clock.c 16 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686
  1. /* linux/arch/arm/mach-s5p6440/clock.c
  2. *
  3. * Copyright (c) 2009 Samsung Electronics Co., Ltd.
  4. * http://www.samsung.com/
  5. *
  6. * S5P6440 - Clock support
  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 version 2 as
  10. * published by the Free Software Foundation.
  11. */
  12. #include <linux/init.h>
  13. #include <linux/module.h>
  14. #include <linux/kernel.h>
  15. #include <linux/list.h>
  16. #include <linux/errno.h>
  17. #include <linux/err.h>
  18. #include <linux/clk.h>
  19. #include <linux/sysdev.h>
  20. #include <linux/io.h>
  21. #include <mach/hardware.h>
  22. #include <mach/map.h>
  23. #include <plat/cpu-freq.h>
  24. #include <mach/regs-clock.h>
  25. #include <plat/clock.h>
  26. #include <plat/cpu.h>
  27. #include <plat/clock-clksrc.h>
  28. #include <plat/s5p-clock.h>
  29. #include <plat/pll.h>
  30. #include <plat/s5p6440.h>
  31. /* APLL Mux output clock */
  32. static struct clksrc_clk clk_mout_apll = {
  33. .clk = {
  34. .name = "mout_apll",
  35. .id = -1,
  36. },
  37. .sources = &clk_src_apll,
  38. .reg_src = { .reg = S5P_CLK_SRC0, .shift = 0, .size = 1 },
  39. };
  40. static int s5p6440_epll_enable(struct clk *clk, int enable)
  41. {
  42. unsigned int ctrlbit = clk->ctrlbit;
  43. unsigned int epll_con = __raw_readl(S5P_EPLL_CON) & ~ctrlbit;
  44. if (enable)
  45. __raw_writel(epll_con | ctrlbit, S5P_EPLL_CON);
  46. else
  47. __raw_writel(epll_con, S5P_EPLL_CON);
  48. return 0;
  49. }
  50. static unsigned long s5p6440_epll_get_rate(struct clk *clk)
  51. {
  52. return clk->rate;
  53. }
  54. static u32 epll_div[][5] = {
  55. { 36000000, 0, 48, 1, 4 },
  56. { 48000000, 0, 32, 1, 3 },
  57. { 60000000, 0, 40, 1, 3 },
  58. { 72000000, 0, 48, 1, 3 },
  59. { 84000000, 0, 28, 1, 2 },
  60. { 96000000, 0, 32, 1, 2 },
  61. { 32768000, 45264, 43, 1, 4 },
  62. { 45158000, 6903, 30, 1, 3 },
  63. { 49152000, 50332, 32, 1, 3 },
  64. { 67738000, 10398, 45, 1, 3 },
  65. { 73728000, 9961, 49, 1, 3 }
  66. };
  67. static int s5p6440_epll_set_rate(struct clk *clk, unsigned long rate)
  68. {
  69. unsigned int epll_con, epll_con_k;
  70. unsigned int i;
  71. if (clk->rate == rate) /* Return if nothing changed */
  72. return 0;
  73. epll_con = __raw_readl(S5P_EPLL_CON);
  74. epll_con_k = __raw_readl(S5P_EPLL_CON_K);
  75. epll_con_k &= ~(PLL90XX_KDIV_MASK);
  76. epll_con &= ~(PLL90XX_MDIV_MASK | PLL90XX_PDIV_MASK | PLL90XX_SDIV_MASK);
  77. for (i = 0; i < ARRAY_SIZE(epll_div); i++) {
  78. if (epll_div[i][0] == rate) {
  79. epll_con_k |= (epll_div[i][1] << PLL90XX_KDIV_SHIFT);
  80. epll_con |= (epll_div[i][2] << PLL90XX_MDIV_SHIFT) |
  81. (epll_div[i][3] << PLL90XX_PDIV_SHIFT) |
  82. (epll_div[i][4] << PLL90XX_SDIV_SHIFT);
  83. break;
  84. }
  85. }
  86. if (i == ARRAY_SIZE(epll_div)) {
  87. printk(KERN_ERR "%s: Invalid Clock EPLL Frequency\n", __func__);
  88. return -EINVAL;
  89. }
  90. __raw_writel(epll_con, S5P_EPLL_CON);
  91. __raw_writel(epll_con_k, S5P_EPLL_CON_K);
  92. clk->rate = rate;
  93. return 0;
  94. }
  95. static struct clk_ops s5p6440_epll_ops = {
  96. .get_rate = s5p6440_epll_get_rate,
  97. .set_rate = s5p6440_epll_set_rate,
  98. };
  99. static struct clksrc_clk clk_mout_epll = {
  100. .clk = {
  101. .name = "mout_epll",
  102. .id = -1,
  103. },
  104. .sources = &clk_src_epll,
  105. .reg_src = { .reg = S5P_CLK_SRC0, .shift = 2, .size = 1 },
  106. };
  107. static struct clksrc_clk clk_mout_mpll = {
  108. .clk = {
  109. .name = "mout_mpll",
  110. .id = -1,
  111. },
  112. .sources = &clk_src_mpll,
  113. .reg_src = { .reg = S5P_CLK_SRC0, .shift = 1, .size = 1 },
  114. };
  115. static struct clk clk_h_low = {
  116. .name = "hclk_low",
  117. .id = -1,
  118. .rate = 0,
  119. .parent = NULL,
  120. .ctrlbit = 0,
  121. .ops = &clk_ops_def_setrate,
  122. };
  123. static struct clk clk_p_low = {
  124. .name = "pclk_low",
  125. .id = -1,
  126. .rate = 0,
  127. .parent = NULL,
  128. .ctrlbit = 0,
  129. .ops = &clk_ops_def_setrate,
  130. };
  131. enum perf_level {
  132. L0 = 532*1000,
  133. L1 = 266*1000,
  134. L2 = 133*1000,
  135. };
  136. static const u32 clock_table[][3] = {
  137. /*{ARM_CLK, DIVarm, DIVhclk}*/
  138. {L0 * 1000, (0 << ARM_DIV_RATIO_SHIFT), (3 << S5P_CLKDIV0_HCLK_SHIFT)},
  139. {L1 * 1000, (1 << ARM_DIV_RATIO_SHIFT), (1 << S5P_CLKDIV0_HCLK_SHIFT)},
  140. {L2 * 1000, (3 << ARM_DIV_RATIO_SHIFT), (0 << S5P_CLKDIV0_HCLK_SHIFT)},
  141. };
  142. static unsigned long s5p6440_armclk_get_rate(struct clk *clk)
  143. {
  144. unsigned long rate = clk_get_rate(clk->parent);
  145. u32 clkdiv;
  146. /* divisor mask starts at bit0, so no need to shift */
  147. clkdiv = __raw_readl(ARM_CLK_DIV) & ARM_DIV_MASK;
  148. return rate / (clkdiv + 1);
  149. }
  150. static unsigned long s5p6440_armclk_round_rate(struct clk *clk,
  151. unsigned long rate)
  152. {
  153. u32 iter;
  154. for (iter = 1 ; iter < ARRAY_SIZE(clock_table) ; iter++) {
  155. if (rate > clock_table[iter][0])
  156. return clock_table[iter-1][0];
  157. }
  158. return clock_table[ARRAY_SIZE(clock_table) - 1][0];
  159. }
  160. static int s5p6440_armclk_set_rate(struct clk *clk, unsigned long rate)
  161. {
  162. u32 round_tmp;
  163. u32 iter;
  164. u32 clk_div0_tmp;
  165. u32 cur_rate = clk->ops->get_rate(clk);
  166. unsigned long flags;
  167. round_tmp = clk->ops->round_rate(clk, rate);
  168. if (round_tmp == cur_rate)
  169. return 0;
  170. for (iter = 0 ; iter < ARRAY_SIZE(clock_table) ; iter++) {
  171. if (round_tmp == clock_table[iter][0])
  172. break;
  173. }
  174. if (iter >= ARRAY_SIZE(clock_table))
  175. iter = ARRAY_SIZE(clock_table) - 1;
  176. local_irq_save(flags);
  177. if (cur_rate > round_tmp) {
  178. /* Frequency Down */
  179. clk_div0_tmp = __raw_readl(ARM_CLK_DIV) & ~(ARM_DIV_MASK);
  180. clk_div0_tmp |= clock_table[iter][1];
  181. __raw_writel(clk_div0_tmp, ARM_CLK_DIV);
  182. clk_div0_tmp = __raw_readl(ARM_CLK_DIV) &
  183. ~(S5P_CLKDIV0_HCLK_MASK);
  184. clk_div0_tmp |= clock_table[iter][2];
  185. __raw_writel(clk_div0_tmp, ARM_CLK_DIV);
  186. } else {
  187. /* Frequency Up */
  188. clk_div0_tmp = __raw_readl(ARM_CLK_DIV) &
  189. ~(S5P_CLKDIV0_HCLK_MASK);
  190. clk_div0_tmp |= clock_table[iter][2];
  191. __raw_writel(clk_div0_tmp, ARM_CLK_DIV);
  192. clk_div0_tmp = __raw_readl(ARM_CLK_DIV) & ~(ARM_DIV_MASK);
  193. clk_div0_tmp |= clock_table[iter][1];
  194. __raw_writel(clk_div0_tmp, ARM_CLK_DIV);
  195. }
  196. local_irq_restore(flags);
  197. clk->rate = clock_table[iter][0];
  198. return 0;
  199. }
  200. static struct clk_ops s5p6440_clkarm_ops = {
  201. .get_rate = s5p6440_armclk_get_rate,
  202. .set_rate = s5p6440_armclk_set_rate,
  203. .round_rate = s5p6440_armclk_round_rate,
  204. };
  205. static struct clksrc_clk clk_dout_mpll = {
  206. .clk = {
  207. .name = "dout_mpll",
  208. .id = -1,
  209. .parent = &clk_mout_mpll.clk,
  210. },
  211. .reg_div = { .reg = S5P_CLK_DIV0, .shift = 4, .size = 1 },
  212. };
  213. int s5p6440_clk48m_ctrl(struct clk *clk, int enable)
  214. {
  215. unsigned long flags;
  216. u32 val;
  217. /* can't rely on clock lock, this register has other usages */
  218. local_irq_save(flags);
  219. val = __raw_readl(S5P_OTHERS);
  220. if (enable)
  221. val |= S5P_OTHERS_USB_SIG_MASK;
  222. else
  223. val &= ~S5P_OTHERS_USB_SIG_MASK;
  224. __raw_writel(val, S5P_OTHERS);
  225. local_irq_restore(flags);
  226. return 0;
  227. }
  228. static int s5p6440_pclk_ctrl(struct clk *clk, int enable)
  229. {
  230. return s5p_gatectrl(S5P_CLK_GATE_PCLK, clk, enable);
  231. }
  232. static int s5p6440_hclk0_ctrl(struct clk *clk, int enable)
  233. {
  234. return s5p_gatectrl(S5P_CLK_GATE_HCLK0, clk, enable);
  235. }
  236. static int s5p6440_hclk1_ctrl(struct clk *clk, int enable)
  237. {
  238. return s5p_gatectrl(S5P_CLK_GATE_HCLK1, clk, enable);
  239. }
  240. static int s5p6440_sclk_ctrl(struct clk *clk, int enable)
  241. {
  242. return s5p_gatectrl(S5P_CLK_GATE_SCLK0, clk, enable);
  243. }
  244. static int s5p6440_mem_ctrl(struct clk *clk, int enable)
  245. {
  246. return s5p_gatectrl(S5P_CLK_GATE_MEM0, clk, enable);
  247. }
  248. /*
  249. * The following clocks will be disabled during clock initialization. It is
  250. * recommended to keep the following clocks disabled until the driver requests
  251. * for enabling the clock.
  252. */
  253. static struct clk init_clocks_disable[] = {
  254. {
  255. .name = "nand",
  256. .id = -1,
  257. .parent = &clk_h,
  258. .enable = s5p6440_mem_ctrl,
  259. .ctrlbit = S5P_CLKCON_MEM0_HCLK_NFCON,
  260. }, {
  261. .name = "adc",
  262. .id = -1,
  263. .parent = &clk_p_low,
  264. .enable = s5p6440_pclk_ctrl,
  265. .ctrlbit = S5P_CLKCON_PCLK_TSADC,
  266. }, {
  267. .name = "i2c",
  268. .id = -1,
  269. .parent = &clk_p_low,
  270. .enable = s5p6440_pclk_ctrl,
  271. .ctrlbit = S5P_CLKCON_PCLK_IIC0,
  272. }, {
  273. .name = "i2s_v40",
  274. .id = 0,
  275. .parent = &clk_p_low,
  276. .enable = s5p6440_pclk_ctrl,
  277. .ctrlbit = S5P_CLKCON_PCLK_IIS2,
  278. }, {
  279. .name = "spi",
  280. .id = 0,
  281. .parent = &clk_p_low,
  282. .enable = s5p6440_pclk_ctrl,
  283. .ctrlbit = S5P_CLKCON_PCLK_SPI0,
  284. }, {
  285. .name = "spi",
  286. .id = 1,
  287. .parent = &clk_p_low,
  288. .enable = s5p6440_pclk_ctrl,
  289. .ctrlbit = S5P_CLKCON_PCLK_SPI1,
  290. }, {
  291. .name = "sclk_spi_48",
  292. .id = 0,
  293. .parent = &clk_48m,
  294. .enable = s5p6440_sclk_ctrl,
  295. .ctrlbit = S5P_CLKCON_SCLK0_SPI0_48,
  296. }, {
  297. .name = "sclk_spi_48",
  298. .id = 1,
  299. .parent = &clk_48m,
  300. .enable = s5p6440_sclk_ctrl,
  301. .ctrlbit = S5P_CLKCON_SCLK0_SPI1_48,
  302. }, {
  303. .name = "mmc_48m",
  304. .id = 0,
  305. .parent = &clk_48m,
  306. .enable = s5p6440_sclk_ctrl,
  307. .ctrlbit = S5P_CLKCON_SCLK0_MMC0_48,
  308. }, {
  309. .name = "mmc_48m",
  310. .id = 1,
  311. .parent = &clk_48m,
  312. .enable = s5p6440_sclk_ctrl,
  313. .ctrlbit = S5P_CLKCON_SCLK0_MMC1_48,
  314. }, {
  315. .name = "mmc_48m",
  316. .id = 2,
  317. .parent = &clk_48m,
  318. .enable = s5p6440_sclk_ctrl,
  319. .ctrlbit = S5P_CLKCON_SCLK0_MMC2_48,
  320. }, {
  321. .name = "otg",
  322. .id = -1,
  323. .parent = &clk_h_low,
  324. .enable = s5p6440_hclk0_ctrl,
  325. .ctrlbit = S5P_CLKCON_HCLK0_USB
  326. }, {
  327. .name = "post",
  328. .id = -1,
  329. .parent = &clk_h_low,
  330. .enable = s5p6440_hclk0_ctrl,
  331. .ctrlbit = S5P_CLKCON_HCLK0_POST0
  332. }, {
  333. .name = "lcd",
  334. .id = -1,
  335. .parent = &clk_h_low,
  336. .enable = s5p6440_hclk1_ctrl,
  337. .ctrlbit = S5P_CLKCON_HCLK1_DISPCON,
  338. }, {
  339. .name = "hsmmc",
  340. .id = 0,
  341. .parent = &clk_h_low,
  342. .enable = s5p6440_hclk0_ctrl,
  343. .ctrlbit = S5P_CLKCON_HCLK0_HSMMC0,
  344. }, {
  345. .name = "hsmmc",
  346. .id = 1,
  347. .parent = &clk_h_low,
  348. .enable = s5p6440_hclk0_ctrl,
  349. .ctrlbit = S5P_CLKCON_HCLK0_HSMMC1,
  350. }, {
  351. .name = "hsmmc",
  352. .id = 2,
  353. .parent = &clk_h_low,
  354. .enable = s5p6440_hclk0_ctrl,
  355. .ctrlbit = S5P_CLKCON_HCLK0_HSMMC2,
  356. }, {
  357. .name = "rtc",
  358. .id = -1,
  359. .parent = &clk_p_low,
  360. .enable = s5p6440_pclk_ctrl,
  361. .ctrlbit = S5P_CLKCON_PCLK_RTC,
  362. }, {
  363. .name = "watchdog",
  364. .id = -1,
  365. .parent = &clk_p_low,
  366. .enable = s5p6440_pclk_ctrl,
  367. .ctrlbit = S5P_CLKCON_PCLK_WDT,
  368. }, {
  369. .name = "timers",
  370. .id = -1,
  371. .parent = &clk_p_low,
  372. .enable = s5p6440_pclk_ctrl,
  373. .ctrlbit = S5P_CLKCON_PCLK_PWM,
  374. }
  375. };
  376. /*
  377. * The following clocks will be enabled during clock initialization.
  378. */
  379. static struct clk init_clocks[] = {
  380. {
  381. .name = "gpio",
  382. .id = -1,
  383. .parent = &clk_p_low,
  384. .enable = s5p6440_pclk_ctrl,
  385. .ctrlbit = S5P_CLKCON_PCLK_GPIO,
  386. }, {
  387. .name = "uart",
  388. .id = 0,
  389. .parent = &clk_p_low,
  390. .enable = s5p6440_pclk_ctrl,
  391. .ctrlbit = S5P_CLKCON_PCLK_UART0,
  392. }, {
  393. .name = "uart",
  394. .id = 1,
  395. .parent = &clk_p_low,
  396. .enable = s5p6440_pclk_ctrl,
  397. .ctrlbit = S5P_CLKCON_PCLK_UART1,
  398. }, {
  399. .name = "uart",
  400. .id = 2,
  401. .parent = &clk_p_low,
  402. .enable = s5p6440_pclk_ctrl,
  403. .ctrlbit = S5P_CLKCON_PCLK_UART2,
  404. }, {
  405. .name = "uart",
  406. .id = 3,
  407. .parent = &clk_p_low,
  408. .enable = s5p6440_pclk_ctrl,
  409. .ctrlbit = S5P_CLKCON_PCLK_UART3,
  410. }
  411. };
  412. static struct clk clk_iis_cd_v40 = {
  413. .name = "iis_cdclk_v40",
  414. .id = -1,
  415. };
  416. static struct clk clk_pcm_cd = {
  417. .name = "pcm_cdclk",
  418. .id = -1,
  419. };
  420. static struct clk *clkset_spi_mmc_list[] = {
  421. &clk_mout_epll.clk,
  422. &clk_dout_mpll.clk,
  423. &clk_fin_epll,
  424. };
  425. static struct clksrc_sources clkset_spi_mmc = {
  426. .sources = clkset_spi_mmc_list,
  427. .nr_sources = ARRAY_SIZE(clkset_spi_mmc_list),
  428. };
  429. static struct clk *clkset_uart_list[] = {
  430. &clk_mout_epll.clk,
  431. &clk_dout_mpll.clk,
  432. };
  433. static struct clksrc_sources clkset_uart = {
  434. .sources = clkset_uart_list,
  435. .nr_sources = ARRAY_SIZE(clkset_uart_list),
  436. };
  437. static struct clksrc_clk clksrcs[] = {
  438. {
  439. .clk = {
  440. .name = "mmc_bus",
  441. .id = 0,
  442. .ctrlbit = S5P_CLKCON_SCLK0_MMC0,
  443. .enable = s5p6440_sclk_ctrl,
  444. },
  445. .sources = &clkset_spi_mmc,
  446. .reg_src = { .reg = S5P_CLK_SRC0, .shift = 18, .size = 2 },
  447. .reg_div = { .reg = S5P_CLK_DIV1, .shift = 0, .size = 4 },
  448. }, {
  449. .clk = {
  450. .name = "mmc_bus",
  451. .id = 1,
  452. .ctrlbit = S5P_CLKCON_SCLK0_MMC1,
  453. .enable = s5p6440_sclk_ctrl,
  454. },
  455. .sources = &clkset_spi_mmc,
  456. .reg_src = { .reg = S5P_CLK_SRC0, .shift = 20, .size = 2 },
  457. .reg_div = { .reg = S5P_CLK_DIV1, .shift = 4, .size = 4 },
  458. }, {
  459. .clk = {
  460. .name = "mmc_bus",
  461. .id = 2,
  462. .ctrlbit = S5P_CLKCON_SCLK0_MMC2,
  463. .enable = s5p6440_sclk_ctrl,
  464. },
  465. .sources = &clkset_spi_mmc,
  466. .reg_src = { .reg = S5P_CLK_SRC0, .shift = 22, .size = 2 },
  467. .reg_div = { .reg = S5P_CLK_DIV1, .shift = 8, .size = 4 },
  468. }, {
  469. .clk = {
  470. .name = "uclk1",
  471. .id = -1,
  472. .ctrlbit = S5P_CLKCON_SCLK0_UART,
  473. .enable = s5p6440_sclk_ctrl,
  474. },
  475. .sources = &clkset_uart,
  476. .reg_src = { .reg = S5P_CLK_SRC0, .shift = 13, .size = 1 },
  477. .reg_div = { .reg = S5P_CLK_DIV2, .shift = 16, .size = 4 },
  478. }, {
  479. .clk = {
  480. .name = "spi_epll",
  481. .id = 0,
  482. .ctrlbit = S5P_CLKCON_SCLK0_SPI0,
  483. .enable = s5p6440_sclk_ctrl,
  484. },
  485. .sources = &clkset_spi_mmc,
  486. .reg_src = { .reg = S5P_CLK_SRC0, .shift = 14, .size = 2 },
  487. .reg_div = { .reg = S5P_CLK_DIV2, .shift = 0, .size = 4 },
  488. }, {
  489. .clk = {
  490. .name = "spi_epll",
  491. .id = 1,
  492. .ctrlbit = S5P_CLKCON_SCLK0_SPI1,
  493. .enable = s5p6440_sclk_ctrl,
  494. },
  495. .sources = &clkset_spi_mmc,
  496. .reg_src = { .reg = S5P_CLK_SRC0, .shift = 16, .size = 2 },
  497. .reg_div = { .reg = S5P_CLK_DIV2, .shift = 4, .size = 4 },
  498. }
  499. };
  500. /* Clock initialisation code */
  501. static struct clksrc_clk *sysclks[] = {
  502. &clk_mout_apll,
  503. &clk_mout_epll,
  504. &clk_mout_mpll,
  505. &clk_dout_mpll,
  506. };
  507. void __init_or_cpufreq s5p6440_setup_clocks(void)
  508. {
  509. struct clk *xtal_clk;
  510. unsigned long xtal;
  511. unsigned long fclk;
  512. unsigned long hclk;
  513. unsigned long hclk_low;
  514. unsigned long pclk;
  515. unsigned long pclk_low;
  516. unsigned long epll;
  517. unsigned long apll;
  518. unsigned long mpll;
  519. unsigned int ptr;
  520. u32 clkdiv0;
  521. u32 clkdiv3;
  522. /* Set S5P6440 functions for clk_fout_epll */
  523. clk_fout_epll.enable = s5p6440_epll_enable;
  524. clk_fout_epll.ops = &s5p6440_epll_ops;
  525. /* Set S5P6440 functions for arm clock */
  526. clk_arm.parent = &clk_mout_apll.clk;
  527. clk_arm.ops = &s5p6440_clkarm_ops;
  528. clk_48m.enable = s5p6440_clk48m_ctrl;
  529. clkdiv0 = __raw_readl(S5P_CLK_DIV0);
  530. clkdiv3 = __raw_readl(S5P_CLK_DIV3);
  531. xtal_clk = clk_get(NULL, "ext_xtal");
  532. BUG_ON(IS_ERR(xtal_clk));
  533. xtal = clk_get_rate(xtal_clk);
  534. clk_put(xtal_clk);
  535. epll = s5p_get_pll90xx(xtal, __raw_readl(S5P_EPLL_CON),
  536. __raw_readl(S5P_EPLL_CON_K));
  537. mpll = s5p_get_pll45xx(xtal, __raw_readl(S5P_MPLL_CON), pll_4502);
  538. apll = s5p_get_pll45xx(xtal, __raw_readl(S5P_APLL_CON), pll_4502);
  539. printk(KERN_INFO "S5P6440: PLL settings, A=%ld.%ldMHz, M=%ld.%ldMHz," \
  540. " E=%ld.%ldMHz\n",
  541. print_mhz(apll), print_mhz(mpll), print_mhz(epll));
  542. fclk = apll / GET_DIV(clkdiv0, S5P_CLKDIV0_ARM);
  543. hclk = fclk / GET_DIV(clkdiv0, S5P_CLKDIV0_HCLK);
  544. pclk = hclk / GET_DIV(clkdiv0, S5P_CLKDIV0_PCLK);
  545. if (__raw_readl(S5P_OTHERS) & S5P_OTHERS_HCLK_LOW_SEL_MPLL) {
  546. /* Asynchronous mode */
  547. hclk_low = mpll / GET_DIV(clkdiv3, S5P_CLKDIV3_HCLK_LOW);
  548. } else {
  549. /* Synchronous mode */
  550. hclk_low = apll / GET_DIV(clkdiv3, S5P_CLKDIV3_HCLK_LOW);
  551. }
  552. pclk_low = hclk_low / GET_DIV(clkdiv3, S5P_CLKDIV3_PCLK_LOW);
  553. printk(KERN_INFO "S5P6440: HCLK=%ld.%ldMHz, HCLK_LOW=%ld.%ldMHz," \
  554. " PCLK=%ld.%ldMHz, PCLK_LOW=%ld.%ldMHz\n",
  555. print_mhz(hclk), print_mhz(hclk_low),
  556. print_mhz(pclk), print_mhz(pclk_low));
  557. clk_fout_mpll.rate = mpll;
  558. clk_fout_epll.rate = epll;
  559. clk_fout_apll.rate = apll;
  560. clk_f.rate = fclk;
  561. clk_h.rate = hclk;
  562. clk_p.rate = pclk;
  563. clk_h_low.rate = hclk_low;
  564. clk_p_low.rate = pclk_low;
  565. for (ptr = 0; ptr < ARRAY_SIZE(clksrcs); ptr++)
  566. s3c_set_clksrc(&clksrcs[ptr], true);
  567. }
  568. static struct clk *clks[] __initdata = {
  569. &clk_ext,
  570. &clk_iis_cd_v40,
  571. &clk_pcm_cd,
  572. &clk_p_low,
  573. &clk_h_low,
  574. };
  575. void __init s5p6440_register_clocks(void)
  576. {
  577. struct clk *clkp;
  578. int ret;
  579. int ptr;
  580. ret = s3c24xx_register_clocks(clks, ARRAY_SIZE(clks));
  581. if (ret > 0)
  582. printk(KERN_ERR "Failed to register %u clocks\n", ret);
  583. for (ptr = 0; ptr < ARRAY_SIZE(sysclks); ptr++)
  584. s3c_register_clksrc(sysclks[ptr], 1);
  585. s3c_register_clksrc(clksrcs, ARRAY_SIZE(clksrcs));
  586. s3c_register_clocks(init_clocks, ARRAY_SIZE(init_clocks));
  587. clkp = init_clocks_disable;
  588. for (ptr = 0; ptr < ARRAY_SIZE(init_clocks_disable); ptr++, clkp++) {
  589. ret = s3c24xx_register_clock(clkp);
  590. if (ret < 0) {
  591. printk(KERN_ERR "Failed to register clock %s (%d)\n",
  592. clkp->name, ret);
  593. }
  594. (clkp->enable)(clkp, 0);
  595. }
  596. s3c_pwmclk_init();
  597. }