clock.c 34 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287
  1. /*
  2. * arch/arm/mach-lpc32xx/clock.c
  3. *
  4. * Author: Kevin Wells <kevin.wells@nxp.com>
  5. *
  6. * Copyright (C) 2010 NXP Semiconductors
  7. *
  8. * This program is free software; you can redistribute it and/or modify
  9. * it under the terms of the GNU General Public License as published by
  10. * the Free Software Foundation; either version 2 of the License, or
  11. * (at your option) any later version.
  12. *
  13. * This program is distributed in the hope that it will be useful,
  14. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  15. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  16. * GNU General Public License for more details.
  17. */
  18. /*
  19. * LPC32xx clock management driver overview
  20. *
  21. * The LPC32XX contains a number of high level system clocks that can be
  22. * generated from different sources. These system clocks are used to
  23. * generate the CPU and bus rates and the individual peripheral clocks in
  24. * the system. When Linux is started by the boot loader, the system
  25. * clocks are already running. Stopping a system clock during normal
  26. * Linux operation should never be attempted, as peripherals that require
  27. * those clocks will quit working (ie, DRAM).
  28. *
  29. * The LPC32xx high level clock tree looks as follows. Clocks marked with
  30. * an asterisk are always on and cannot be disabled. Clocks marked with
  31. * an ampersand can only be disabled in CPU suspend mode. Clocks marked
  32. * with a caret are always on if it is the selected clock for the SYSCLK
  33. * source. The clock that isn't used for SYSCLK can be enabled and
  34. * disabled normally.
  35. * 32KHz oscillator*
  36. * / | \
  37. * RTC* PLL397^ TOUCH
  38. * /
  39. * Main oscillator^ /
  40. * | \ /
  41. * | SYSCLK&
  42. * | \
  43. * | \
  44. * USB_PLL HCLK_PLL&
  45. * | | |
  46. * USB host/device PCLK& |
  47. * | |
  48. * Peripherals
  49. *
  50. * The CPU and chip bus rates are derived from the HCLK PLL, which can
  51. * generate various clock rates up to 266MHz and beyond. The internal bus
  52. * rates (PCLK and HCLK) are generated from dividers based on the HCLK
  53. * PLL rate. HCLK can be a ratio of 1:1, 1:2, or 1:4 or HCLK PLL rate,
  54. * while PCLK can be 1:1 to 1:32 of HCLK PLL rate. Most peripherals high
  55. * level clocks are based on either HCLK or PCLK, but have their own
  56. * dividers as part of the IP itself. Because of this, the system clock
  57. * rates should not be changed.
  58. *
  59. * The HCLK PLL is clocked from SYSCLK, which can be derived from the
  60. * main oscillator or PLL397. PLL397 generates a rate that is 397 times
  61. * the 32KHz oscillator rate. The main oscillator runs at the selected
  62. * oscillator/crystal rate on the mosc_in pin of the LPC32xx. This rate
  63. * is normally 13MHz, but depends on the selection of external crystals
  64. * or oscillators. If USB operation is required, the main oscillator must
  65. * be used in the system.
  66. *
  67. * Switching SYSCLK between sources during normal Linux operation is not
  68. * supported. SYSCLK is preset in the bootloader. Because of the
  69. * complexities of clock management during clock frequency changes,
  70. * there are some limitations to the clock driver explained below:
  71. * - The PLL397 and main oscillator can be enabled and disabled by the
  72. * clk_enable() and clk_disable() functions unless SYSCLK is based
  73. * on that clock. This allows the other oscillator that isn't driving
  74. * the HCLK PLL to be used as another system clock that can be routed
  75. * to an external pin.
  76. * - The muxed SYSCLK input and HCLK_PLL rate cannot be changed with
  77. * this driver.
  78. * - HCLK and PCLK rates cannot be changed as part of this driver.
  79. * - Most peripherals have their own dividers are part of the peripheral
  80. * block. Changing SYSCLK, HCLK PLL, HCLK, or PCLK sources or rates
  81. * will also impact the individual peripheral rates.
  82. */
  83. #include <linux/export.h>
  84. #include <linux/kernel.h>
  85. #include <linux/list.h>
  86. #include <linux/errno.h>
  87. #include <linux/device.h>
  88. #include <linux/delay.h>
  89. #include <linux/err.h>
  90. #include <linux/clk.h>
  91. #include <linux/amba/bus.h>
  92. #include <linux/amba/clcd.h>
  93. #include <linux/clkdev.h>
  94. #include <mach/hardware.h>
  95. #include <mach/platform.h>
  96. #include "clock.h"
  97. #include "common.h"
  98. static DEFINE_SPINLOCK(global_clkregs_lock);
  99. static int usb_pll_enable, usb_pll_valid;
  100. static struct clk clk_armpll;
  101. static struct clk clk_usbpll;
  102. /*
  103. * Post divider values for PLLs based on selected register value
  104. */
  105. static const u32 pll_postdivs[4] = {1, 2, 4, 8};
  106. static unsigned long local_return_parent_rate(struct clk *clk)
  107. {
  108. /*
  109. * If a clock has a rate of 0, then it inherits it's parent
  110. * clock rate
  111. */
  112. while (clk->rate == 0)
  113. clk = clk->parent;
  114. return clk->rate;
  115. }
  116. /* 32KHz clock has a fixed rate and is not stoppable */
  117. static struct clk osc_32KHz = {
  118. .rate = LPC32XX_CLOCK_OSC_FREQ,
  119. .get_rate = local_return_parent_rate,
  120. };
  121. static int local_pll397_enable(struct clk *clk, int enable)
  122. {
  123. u32 reg;
  124. unsigned long timeout = jiffies + msecs_to_jiffies(10);
  125. reg = __raw_readl(LPC32XX_CLKPWR_PLL397_CTRL);
  126. if (enable == 0) {
  127. reg |= LPC32XX_CLKPWR_SYSCTRL_PLL397_DIS;
  128. __raw_writel(reg, LPC32XX_CLKPWR_PLL397_CTRL);
  129. } else {
  130. /* Enable PLL397 */
  131. reg &= ~LPC32XX_CLKPWR_SYSCTRL_PLL397_DIS;
  132. __raw_writel(reg, LPC32XX_CLKPWR_PLL397_CTRL);
  133. /* Wait for PLL397 lock */
  134. while (((__raw_readl(LPC32XX_CLKPWR_PLL397_CTRL) &
  135. LPC32XX_CLKPWR_SYSCTRL_PLL397_STS) == 0) &&
  136. time_before(jiffies, timeout))
  137. cpu_relax();
  138. if ((__raw_readl(LPC32XX_CLKPWR_PLL397_CTRL) &
  139. LPC32XX_CLKPWR_SYSCTRL_PLL397_STS) == 0)
  140. return -ENODEV;
  141. }
  142. return 0;
  143. }
  144. static int local_oscmain_enable(struct clk *clk, int enable)
  145. {
  146. u32 reg;
  147. unsigned long timeout = jiffies + msecs_to_jiffies(10);
  148. reg = __raw_readl(LPC32XX_CLKPWR_MAIN_OSC_CTRL);
  149. if (enable == 0) {
  150. reg |= LPC32XX_CLKPWR_MOSC_DISABLE;
  151. __raw_writel(reg, LPC32XX_CLKPWR_MAIN_OSC_CTRL);
  152. } else {
  153. /* Enable main oscillator */
  154. reg &= ~LPC32XX_CLKPWR_MOSC_DISABLE;
  155. __raw_writel(reg, LPC32XX_CLKPWR_MAIN_OSC_CTRL);
  156. /* Wait for main oscillator to start */
  157. while (((__raw_readl(LPC32XX_CLKPWR_MAIN_OSC_CTRL) &
  158. LPC32XX_CLKPWR_MOSC_DISABLE) != 0) &&
  159. time_before(jiffies, timeout))
  160. cpu_relax();
  161. if ((__raw_readl(LPC32XX_CLKPWR_MAIN_OSC_CTRL) &
  162. LPC32XX_CLKPWR_MOSC_DISABLE) != 0)
  163. return -ENODEV;
  164. }
  165. return 0;
  166. }
  167. static struct clk osc_pll397 = {
  168. .parent = &osc_32KHz,
  169. .enable = local_pll397_enable,
  170. .rate = LPC32XX_CLOCK_OSC_FREQ * 397,
  171. .get_rate = local_return_parent_rate,
  172. };
  173. static struct clk osc_main = {
  174. .enable = local_oscmain_enable,
  175. .rate = LPC32XX_MAIN_OSC_FREQ,
  176. .get_rate = local_return_parent_rate,
  177. };
  178. static struct clk clk_sys;
  179. /*
  180. * Convert a PLL register value to a PLL output frequency
  181. */
  182. u32 clk_get_pllrate_from_reg(u32 inputclk, u32 regval)
  183. {
  184. struct clk_pll_setup pllcfg;
  185. pllcfg.cco_bypass_b15 = 0;
  186. pllcfg.direct_output_b14 = 0;
  187. pllcfg.fdbk_div_ctrl_b13 = 0;
  188. if ((regval & LPC32XX_CLKPWR_HCLKPLL_CCO_BYPASS) != 0)
  189. pllcfg.cco_bypass_b15 = 1;
  190. if ((regval & LPC32XX_CLKPWR_HCLKPLL_POSTDIV_BYPASS) != 0)
  191. pllcfg.direct_output_b14 = 1;
  192. if ((regval & LPC32XX_CLKPWR_HCLKPLL_FDBK_SEL_FCLK) != 0)
  193. pllcfg.fdbk_div_ctrl_b13 = 1;
  194. pllcfg.pll_m = 1 + ((regval >> 1) & 0xFF);
  195. pllcfg.pll_n = 1 + ((regval >> 9) & 0x3);
  196. pllcfg.pll_p = pll_postdivs[((regval >> 11) & 0x3)];
  197. return clk_check_pll_setup(inputclk, &pllcfg);
  198. }
  199. /*
  200. * Setup the HCLK PLL with a PLL structure
  201. */
  202. static u32 local_clk_pll_setup(struct clk_pll_setup *PllSetup)
  203. {
  204. u32 tv, tmp = 0;
  205. if (PllSetup->analog_on != 0)
  206. tmp |= LPC32XX_CLKPWR_HCLKPLL_POWER_UP;
  207. if (PllSetup->cco_bypass_b15 != 0)
  208. tmp |= LPC32XX_CLKPWR_HCLKPLL_CCO_BYPASS;
  209. if (PllSetup->direct_output_b14 != 0)
  210. tmp |= LPC32XX_CLKPWR_HCLKPLL_POSTDIV_BYPASS;
  211. if (PllSetup->fdbk_div_ctrl_b13 != 0)
  212. tmp |= LPC32XX_CLKPWR_HCLKPLL_FDBK_SEL_FCLK;
  213. tv = ffs(PllSetup->pll_p) - 1;
  214. if ((!is_power_of_2(PllSetup->pll_p)) || (tv > 3))
  215. return 0;
  216. tmp |= LPC32XX_CLKPWR_HCLKPLL_POSTDIV_2POW(tv);
  217. tmp |= LPC32XX_CLKPWR_HCLKPLL_PREDIV_PLUS1(PllSetup->pll_n - 1);
  218. tmp |= LPC32XX_CLKPWR_HCLKPLL_PLLM(PllSetup->pll_m - 1);
  219. return tmp;
  220. }
  221. /*
  222. * Update the ARM core PLL frequency rate variable from the actual PLL setting
  223. */
  224. static void local_update_armpll_rate(void)
  225. {
  226. u32 clkin, pllreg;
  227. clkin = clk_armpll.parent->rate;
  228. pllreg = __raw_readl(LPC32XX_CLKPWR_HCLKPLL_CTRL) & 0x1FFFF;
  229. clk_armpll.rate = clk_get_pllrate_from_reg(clkin, pllreg);
  230. }
  231. /*
  232. * Find a PLL configuration for the selected input frequency
  233. */
  234. static u32 local_clk_find_pll_cfg(u32 pllin_freq, u32 target_freq,
  235. struct clk_pll_setup *pllsetup)
  236. {
  237. u32 ifreq, freqtol, m, n, p, fclkout;
  238. /* Determine frequency tolerance limits */
  239. freqtol = target_freq / 250;
  240. ifreq = pllin_freq;
  241. /* Is direct bypass mode possible? */
  242. if (abs(pllin_freq - target_freq) <= freqtol) {
  243. pllsetup->analog_on = 0;
  244. pllsetup->cco_bypass_b15 = 1;
  245. pllsetup->direct_output_b14 = 1;
  246. pllsetup->fdbk_div_ctrl_b13 = 1;
  247. pllsetup->pll_p = pll_postdivs[0];
  248. pllsetup->pll_n = 1;
  249. pllsetup->pll_m = 1;
  250. return clk_check_pll_setup(ifreq, pllsetup);
  251. } else if (target_freq <= ifreq) {
  252. pllsetup->analog_on = 0;
  253. pllsetup->cco_bypass_b15 = 1;
  254. pllsetup->direct_output_b14 = 0;
  255. pllsetup->fdbk_div_ctrl_b13 = 1;
  256. pllsetup->pll_n = 1;
  257. pllsetup->pll_m = 1;
  258. for (p = 0; p <= 3; p++) {
  259. pllsetup->pll_p = pll_postdivs[p];
  260. fclkout = clk_check_pll_setup(ifreq, pllsetup);
  261. if (abs(target_freq - fclkout) <= freqtol)
  262. return fclkout;
  263. }
  264. }
  265. /* Is direct mode possible? */
  266. pllsetup->analog_on = 1;
  267. pllsetup->cco_bypass_b15 = 0;
  268. pllsetup->direct_output_b14 = 1;
  269. pllsetup->fdbk_div_ctrl_b13 = 0;
  270. pllsetup->pll_p = pll_postdivs[0];
  271. for (m = 1; m <= 256; m++) {
  272. for (n = 1; n <= 4; n++) {
  273. /* Compute output frequency for this value */
  274. pllsetup->pll_n = n;
  275. pllsetup->pll_m = m;
  276. fclkout = clk_check_pll_setup(ifreq,
  277. pllsetup);
  278. if (abs(target_freq - fclkout) <=
  279. freqtol)
  280. return fclkout;
  281. }
  282. }
  283. /* Is integer mode possible? */
  284. pllsetup->analog_on = 1;
  285. pllsetup->cco_bypass_b15 = 0;
  286. pllsetup->direct_output_b14 = 0;
  287. pllsetup->fdbk_div_ctrl_b13 = 1;
  288. for (m = 1; m <= 256; m++) {
  289. for (n = 1; n <= 4; n++) {
  290. for (p = 0; p < 4; p++) {
  291. /* Compute output frequency */
  292. pllsetup->pll_p = pll_postdivs[p];
  293. pllsetup->pll_n = n;
  294. pllsetup->pll_m = m;
  295. fclkout = clk_check_pll_setup(
  296. ifreq, pllsetup);
  297. if (abs(target_freq - fclkout) <= freqtol)
  298. return fclkout;
  299. }
  300. }
  301. }
  302. /* Try non-integer mode */
  303. pllsetup->analog_on = 1;
  304. pllsetup->cco_bypass_b15 = 0;
  305. pllsetup->direct_output_b14 = 0;
  306. pllsetup->fdbk_div_ctrl_b13 = 0;
  307. for (m = 1; m <= 256; m++) {
  308. for (n = 1; n <= 4; n++) {
  309. for (p = 0; p < 4; p++) {
  310. /* Compute output frequency */
  311. pllsetup->pll_p = pll_postdivs[p];
  312. pllsetup->pll_n = n;
  313. pllsetup->pll_m = m;
  314. fclkout = clk_check_pll_setup(
  315. ifreq, pllsetup);
  316. if (abs(target_freq - fclkout) <= freqtol)
  317. return fclkout;
  318. }
  319. }
  320. }
  321. return 0;
  322. }
  323. static struct clk clk_armpll = {
  324. .parent = &clk_sys,
  325. .get_rate = local_return_parent_rate,
  326. };
  327. /*
  328. * Setup the USB PLL with a PLL structure
  329. */
  330. static u32 local_clk_usbpll_setup(struct clk_pll_setup *pHCLKPllSetup)
  331. {
  332. u32 reg, tmp = local_clk_pll_setup(pHCLKPllSetup);
  333. reg = __raw_readl(LPC32XX_CLKPWR_USB_CTRL) & ~0x1FFFF;
  334. reg |= tmp;
  335. __raw_writel(reg, LPC32XX_CLKPWR_USB_CTRL);
  336. return clk_check_pll_setup(clk_usbpll.parent->rate,
  337. pHCLKPllSetup);
  338. }
  339. static int local_usbpll_enable(struct clk *clk, int enable)
  340. {
  341. u32 reg;
  342. int ret = 0;
  343. unsigned long timeout = jiffies + msecs_to_jiffies(20);
  344. reg = __raw_readl(LPC32XX_CLKPWR_USB_CTRL);
  345. __raw_writel(reg & ~(LPC32XX_CLKPWR_USBCTRL_CLK_EN2 |
  346. LPC32XX_CLKPWR_USBCTRL_PLL_PWRUP),
  347. LPC32XX_CLKPWR_USB_CTRL);
  348. __raw_writel(reg & ~LPC32XX_CLKPWR_USBCTRL_CLK_EN1,
  349. LPC32XX_CLKPWR_USB_CTRL);
  350. if (enable && usb_pll_valid && usb_pll_enable) {
  351. ret = -ENODEV;
  352. /*
  353. * If the PLL rate has been previously set, then the rate
  354. * in the PLL register is valid and can be enabled here.
  355. * Otherwise, it needs to be enabled as part of setrate.
  356. */
  357. /*
  358. * Gate clock into PLL
  359. */
  360. reg |= LPC32XX_CLKPWR_USBCTRL_CLK_EN1;
  361. __raw_writel(reg, LPC32XX_CLKPWR_USB_CTRL);
  362. /*
  363. * Enable PLL
  364. */
  365. reg |= LPC32XX_CLKPWR_USBCTRL_PLL_PWRUP;
  366. __raw_writel(reg, LPC32XX_CLKPWR_USB_CTRL);
  367. /*
  368. * Wait for PLL to lock
  369. */
  370. while (time_before(jiffies, timeout) && (ret == -ENODEV)) {
  371. reg = __raw_readl(LPC32XX_CLKPWR_USB_CTRL);
  372. if (reg & LPC32XX_CLKPWR_USBCTRL_PLL_STS)
  373. ret = 0;
  374. else
  375. udelay(10);
  376. }
  377. /*
  378. * Gate clock from PLL if PLL is locked
  379. */
  380. if (ret == 0) {
  381. __raw_writel(reg | LPC32XX_CLKPWR_USBCTRL_CLK_EN2,
  382. LPC32XX_CLKPWR_USB_CTRL);
  383. } else {
  384. __raw_writel(reg & ~(LPC32XX_CLKPWR_USBCTRL_CLK_EN1 |
  385. LPC32XX_CLKPWR_USBCTRL_PLL_PWRUP),
  386. LPC32XX_CLKPWR_USB_CTRL);
  387. }
  388. } else if ((enable == 0) && usb_pll_valid && usb_pll_enable) {
  389. usb_pll_valid = 0;
  390. usb_pll_enable = 0;
  391. }
  392. return ret;
  393. }
  394. static unsigned long local_usbpll_round_rate(struct clk *clk,
  395. unsigned long rate)
  396. {
  397. u32 clkin, usbdiv;
  398. struct clk_pll_setup pllsetup;
  399. /*
  400. * Unlike other clocks, this clock has a KHz input rate, so bump
  401. * it up to work with the PLL function
  402. */
  403. rate = rate * 1000;
  404. clkin = clk->get_rate(clk);
  405. usbdiv = (__raw_readl(LPC32XX_CLKPWR_USBCLK_PDIV) &
  406. LPC32XX_CLKPWR_USBPDIV_PLL_MASK) + 1;
  407. clkin = clkin / usbdiv;
  408. /* Try to find a good rate setup */
  409. if (local_clk_find_pll_cfg(clkin, rate, &pllsetup) == 0)
  410. return 0;
  411. return clk_check_pll_setup(clkin, &pllsetup);
  412. }
  413. static int local_usbpll_set_rate(struct clk *clk, unsigned long rate)
  414. {
  415. int ret = -ENODEV;
  416. u32 clkin, usbdiv;
  417. struct clk_pll_setup pllsetup;
  418. /*
  419. * Unlike other clocks, this clock has a KHz input rate, so bump
  420. * it up to work with the PLL function
  421. */
  422. rate = rate * 1000;
  423. clkin = clk->get_rate(clk->parent);
  424. usbdiv = (__raw_readl(LPC32XX_CLKPWR_USBCLK_PDIV) &
  425. LPC32XX_CLKPWR_USBPDIV_PLL_MASK) + 1;
  426. clkin = clkin / usbdiv;
  427. /* Try to find a good rate setup */
  428. if (local_clk_find_pll_cfg(clkin, rate, &pllsetup) == 0)
  429. return -EINVAL;
  430. /*
  431. * Disable PLL clocks during PLL change
  432. */
  433. local_usbpll_enable(clk, 0);
  434. pllsetup.analog_on = 0;
  435. local_clk_usbpll_setup(&pllsetup);
  436. /*
  437. * Start USB PLL and check PLL status
  438. */
  439. usb_pll_valid = 1;
  440. usb_pll_enable = 1;
  441. ret = local_usbpll_enable(clk, 1);
  442. if (ret >= 0)
  443. clk->rate = clk_check_pll_setup(clkin, &pllsetup);
  444. return ret;
  445. }
  446. static struct clk clk_usbpll = {
  447. .parent = &osc_main,
  448. .set_rate = local_usbpll_set_rate,
  449. .enable = local_usbpll_enable,
  450. .rate = 48000, /* In KHz */
  451. .get_rate = local_return_parent_rate,
  452. .round_rate = local_usbpll_round_rate,
  453. };
  454. static u32 clk_get_hclk_div(void)
  455. {
  456. static const u32 hclkdivs[4] = {1, 2, 4, 4};
  457. return hclkdivs[LPC32XX_CLKPWR_HCLKDIV_DIV_2POW(
  458. __raw_readl(LPC32XX_CLKPWR_HCLK_DIV))];
  459. }
  460. static struct clk clk_hclk = {
  461. .parent = &clk_armpll,
  462. .get_rate = local_return_parent_rate,
  463. };
  464. static struct clk clk_pclk = {
  465. .parent = &clk_armpll,
  466. .get_rate = local_return_parent_rate,
  467. };
  468. static int local_onoff_enable(struct clk *clk, int enable)
  469. {
  470. u32 tmp;
  471. tmp = __raw_readl(clk->enable_reg);
  472. if (enable == 0)
  473. tmp &= ~clk->enable_mask;
  474. else
  475. tmp |= clk->enable_mask;
  476. __raw_writel(tmp, clk->enable_reg);
  477. return 0;
  478. }
  479. /* Peripheral clock sources */
  480. static struct clk clk_timer0 = {
  481. .parent = &clk_pclk,
  482. .enable = local_onoff_enable,
  483. .enable_reg = LPC32XX_CLKPWR_TIMERS_PWMS_CLK_CTRL_1,
  484. .enable_mask = LPC32XX_CLKPWR_TMRPWMCLK_TIMER0_EN,
  485. .get_rate = local_return_parent_rate,
  486. };
  487. static struct clk clk_timer1 = {
  488. .parent = &clk_pclk,
  489. .enable = local_onoff_enable,
  490. .enable_reg = LPC32XX_CLKPWR_TIMERS_PWMS_CLK_CTRL_1,
  491. .enable_mask = LPC32XX_CLKPWR_TMRPWMCLK_TIMER1_EN,
  492. .get_rate = local_return_parent_rate,
  493. };
  494. static struct clk clk_timer2 = {
  495. .parent = &clk_pclk,
  496. .enable = local_onoff_enable,
  497. .enable_reg = LPC32XX_CLKPWR_TIMERS_PWMS_CLK_CTRL_1,
  498. .enable_mask = LPC32XX_CLKPWR_TMRPWMCLK_TIMER2_EN,
  499. .get_rate = local_return_parent_rate,
  500. };
  501. static struct clk clk_timer3 = {
  502. .parent = &clk_pclk,
  503. .enable = local_onoff_enable,
  504. .enable_reg = LPC32XX_CLKPWR_TIMERS_PWMS_CLK_CTRL_1,
  505. .enable_mask = LPC32XX_CLKPWR_TMRPWMCLK_TIMER3_EN,
  506. .get_rate = local_return_parent_rate,
  507. };
  508. static struct clk clk_mpwm = {
  509. .parent = &clk_pclk,
  510. .enable = local_onoff_enable,
  511. .enable_reg = LPC32XX_CLKPWR_TIMERS_PWMS_CLK_CTRL_1,
  512. .enable_mask = LPC32XX_CLKPWR_TMRPWMCLK_MPWM_EN,
  513. .get_rate = local_return_parent_rate,
  514. };
  515. static struct clk clk_wdt = {
  516. .parent = &clk_pclk,
  517. .enable = local_onoff_enable,
  518. .enable_reg = LPC32XX_CLKPWR_TIMER_CLK_CTRL,
  519. .enable_mask = LPC32XX_CLKPWR_PWMCLK_WDOG_EN,
  520. .get_rate = local_return_parent_rate,
  521. };
  522. static struct clk clk_vfp9 = {
  523. .parent = &clk_pclk,
  524. .enable = local_onoff_enable,
  525. .enable_reg = LPC32XX_CLKPWR_DEBUG_CTRL,
  526. .enable_mask = LPC32XX_CLKPWR_VFP_CLOCK_ENABLE_BIT,
  527. .get_rate = local_return_parent_rate,
  528. };
  529. static struct clk clk_dma = {
  530. .parent = &clk_hclk,
  531. .enable = local_onoff_enable,
  532. .enable_reg = LPC32XX_CLKPWR_DMA_CLK_CTRL,
  533. .enable_mask = LPC32XX_CLKPWR_DMACLKCTRL_CLK_EN,
  534. .get_rate = local_return_parent_rate,
  535. };
  536. static struct clk clk_pwm = {
  537. .parent = &clk_pclk,
  538. .enable = local_onoff_enable,
  539. .enable_reg = LPC32XX_CLKPWR_PWM_CLK_CTRL,
  540. .enable_mask = LPC32XX_CLKPWR_PWMCLK_PWM1CLK_EN |
  541. LPC32XX_CLKPWR_PWMCLK_PWM1SEL_PCLK |
  542. LPC32XX_CLKPWR_PWMCLK_PWM1_DIV(1) |
  543. LPC32XX_CLKPWR_PWMCLK_PWM2CLK_EN |
  544. LPC32XX_CLKPWR_PWMCLK_PWM2SEL_PCLK |
  545. LPC32XX_CLKPWR_PWMCLK_PWM2_DIV(1),
  546. .get_rate = local_return_parent_rate,
  547. };
  548. static struct clk clk_uart3 = {
  549. .parent = &clk_pclk,
  550. .enable = local_onoff_enable,
  551. .enable_reg = LPC32XX_CLKPWR_UART_CLK_CTRL,
  552. .enable_mask = LPC32XX_CLKPWR_UARTCLKCTRL_UART3_EN,
  553. .get_rate = local_return_parent_rate,
  554. };
  555. static struct clk clk_uart4 = {
  556. .parent = &clk_pclk,
  557. .enable = local_onoff_enable,
  558. .enable_reg = LPC32XX_CLKPWR_UART_CLK_CTRL,
  559. .enable_mask = LPC32XX_CLKPWR_UARTCLKCTRL_UART4_EN,
  560. .get_rate = local_return_parent_rate,
  561. };
  562. static struct clk clk_uart5 = {
  563. .parent = &clk_pclk,
  564. .enable = local_onoff_enable,
  565. .enable_reg = LPC32XX_CLKPWR_UART_CLK_CTRL,
  566. .enable_mask = LPC32XX_CLKPWR_UARTCLKCTRL_UART5_EN,
  567. .get_rate = local_return_parent_rate,
  568. };
  569. static struct clk clk_uart6 = {
  570. .parent = &clk_pclk,
  571. .enable = local_onoff_enable,
  572. .enable_reg = LPC32XX_CLKPWR_UART_CLK_CTRL,
  573. .enable_mask = LPC32XX_CLKPWR_UARTCLKCTRL_UART6_EN,
  574. .get_rate = local_return_parent_rate,
  575. };
  576. static struct clk clk_i2c0 = {
  577. .parent = &clk_hclk,
  578. .enable = local_onoff_enable,
  579. .enable_reg = LPC32XX_CLKPWR_I2C_CLK_CTRL,
  580. .enable_mask = LPC32XX_CLKPWR_I2CCLK_I2C1CLK_EN,
  581. .get_rate = local_return_parent_rate,
  582. };
  583. static struct clk clk_i2c1 = {
  584. .parent = &clk_hclk,
  585. .enable = local_onoff_enable,
  586. .enable_reg = LPC32XX_CLKPWR_I2C_CLK_CTRL,
  587. .enable_mask = LPC32XX_CLKPWR_I2CCLK_I2C2CLK_EN,
  588. .get_rate = local_return_parent_rate,
  589. };
  590. static struct clk clk_i2c2 = {
  591. .parent = &clk_pclk,
  592. .enable = local_onoff_enable,
  593. .enable_reg = io_p2v(LPC32XX_USB_BASE + 0xFF4),
  594. .enable_mask = 0x4,
  595. .get_rate = local_return_parent_rate,
  596. };
  597. static struct clk clk_ssp0 = {
  598. .parent = &clk_hclk,
  599. .enable = local_onoff_enable,
  600. .enable_reg = LPC32XX_CLKPWR_SSP_CLK_CTRL,
  601. .enable_mask = LPC32XX_CLKPWR_SSPCTRL_SSPCLK0_EN,
  602. .get_rate = local_return_parent_rate,
  603. };
  604. static struct clk clk_ssp1 = {
  605. .parent = &clk_hclk,
  606. .enable = local_onoff_enable,
  607. .enable_reg = LPC32XX_CLKPWR_SSP_CLK_CTRL,
  608. .enable_mask = LPC32XX_CLKPWR_SSPCTRL_SSPCLK1_EN,
  609. .get_rate = local_return_parent_rate,
  610. };
  611. static struct clk clk_kscan = {
  612. .parent = &osc_32KHz,
  613. .enable = local_onoff_enable,
  614. .enable_reg = LPC32XX_CLKPWR_KEY_CLK_CTRL,
  615. .enable_mask = LPC32XX_CLKPWR_KEYCLKCTRL_CLK_EN,
  616. .get_rate = local_return_parent_rate,
  617. };
  618. static struct clk clk_nand = {
  619. .parent = &clk_hclk,
  620. .enable = local_onoff_enable,
  621. .enable_reg = LPC32XX_CLKPWR_NAND_CLK_CTRL,
  622. .enable_mask = LPC32XX_CLKPWR_NANDCLK_SLCCLK_EN |
  623. LPC32XX_CLKPWR_NANDCLK_SEL_SLC,
  624. .get_rate = local_return_parent_rate,
  625. };
  626. static struct clk clk_nand_mlc = {
  627. .parent = &clk_hclk,
  628. .enable = local_onoff_enable,
  629. .enable_reg = LPC32XX_CLKPWR_NAND_CLK_CTRL,
  630. .enable_mask = LPC32XX_CLKPWR_NANDCLK_MLCCLK_EN |
  631. LPC32XX_CLKPWR_NANDCLK_DMA_INT |
  632. LPC32XX_CLKPWR_NANDCLK_INTSEL_MLC,
  633. .get_rate = local_return_parent_rate,
  634. };
  635. static struct clk clk_i2s0 = {
  636. .parent = &clk_hclk,
  637. .enable = local_onoff_enable,
  638. .enable_reg = LPC32XX_CLKPWR_I2S_CLK_CTRL,
  639. .enable_mask = LPC32XX_CLKPWR_I2SCTRL_I2SCLK0_EN,
  640. .get_rate = local_return_parent_rate,
  641. };
  642. static struct clk clk_i2s1 = {
  643. .parent = &clk_hclk,
  644. .enable = local_onoff_enable,
  645. .enable_reg = LPC32XX_CLKPWR_I2S_CLK_CTRL,
  646. .enable_mask = LPC32XX_CLKPWR_I2SCTRL_I2SCLK1_EN |
  647. LPC32XX_CLKPWR_I2SCTRL_I2S1_USE_DMA,
  648. .get_rate = local_return_parent_rate,
  649. };
  650. static struct clk clk_net = {
  651. .parent = &clk_hclk,
  652. .enable = local_onoff_enable,
  653. .enable_reg = LPC32XX_CLKPWR_MACCLK_CTRL,
  654. .enable_mask = (LPC32XX_CLKPWR_MACCTRL_DMACLK_EN |
  655. LPC32XX_CLKPWR_MACCTRL_MMIOCLK_EN |
  656. LPC32XX_CLKPWR_MACCTRL_HRCCLK_EN),
  657. .get_rate = local_return_parent_rate,
  658. };
  659. static struct clk clk_rtc = {
  660. .parent = &osc_32KHz,
  661. .rate = 1, /* 1 Hz */
  662. .get_rate = local_return_parent_rate,
  663. };
  664. static int local_usb_enable(struct clk *clk, int enable)
  665. {
  666. u32 tmp;
  667. if (enable) {
  668. /* Set up I2C pull levels */
  669. tmp = __raw_readl(LPC32XX_CLKPWR_I2C_CLK_CTRL);
  670. tmp |= LPC32XX_CLKPWR_I2CCLK_USBI2CHI_DRIVE;
  671. __raw_writel(tmp, LPC32XX_CLKPWR_I2C_CLK_CTRL);
  672. }
  673. return local_onoff_enable(clk, enable);
  674. }
  675. static struct clk clk_usbd = {
  676. .parent = &clk_usbpll,
  677. .enable = local_usb_enable,
  678. .enable_reg = LPC32XX_CLKPWR_USB_CTRL,
  679. .enable_mask = LPC32XX_CLKPWR_USBCTRL_HCLK_EN,
  680. .get_rate = local_return_parent_rate,
  681. };
  682. #define OTG_ALWAYS_MASK (LPC32XX_USB_OTG_OTG_CLOCK_ON | \
  683. LPC32XX_USB_OTG_I2C_CLOCK_ON)
  684. static int local_usb_otg_enable(struct clk *clk, int enable)
  685. {
  686. int to = 1000;
  687. if (enable) {
  688. __raw_writel(clk->enable_mask, clk->enable_reg);
  689. while (((__raw_readl(LPC32XX_USB_OTG_CLK_STAT) &
  690. clk->enable_mask) != clk->enable_mask) && (to > 0))
  691. to--;
  692. } else {
  693. __raw_writel(OTG_ALWAYS_MASK, clk->enable_reg);
  694. while (((__raw_readl(LPC32XX_USB_OTG_CLK_STAT) &
  695. OTG_ALWAYS_MASK) != OTG_ALWAYS_MASK) && (to > 0))
  696. to--;
  697. }
  698. if (to)
  699. return 0;
  700. else
  701. return -1;
  702. }
  703. static struct clk clk_usb_otg_dev = {
  704. .parent = &clk_usbpll,
  705. .enable = local_usb_otg_enable,
  706. .enable_reg = LPC32XX_USB_OTG_CLK_CTRL,
  707. .enable_mask = LPC32XX_USB_OTG_AHB_M_CLOCK_ON |
  708. LPC32XX_USB_OTG_OTG_CLOCK_ON |
  709. LPC32XX_USB_OTG_DEV_CLOCK_ON |
  710. LPC32XX_USB_OTG_I2C_CLOCK_ON,
  711. .get_rate = local_return_parent_rate,
  712. };
  713. static struct clk clk_usb_otg_host = {
  714. .parent = &clk_usbpll,
  715. .enable = local_usb_otg_enable,
  716. .enable_reg = LPC32XX_USB_OTG_CLK_CTRL,
  717. .enable_mask = LPC32XX_USB_OTG_AHB_M_CLOCK_ON |
  718. LPC32XX_USB_OTG_OTG_CLOCK_ON |
  719. LPC32XX_USB_OTG_HOST_CLOCK_ON |
  720. LPC32XX_USB_OTG_I2C_CLOCK_ON,
  721. .get_rate = local_return_parent_rate,
  722. };
  723. static int tsc_onoff_enable(struct clk *clk, int enable)
  724. {
  725. u32 tmp;
  726. /* Make sure 32KHz clock is the selected clock */
  727. tmp = __raw_readl(LPC32XX_CLKPWR_ADC_CLK_CTRL_1);
  728. tmp &= ~LPC32XX_CLKPWR_ADCCTRL1_PCLK_SEL;
  729. __raw_writel(tmp, LPC32XX_CLKPWR_ADC_CLK_CTRL_1);
  730. if (enable == 0)
  731. __raw_writel(0, clk->enable_reg);
  732. else
  733. __raw_writel(clk->enable_mask, clk->enable_reg);
  734. return 0;
  735. }
  736. static struct clk clk_tsc = {
  737. .parent = &osc_32KHz,
  738. .enable = tsc_onoff_enable,
  739. .enable_reg = LPC32XX_CLKPWR_ADC_CLK_CTRL,
  740. .enable_mask = LPC32XX_CLKPWR_ADC32CLKCTRL_CLK_EN,
  741. .get_rate = local_return_parent_rate,
  742. };
  743. static int adc_onoff_enable(struct clk *clk, int enable)
  744. {
  745. u32 tmp;
  746. u32 divider;
  747. /* Use PERIPH_CLOCK */
  748. tmp = __raw_readl(LPC32XX_CLKPWR_ADC_CLK_CTRL_1);
  749. tmp |= LPC32XX_CLKPWR_ADCCTRL1_PCLK_SEL;
  750. /*
  751. * Set clock divider so that we have equal to or less than
  752. * 4.5MHz clock at ADC
  753. */
  754. divider = clk->get_rate(clk) / 4500000 + 1;
  755. tmp |= divider;
  756. __raw_writel(tmp, LPC32XX_CLKPWR_ADC_CLK_CTRL_1);
  757. /* synchronize rate of this clock w/ actual HW setting */
  758. clk->rate = clk->get_rate(clk->parent) / divider;
  759. if (enable == 0)
  760. __raw_writel(0, clk->enable_reg);
  761. else
  762. __raw_writel(clk->enable_mask, clk->enable_reg);
  763. return 0;
  764. }
  765. static struct clk clk_adc = {
  766. .parent = &clk_pclk,
  767. .enable = adc_onoff_enable,
  768. .enable_reg = LPC32XX_CLKPWR_ADC_CLK_CTRL,
  769. .enable_mask = LPC32XX_CLKPWR_ADC32CLKCTRL_CLK_EN,
  770. .get_rate = local_return_parent_rate,
  771. };
  772. static int mmc_onoff_enable(struct clk *clk, int enable)
  773. {
  774. u32 tmp;
  775. tmp = __raw_readl(LPC32XX_CLKPWR_MS_CTRL) &
  776. ~(LPC32XX_CLKPWR_MSCARD_SDCARD_EN |
  777. LPC32XX_CLKPWR_MSCARD_MSDIO_PU_EN |
  778. LPC32XX_CLKPWR_MSCARD_MSDIO_PIN_DIS |
  779. LPC32XX_CLKPWR_MSCARD_MSDIO0_DIS |
  780. LPC32XX_CLKPWR_MSCARD_MSDIO1_DIS |
  781. LPC32XX_CLKPWR_MSCARD_MSDIO23_DIS);
  782. /* If rate is 0, disable clock */
  783. if (enable != 0)
  784. tmp |= LPC32XX_CLKPWR_MSCARD_SDCARD_EN |
  785. LPC32XX_CLKPWR_MSCARD_MSDIO_PU_EN;
  786. __raw_writel(tmp, LPC32XX_CLKPWR_MS_CTRL);
  787. return 0;
  788. }
  789. static unsigned long mmc_get_rate(struct clk *clk)
  790. {
  791. u32 div, rate, oldclk;
  792. /* The MMC clock must be on when accessing an MMC register */
  793. oldclk = __raw_readl(LPC32XX_CLKPWR_MS_CTRL);
  794. __raw_writel(oldclk | LPC32XX_CLKPWR_MSCARD_SDCARD_EN,
  795. LPC32XX_CLKPWR_MS_CTRL);
  796. div = __raw_readl(LPC32XX_CLKPWR_MS_CTRL);
  797. __raw_writel(oldclk, LPC32XX_CLKPWR_MS_CTRL);
  798. /* Get the parent clock rate */
  799. rate = clk->parent->get_rate(clk->parent);
  800. /* Get the MMC controller clock divider value */
  801. div = div & LPC32XX_CLKPWR_MSCARD_SDCARD_DIV(0xf);
  802. if (!div)
  803. div = 1;
  804. return rate / div;
  805. }
  806. static unsigned long mmc_round_rate(struct clk *clk, unsigned long rate)
  807. {
  808. unsigned long div, prate;
  809. /* Get the parent clock rate */
  810. prate = clk->parent->get_rate(clk->parent);
  811. if (rate >= prate)
  812. return prate;
  813. div = prate / rate;
  814. if (div > 0xf)
  815. div = 0xf;
  816. return prate / div;
  817. }
  818. static int mmc_set_rate(struct clk *clk, unsigned long rate)
  819. {
  820. u32 tmp;
  821. unsigned long prate, div, crate = mmc_round_rate(clk, rate);
  822. prate = clk->parent->get_rate(clk->parent);
  823. div = prate / crate;
  824. /* The MMC clock must be on when accessing an MMC register */
  825. tmp = __raw_readl(LPC32XX_CLKPWR_MS_CTRL) &
  826. ~LPC32XX_CLKPWR_MSCARD_SDCARD_DIV(0xf);
  827. tmp |= LPC32XX_CLKPWR_MSCARD_SDCARD_DIV(div) |
  828. LPC32XX_CLKPWR_MSCARD_SDCARD_EN;
  829. __raw_writel(tmp, LPC32XX_CLKPWR_MS_CTRL);
  830. return 0;
  831. }
  832. static struct clk clk_mmc = {
  833. .parent = &clk_armpll,
  834. .set_rate = mmc_set_rate,
  835. .get_rate = mmc_get_rate,
  836. .round_rate = mmc_round_rate,
  837. .enable = mmc_onoff_enable,
  838. .enable_reg = LPC32XX_CLKPWR_MS_CTRL,
  839. .enable_mask = LPC32XX_CLKPWR_MSCARD_SDCARD_EN,
  840. };
  841. static unsigned long clcd_get_rate(struct clk *clk)
  842. {
  843. u32 tmp, div, rate, oldclk;
  844. /* The LCD clock must be on when accessing an LCD register */
  845. oldclk = __raw_readl(LPC32XX_CLKPWR_LCDCLK_CTRL);
  846. __raw_writel(oldclk | LPC32XX_CLKPWR_LCDCTRL_CLK_EN,
  847. LPC32XX_CLKPWR_LCDCLK_CTRL);
  848. tmp = __raw_readl(io_p2v(LPC32XX_LCD_BASE + CLCD_TIM2));
  849. __raw_writel(oldclk, LPC32XX_CLKPWR_LCDCLK_CTRL);
  850. rate = clk->parent->get_rate(clk->parent);
  851. /* Only supports internal clocking */
  852. if (tmp & TIM2_BCD)
  853. return rate;
  854. div = (tmp & 0x1F) | ((tmp & 0xF8) >> 22);
  855. tmp = rate / (2 + div);
  856. return tmp;
  857. }
  858. static int clcd_set_rate(struct clk *clk, unsigned long rate)
  859. {
  860. u32 tmp, prate, div, oldclk;
  861. /* The LCD clock must be on when accessing an LCD register */
  862. oldclk = __raw_readl(LPC32XX_CLKPWR_LCDCLK_CTRL);
  863. __raw_writel(oldclk | LPC32XX_CLKPWR_LCDCTRL_CLK_EN,
  864. LPC32XX_CLKPWR_LCDCLK_CTRL);
  865. tmp = __raw_readl(io_p2v(LPC32XX_LCD_BASE + CLCD_TIM2)) | TIM2_BCD;
  866. prate = clk->parent->get_rate(clk->parent);
  867. if (rate < prate) {
  868. /* Find closest divider */
  869. div = prate / rate;
  870. if (div >= 2) {
  871. div -= 2;
  872. tmp &= ~TIM2_BCD;
  873. }
  874. tmp &= ~(0xF800001F);
  875. tmp |= (div & 0x1F);
  876. tmp |= (((div >> 5) & 0x1F) << 27);
  877. }
  878. __raw_writel(tmp, io_p2v(LPC32XX_LCD_BASE + CLCD_TIM2));
  879. __raw_writel(oldclk, LPC32XX_CLKPWR_LCDCLK_CTRL);
  880. return 0;
  881. }
  882. static unsigned long clcd_round_rate(struct clk *clk, unsigned long rate)
  883. {
  884. u32 prate, div;
  885. prate = clk->parent->get_rate(clk->parent);
  886. if (rate >= prate)
  887. rate = prate;
  888. else {
  889. div = prate / rate;
  890. if (div > 0x3ff)
  891. div = 0x3ff;
  892. rate = prate / div;
  893. }
  894. return rate;
  895. }
  896. static struct clk clk_lcd = {
  897. .parent = &clk_hclk,
  898. .set_rate = clcd_set_rate,
  899. .get_rate = clcd_get_rate,
  900. .round_rate = clcd_round_rate,
  901. .enable = local_onoff_enable,
  902. .enable_reg = LPC32XX_CLKPWR_LCDCLK_CTRL,
  903. .enable_mask = LPC32XX_CLKPWR_LCDCTRL_CLK_EN,
  904. };
  905. static void local_clk_disable(struct clk *clk)
  906. {
  907. /* Don't attempt to disable clock if it has no users */
  908. if (clk->usecount > 0) {
  909. clk->usecount--;
  910. /* Only disable clock when it has no more users */
  911. if ((clk->usecount == 0) && (clk->enable))
  912. clk->enable(clk, 0);
  913. /* Check parent clocks, they may need to be disabled too */
  914. if (clk->parent)
  915. local_clk_disable(clk->parent);
  916. }
  917. }
  918. static int local_clk_enable(struct clk *clk)
  919. {
  920. int ret = 0;
  921. /* Enable parent clocks first and update use counts */
  922. if (clk->parent)
  923. ret = local_clk_enable(clk->parent);
  924. if (!ret) {
  925. /* Only enable clock if it's currently disabled */
  926. if ((clk->usecount == 0) && (clk->enable))
  927. ret = clk->enable(clk, 1);
  928. if (!ret)
  929. clk->usecount++;
  930. else if (clk->parent)
  931. local_clk_disable(clk->parent);
  932. }
  933. return ret;
  934. }
  935. /*
  936. * clk_enable - inform the system when the clock source should be running.
  937. */
  938. int clk_enable(struct clk *clk)
  939. {
  940. int ret;
  941. unsigned long flags;
  942. spin_lock_irqsave(&global_clkregs_lock, flags);
  943. ret = local_clk_enable(clk);
  944. spin_unlock_irqrestore(&global_clkregs_lock, flags);
  945. return ret;
  946. }
  947. EXPORT_SYMBOL(clk_enable);
  948. /*
  949. * clk_disable - inform the system when the clock source is no longer required
  950. */
  951. void clk_disable(struct clk *clk)
  952. {
  953. unsigned long flags;
  954. spin_lock_irqsave(&global_clkregs_lock, flags);
  955. local_clk_disable(clk);
  956. spin_unlock_irqrestore(&global_clkregs_lock, flags);
  957. }
  958. EXPORT_SYMBOL(clk_disable);
  959. /*
  960. * clk_get_rate - obtain the current clock rate (in Hz) for a clock source
  961. */
  962. unsigned long clk_get_rate(struct clk *clk)
  963. {
  964. return clk->get_rate(clk);
  965. }
  966. EXPORT_SYMBOL(clk_get_rate);
  967. /*
  968. * clk_set_rate - set the clock rate for a clock source
  969. */
  970. int clk_set_rate(struct clk *clk, unsigned long rate)
  971. {
  972. int ret = -EINVAL;
  973. /*
  974. * Most system clocks can only be enabled or disabled, with
  975. * the actual rate set as part of the peripheral dividers
  976. * instead of high level clock control
  977. */
  978. if (clk->set_rate)
  979. ret = clk->set_rate(clk, rate);
  980. return ret;
  981. }
  982. EXPORT_SYMBOL(clk_set_rate);
  983. /*
  984. * clk_round_rate - adjust a rate to the exact rate a clock can provide
  985. */
  986. long clk_round_rate(struct clk *clk, unsigned long rate)
  987. {
  988. if (clk->round_rate)
  989. rate = clk->round_rate(clk, rate);
  990. else
  991. rate = clk->get_rate(clk);
  992. return rate;
  993. }
  994. EXPORT_SYMBOL(clk_round_rate);
  995. /*
  996. * clk_set_parent - set the parent clock source for this clock
  997. */
  998. int clk_set_parent(struct clk *clk, struct clk *parent)
  999. {
  1000. /* Clock re-parenting is not supported */
  1001. return -EINVAL;
  1002. }
  1003. EXPORT_SYMBOL(clk_set_parent);
  1004. /*
  1005. * clk_get_parent - get the parent clock source for this clock
  1006. */
  1007. struct clk *clk_get_parent(struct clk *clk)
  1008. {
  1009. return clk->parent;
  1010. }
  1011. EXPORT_SYMBOL(clk_get_parent);
  1012. static struct clk_lookup lookups[] = {
  1013. CLKDEV_INIT(NULL, "osc_32KHz", &osc_32KHz),
  1014. CLKDEV_INIT(NULL, "osc_pll397", &osc_pll397),
  1015. CLKDEV_INIT(NULL, "osc_main", &osc_main),
  1016. CLKDEV_INIT(NULL, "sys_ck", &clk_sys),
  1017. CLKDEV_INIT(NULL, "arm_pll_ck", &clk_armpll),
  1018. CLKDEV_INIT(NULL, "ck_pll5", &clk_usbpll),
  1019. CLKDEV_INIT(NULL, "hclk_ck", &clk_hclk),
  1020. CLKDEV_INIT(NULL, "pclk_ck", &clk_pclk),
  1021. CLKDEV_INIT(NULL, "timer0_ck", &clk_timer0),
  1022. CLKDEV_INIT(NULL, "timer1_ck", &clk_timer1),
  1023. CLKDEV_INIT(NULL, "timer2_ck", &clk_timer2),
  1024. CLKDEV_INIT(NULL, "timer3_ck", &clk_timer3),
  1025. CLKDEV_INIT(NULL, "vfp9_ck", &clk_vfp9),
  1026. CLKDEV_INIT("pl08xdmac", NULL, &clk_dma),
  1027. CLKDEV_INIT("4003c000.watchdog", NULL, &clk_wdt),
  1028. CLKDEV_INIT("4005c000.pwm", NULL, &clk_pwm),
  1029. CLKDEV_INIT("400e8000.mpwm", NULL, &clk_mpwm),
  1030. CLKDEV_INIT(NULL, "uart3_ck", &clk_uart3),
  1031. CLKDEV_INIT(NULL, "uart4_ck", &clk_uart4),
  1032. CLKDEV_INIT(NULL, "uart5_ck", &clk_uart5),
  1033. CLKDEV_INIT(NULL, "uart6_ck", &clk_uart6),
  1034. CLKDEV_INIT("400a0000.i2c", NULL, &clk_i2c0),
  1035. CLKDEV_INIT("400a8000.i2c", NULL, &clk_i2c1),
  1036. CLKDEV_INIT("31020300.i2c", NULL, &clk_i2c2),
  1037. CLKDEV_INIT("dev:ssp0", NULL, &clk_ssp0),
  1038. CLKDEV_INIT("dev:ssp1", NULL, &clk_ssp1),
  1039. CLKDEV_INIT("40050000.key", NULL, &clk_kscan),
  1040. CLKDEV_INIT("20020000.flash", NULL, &clk_nand),
  1041. CLKDEV_INIT("200a8000.flash", NULL, &clk_nand_mlc),
  1042. CLKDEV_INIT("40048000.adc", NULL, &clk_adc),
  1043. CLKDEV_INIT(NULL, "i2s0_ck", &clk_i2s0),
  1044. CLKDEV_INIT(NULL, "i2s1_ck", &clk_i2s1),
  1045. CLKDEV_INIT("40048000.tsc", NULL, &clk_tsc),
  1046. CLKDEV_INIT("20098000.sd", NULL, &clk_mmc),
  1047. CLKDEV_INIT("31060000.ethernet", NULL, &clk_net),
  1048. CLKDEV_INIT("dev:clcd", NULL, &clk_lcd),
  1049. CLKDEV_INIT("31020000.usbd", "ck_usbd", &clk_usbd),
  1050. CLKDEV_INIT("31020000.ohci", "ck_usbd", &clk_usbd),
  1051. CLKDEV_INIT("31020000.usbd", "ck_usb_otg", &clk_usb_otg_dev),
  1052. CLKDEV_INIT("31020000.ohci", "ck_usb_otg", &clk_usb_otg_host),
  1053. CLKDEV_INIT("lpc32xx_rtc", NULL, &clk_rtc),
  1054. };
  1055. static int __init clk_init(void)
  1056. {
  1057. int i;
  1058. for (i = 0; i < ARRAY_SIZE(lookups); i++)
  1059. clkdev_add(&lookups[i]);
  1060. /*
  1061. * Setup muxed SYSCLK for HCLK PLL base -this selects the
  1062. * parent clock used for the ARM PLL and is used to derive
  1063. * the many system clock rates in the device.
  1064. */
  1065. if (clk_is_sysclk_mainosc() != 0)
  1066. clk_sys.parent = &osc_main;
  1067. else
  1068. clk_sys.parent = &osc_pll397;
  1069. clk_sys.rate = clk_sys.parent->rate;
  1070. /* Compute the current ARM PLL and USB PLL frequencies */
  1071. local_update_armpll_rate();
  1072. /* Compute HCLK and PCLK bus rates */
  1073. clk_hclk.rate = clk_hclk.parent->rate / clk_get_hclk_div();
  1074. clk_pclk.rate = clk_pclk.parent->rate / clk_get_pclk_div();
  1075. /*
  1076. * Enable system clocks - this step is somewhat formal, as the
  1077. * clocks are already running, but it does get the clock data
  1078. * inline with the actual system state. Never disable these
  1079. * clocks as they will only stop if the system is going to sleep.
  1080. * In that case, the chip/system power management functions will
  1081. * handle clock gating.
  1082. */
  1083. if (clk_enable(&clk_hclk) || clk_enable(&clk_pclk))
  1084. printk(KERN_ERR "Error enabling system HCLK and PCLK\n");
  1085. /*
  1086. * Timers 0 and 1 were enabled and are being used by the high
  1087. * resolution tick function prior to this driver being initialized.
  1088. * Tag them now as used.
  1089. */
  1090. if (clk_enable(&clk_timer0) || clk_enable(&clk_timer1))
  1091. printk(KERN_ERR "Error enabling timer tick clocks\n");
  1092. return 0;
  1093. }
  1094. core_initcall(clk_init);