clock.c 16 KB

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