clock.c 16 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698
  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 unsigned long s5p6440_clk_doutmpll_get_rate(struct clk *clk)
  206. {
  207. unsigned long rate = clk_get_rate(clk->parent);
  208. if (__raw_readl(S5P_CLK_DIV0) & S5P_CLKDIV0_MPLL_MASK)
  209. rate /= 2;
  210. return rate;
  211. }
  212. static struct clk clk_dout_mpll = {
  213. .name = "dout_mpll",
  214. .id = -1,
  215. .parent = &clk_mout_mpll.clk,
  216. .ops = &(struct clk_ops) {
  217. .get_rate = s5p6440_clk_doutmpll_get_rate,
  218. },
  219. };
  220. int s5p6440_clk48m_ctrl(struct clk *clk, int enable)
  221. {
  222. unsigned long flags;
  223. u32 val;
  224. /* can't rely on clock lock, this register has other usages */
  225. local_irq_save(flags);
  226. val = __raw_readl(S5P_OTHERS);
  227. if (enable)
  228. val |= S5P_OTHERS_USB_SIG_MASK;
  229. else
  230. val &= ~S5P_OTHERS_USB_SIG_MASK;
  231. __raw_writel(val, S5P_OTHERS);
  232. local_irq_restore(flags);
  233. return 0;
  234. }
  235. static int s5p6440_pclk_ctrl(struct clk *clk, int enable)
  236. {
  237. return s5p_gatectrl(S5P_CLK_GATE_PCLK, clk, enable);
  238. }
  239. static int s5p6440_hclk0_ctrl(struct clk *clk, int enable)
  240. {
  241. return s5p_gatectrl(S5P_CLK_GATE_HCLK0, clk, enable);
  242. }
  243. static int s5p6440_hclk1_ctrl(struct clk *clk, int enable)
  244. {
  245. return s5p_gatectrl(S5P_CLK_GATE_HCLK1, clk, enable);
  246. }
  247. static int s5p6440_sclk_ctrl(struct clk *clk, int enable)
  248. {
  249. return s5p_gatectrl(S5P_CLK_GATE_SCLK0, clk, enable);
  250. }
  251. static int s5p6440_mem_ctrl(struct clk *clk, int enable)
  252. {
  253. return s5p_gatectrl(S5P_CLK_GATE_MEM0, clk, enable);
  254. }
  255. /*
  256. * The following clocks will be disabled during clock initialization. It is
  257. * recommended to keep the following clocks disabled until the driver requests
  258. * for enabling the clock.
  259. */
  260. static struct clk init_clocks_disable[] = {
  261. {
  262. .name = "nand",
  263. .id = -1,
  264. .parent = &clk_h,
  265. .enable = s5p6440_mem_ctrl,
  266. .ctrlbit = S5P_CLKCON_MEM0_HCLK_NFCON,
  267. }, {
  268. .name = "adc",
  269. .id = -1,
  270. .parent = &clk_p_low,
  271. .enable = s5p6440_pclk_ctrl,
  272. .ctrlbit = S5P_CLKCON_PCLK_TSADC,
  273. }, {
  274. .name = "i2c",
  275. .id = -1,
  276. .parent = &clk_p_low,
  277. .enable = s5p6440_pclk_ctrl,
  278. .ctrlbit = S5P_CLKCON_PCLK_IIC0,
  279. }, {
  280. .name = "i2s_v40",
  281. .id = 0,
  282. .parent = &clk_p_low,
  283. .enable = s5p6440_pclk_ctrl,
  284. .ctrlbit = S5P_CLKCON_PCLK_IIS2,
  285. }, {
  286. .name = "spi",
  287. .id = 0,
  288. .parent = &clk_p_low,
  289. .enable = s5p6440_pclk_ctrl,
  290. .ctrlbit = S5P_CLKCON_PCLK_SPI0,
  291. }, {
  292. .name = "spi",
  293. .id = 1,
  294. .parent = &clk_p_low,
  295. .enable = s5p6440_pclk_ctrl,
  296. .ctrlbit = S5P_CLKCON_PCLK_SPI1,
  297. }, {
  298. .name = "sclk_spi_48",
  299. .id = 0,
  300. .parent = &clk_48m,
  301. .enable = s5p6440_sclk_ctrl,
  302. .ctrlbit = S5P_CLKCON_SCLK0_SPI0_48,
  303. }, {
  304. .name = "sclk_spi_48",
  305. .id = 1,
  306. .parent = &clk_48m,
  307. .enable = s5p6440_sclk_ctrl,
  308. .ctrlbit = S5P_CLKCON_SCLK0_SPI1_48,
  309. }, {
  310. .name = "mmc_48m",
  311. .id = 0,
  312. .parent = &clk_48m,
  313. .enable = s5p6440_sclk_ctrl,
  314. .ctrlbit = S5P_CLKCON_SCLK0_MMC0_48,
  315. }, {
  316. .name = "mmc_48m",
  317. .id = 1,
  318. .parent = &clk_48m,
  319. .enable = s5p6440_sclk_ctrl,
  320. .ctrlbit = S5P_CLKCON_SCLK0_MMC1_48,
  321. }, {
  322. .name = "mmc_48m",
  323. .id = 2,
  324. .parent = &clk_48m,
  325. .enable = s5p6440_sclk_ctrl,
  326. .ctrlbit = S5P_CLKCON_SCLK0_MMC2_48,
  327. }, {
  328. .name = "otg",
  329. .id = -1,
  330. .parent = &clk_h_low,
  331. .enable = s5p6440_hclk0_ctrl,
  332. .ctrlbit = S5P_CLKCON_HCLK0_USB
  333. }, {
  334. .name = "post",
  335. .id = -1,
  336. .parent = &clk_h_low,
  337. .enable = s5p6440_hclk0_ctrl,
  338. .ctrlbit = S5P_CLKCON_HCLK0_POST0
  339. }, {
  340. .name = "lcd",
  341. .id = -1,
  342. .parent = &clk_h_low,
  343. .enable = s5p6440_hclk1_ctrl,
  344. .ctrlbit = S5P_CLKCON_HCLK1_DISPCON,
  345. }, {
  346. .name = "hsmmc",
  347. .id = 0,
  348. .parent = &clk_h_low,
  349. .enable = s5p6440_hclk0_ctrl,
  350. .ctrlbit = S5P_CLKCON_HCLK0_HSMMC0,
  351. }, {
  352. .name = "hsmmc",
  353. .id = 1,
  354. .parent = &clk_h_low,
  355. .enable = s5p6440_hclk0_ctrl,
  356. .ctrlbit = S5P_CLKCON_HCLK0_HSMMC1,
  357. }, {
  358. .name = "hsmmc",
  359. .id = 2,
  360. .parent = &clk_h_low,
  361. .enable = s5p6440_hclk0_ctrl,
  362. .ctrlbit = S5P_CLKCON_HCLK0_HSMMC2,
  363. }, {
  364. .name = "rtc",
  365. .id = -1,
  366. .parent = &clk_p_low,
  367. .enable = s5p6440_pclk_ctrl,
  368. .ctrlbit = S5P_CLKCON_PCLK_RTC,
  369. }, {
  370. .name = "watchdog",
  371. .id = -1,
  372. .parent = &clk_p_low,
  373. .enable = s5p6440_pclk_ctrl,
  374. .ctrlbit = S5P_CLKCON_PCLK_WDT,
  375. }, {
  376. .name = "timers",
  377. .id = -1,
  378. .parent = &clk_p_low,
  379. .enable = s5p6440_pclk_ctrl,
  380. .ctrlbit = S5P_CLKCON_PCLK_PWM,
  381. }
  382. };
  383. /*
  384. * The following clocks will be enabled during clock initialization.
  385. */
  386. static struct clk init_clocks[] = {
  387. {
  388. .name = "gpio",
  389. .id = -1,
  390. .parent = &clk_p_low,
  391. .enable = s5p6440_pclk_ctrl,
  392. .ctrlbit = S5P_CLKCON_PCLK_GPIO,
  393. }, {
  394. .name = "uart",
  395. .id = 0,
  396. .parent = &clk_p_low,
  397. .enable = s5p6440_pclk_ctrl,
  398. .ctrlbit = S5P_CLKCON_PCLK_UART0,
  399. }, {
  400. .name = "uart",
  401. .id = 1,
  402. .parent = &clk_p_low,
  403. .enable = s5p6440_pclk_ctrl,
  404. .ctrlbit = S5P_CLKCON_PCLK_UART1,
  405. }, {
  406. .name = "uart",
  407. .id = 2,
  408. .parent = &clk_p_low,
  409. .enable = s5p6440_pclk_ctrl,
  410. .ctrlbit = S5P_CLKCON_PCLK_UART2,
  411. }, {
  412. .name = "uart",
  413. .id = 3,
  414. .parent = &clk_p_low,
  415. .enable = s5p6440_pclk_ctrl,
  416. .ctrlbit = S5P_CLKCON_PCLK_UART3,
  417. }
  418. };
  419. static struct clk clk_iis_cd_v40 = {
  420. .name = "iis_cdclk_v40",
  421. .id = -1,
  422. };
  423. static struct clk clk_pcm_cd = {
  424. .name = "pcm_cdclk",
  425. .id = -1,
  426. };
  427. static struct clk *clkset_spi_mmc_list[] = {
  428. &clk_mout_epll.clk,
  429. &clk_dout_mpll,
  430. &clk_fin_epll,
  431. };
  432. static struct clksrc_sources clkset_spi_mmc = {
  433. .sources = clkset_spi_mmc_list,
  434. .nr_sources = ARRAY_SIZE(clkset_spi_mmc_list),
  435. };
  436. static struct clk *clkset_uart_list[] = {
  437. &clk_mout_epll.clk,
  438. &clk_dout_mpll
  439. };
  440. static struct clksrc_sources clkset_uart = {
  441. .sources = clkset_uart_list,
  442. .nr_sources = ARRAY_SIZE(clkset_uart_list),
  443. };
  444. static struct clksrc_clk clksrcs[] = {
  445. {
  446. .clk = {
  447. .name = "mmc_bus",
  448. .id = 0,
  449. .ctrlbit = S5P_CLKCON_SCLK0_MMC0,
  450. .enable = s5p6440_sclk_ctrl,
  451. },
  452. .sources = &clkset_spi_mmc,
  453. .reg_src = { .reg = S5P_CLK_SRC0, .shift = 18, .size = 2 },
  454. .reg_div = { .reg = S5P_CLK_DIV1, .shift = 0, .size = 4 },
  455. }, {
  456. .clk = {
  457. .name = "mmc_bus",
  458. .id = 1,
  459. .ctrlbit = S5P_CLKCON_SCLK0_MMC1,
  460. .enable = s5p6440_sclk_ctrl,
  461. },
  462. .sources = &clkset_spi_mmc,
  463. .reg_src = { .reg = S5P_CLK_SRC0, .shift = 20, .size = 2 },
  464. .reg_div = { .reg = S5P_CLK_DIV1, .shift = 4, .size = 4 },
  465. }, {
  466. .clk = {
  467. .name = "mmc_bus",
  468. .id = 2,
  469. .ctrlbit = S5P_CLKCON_SCLK0_MMC2,
  470. .enable = s5p6440_sclk_ctrl,
  471. },
  472. .sources = &clkset_spi_mmc,
  473. .reg_src = { .reg = S5P_CLK_SRC0, .shift = 22, .size = 2 },
  474. .reg_div = { .reg = S5P_CLK_DIV1, .shift = 8, .size = 4 },
  475. }, {
  476. .clk = {
  477. .name = "uclk1",
  478. .id = -1,
  479. .ctrlbit = S5P_CLKCON_SCLK0_UART,
  480. .enable = s5p6440_sclk_ctrl,
  481. },
  482. .sources = &clkset_uart,
  483. .reg_src = { .reg = S5P_CLK_SRC0, .shift = 13, .size = 1 },
  484. .reg_div = { .reg = S5P_CLK_DIV2, .shift = 16, .size = 4 },
  485. }, {
  486. .clk = {
  487. .name = "spi_epll",
  488. .id = 0,
  489. .ctrlbit = S5P_CLKCON_SCLK0_SPI0,
  490. .enable = s5p6440_sclk_ctrl,
  491. },
  492. .sources = &clkset_spi_mmc,
  493. .reg_src = { .reg = S5P_CLK_SRC0, .shift = 14, .size = 2 },
  494. .reg_div = { .reg = S5P_CLK_DIV2, .shift = 0, .size = 4 },
  495. }, {
  496. .clk = {
  497. .name = "spi_epll",
  498. .id = 1,
  499. .ctrlbit = S5P_CLKCON_SCLK0_SPI1,
  500. .enable = s5p6440_sclk_ctrl,
  501. },
  502. .sources = &clkset_spi_mmc,
  503. .reg_src = { .reg = S5P_CLK_SRC0, .shift = 16, .size = 2 },
  504. .reg_div = { .reg = S5P_CLK_DIV2, .shift = 4, .size = 4 },
  505. }
  506. };
  507. /* Clock initialisation code */
  508. static struct clksrc_clk *init_parents[] = {
  509. &clk_mout_apll,
  510. &clk_mout_epll,
  511. &clk_mout_mpll,
  512. };
  513. void __init_or_cpufreq s5p6440_setup_clocks(void)
  514. {
  515. struct clk *xtal_clk;
  516. unsigned long xtal;
  517. unsigned long fclk;
  518. unsigned long hclk;
  519. unsigned long hclk_low;
  520. unsigned long pclk;
  521. unsigned long pclk_low;
  522. unsigned long epll;
  523. unsigned long apll;
  524. unsigned long mpll;
  525. unsigned int ptr;
  526. u32 clkdiv0;
  527. u32 clkdiv3;
  528. /* Set S5P6440 functions for clk_fout_epll */
  529. clk_fout_epll.enable = s5p6440_epll_enable;
  530. clk_fout_epll.ops = &s5p6440_epll_ops;
  531. /* Set S5P6440 functions for arm clock */
  532. clk_arm.parent = &clk_mout_apll.clk;
  533. clk_arm.ops = &s5p6440_clkarm_ops;
  534. clk_48m.enable = s5p6440_clk48m_ctrl;
  535. clkdiv0 = __raw_readl(S5P_CLK_DIV0);
  536. clkdiv3 = __raw_readl(S5P_CLK_DIV3);
  537. xtal_clk = clk_get(NULL, "ext_xtal");
  538. BUG_ON(IS_ERR(xtal_clk));
  539. xtal = clk_get_rate(xtal_clk);
  540. clk_put(xtal_clk);
  541. epll = s5p_get_pll90xx(xtal, __raw_readl(S5P_EPLL_CON),
  542. __raw_readl(S5P_EPLL_CON_K));
  543. mpll = s5p_get_pll45xx(xtal, __raw_readl(S5P_MPLL_CON), pll_4502);
  544. apll = s5p_get_pll45xx(xtal, __raw_readl(S5P_APLL_CON), pll_4502);
  545. printk(KERN_INFO "S5P6440: PLL settings, A=%ld.%ldMHz, M=%ld.%ldMHz," \
  546. " E=%ld.%ldMHz\n",
  547. print_mhz(apll), print_mhz(mpll), print_mhz(epll));
  548. fclk = apll / GET_DIV(clkdiv0, S5P_CLKDIV0_ARM);
  549. hclk = fclk / GET_DIV(clkdiv0, S5P_CLKDIV0_HCLK);
  550. pclk = hclk / GET_DIV(clkdiv0, S5P_CLKDIV0_PCLK);
  551. if (__raw_readl(S5P_OTHERS) & S5P_OTHERS_HCLK_LOW_SEL_MPLL) {
  552. /* Asynchronous mode */
  553. hclk_low = mpll / GET_DIV(clkdiv3, S5P_CLKDIV3_HCLK_LOW);
  554. } else {
  555. /* Synchronous mode */
  556. hclk_low = apll / GET_DIV(clkdiv3, S5P_CLKDIV3_HCLK_LOW);
  557. }
  558. pclk_low = hclk_low / GET_DIV(clkdiv3, S5P_CLKDIV3_PCLK_LOW);
  559. printk(KERN_INFO "S5P6440: HCLK=%ld.%ldMHz, HCLK_LOW=%ld.%ldMHz," \
  560. " PCLK=%ld.%ldMHz, PCLK_LOW=%ld.%ldMHz\n",
  561. print_mhz(hclk), print_mhz(hclk_low),
  562. print_mhz(pclk), print_mhz(pclk_low));
  563. clk_fout_mpll.rate = mpll;
  564. clk_fout_epll.rate = epll;
  565. clk_fout_apll.rate = apll;
  566. clk_f.rate = fclk;
  567. clk_h.rate = hclk;
  568. clk_p.rate = pclk;
  569. clk_h_low.rate = hclk_low;
  570. clk_p_low.rate = pclk_low;
  571. for (ptr = 0; ptr < ARRAY_SIZE(init_parents); ptr++)
  572. s3c_set_clksrc(init_parents[ptr], true);
  573. for (ptr = 0; ptr < ARRAY_SIZE(clksrcs); ptr++)
  574. s3c_set_clksrc(&clksrcs[ptr], true);
  575. }
  576. static struct clk *clks[] __initdata = {
  577. &clk_ext,
  578. &clk_mout_epll.clk,
  579. &clk_mout_mpll.clk,
  580. &clk_dout_mpll,
  581. &clk_iis_cd_v40,
  582. &clk_pcm_cd,
  583. &clk_p_low,
  584. &clk_h_low,
  585. };
  586. void __init s5p6440_register_clocks(void)
  587. {
  588. struct clk *clkp;
  589. int ret;
  590. int ptr;
  591. ret = s3c24xx_register_clocks(clks, ARRAY_SIZE(clks));
  592. if (ret > 0)
  593. printk(KERN_ERR "Failed to register %u clocks\n", ret);
  594. s3c_register_clksrc(clksrcs, ARRAY_SIZE(clksrcs));
  595. s3c_register_clocks(init_clocks, ARRAY_SIZE(init_clocks));
  596. clkp = init_clocks_disable;
  597. for (ptr = 0; ptr < ARRAY_SIZE(init_clocks_disable); ptr++, clkp++) {
  598. ret = s3c24xx_register_clock(clkp);
  599. if (ret < 0) {
  600. printk(KERN_ERR "Failed to register clock %s (%d)\n",
  601. clkp->name, ret);
  602. }
  603. (clkp->enable)(clkp, 0);
  604. }
  605. s3c_pwmclk_init();
  606. }