clock.c 16 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822
  1. /*
  2. * Copyright (C) 2010 Samsung Electronics
  3. * Minkyu Kang <mk7.kang@samsung.com>
  4. *
  5. * See file CREDITS for list of people who contributed to this
  6. * project.
  7. *
  8. * This program is free software; you can redistribute it and/or
  9. * modify it under the terms of the GNU General Public License as
  10. * published by the Free Software Foundation; either version 2 of
  11. * the License, or (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. * You should have received a copy of the GNU General Public License
  19. * along with this program; if not, write to the Free Software
  20. * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
  21. * MA 02111-1307 USA
  22. */
  23. #include <common.h>
  24. #include <asm/io.h>
  25. #include <asm/arch/clock.h>
  26. #include <asm/arch/clk.h>
  27. /* exynos4: return pll clock frequency */
  28. static unsigned long exynos4_get_pll_clk(int pllreg)
  29. {
  30. struct exynos4_clock *clk =
  31. (struct exynos4_clock *)samsung_get_base_clock();
  32. unsigned long r, m, p, s, k = 0, mask, fout;
  33. unsigned int freq;
  34. switch (pllreg) {
  35. case APLL:
  36. r = readl(&clk->apll_con0);
  37. break;
  38. case MPLL:
  39. r = readl(&clk->mpll_con0);
  40. break;
  41. case EPLL:
  42. r = readl(&clk->epll_con0);
  43. k = readl(&clk->epll_con1);
  44. break;
  45. case VPLL:
  46. r = readl(&clk->vpll_con0);
  47. k = readl(&clk->vpll_con1);
  48. break;
  49. default:
  50. printf("Unsupported PLL (%d)\n", pllreg);
  51. return 0;
  52. }
  53. /*
  54. * APLL_CON: MIDV [25:16]
  55. * MPLL_CON: MIDV [25:16]
  56. * EPLL_CON: MIDV [24:16]
  57. * VPLL_CON: MIDV [24:16]
  58. */
  59. if (pllreg == APLL || pllreg == MPLL)
  60. mask = 0x3ff;
  61. else
  62. mask = 0x1ff;
  63. m = (r >> 16) & mask;
  64. /* PDIV [13:8] */
  65. p = (r >> 8) & 0x3f;
  66. /* SDIV [2:0] */
  67. s = r & 0x7;
  68. freq = CONFIG_SYS_CLK_FREQ;
  69. if (pllreg == EPLL) {
  70. k = k & 0xffff;
  71. /* FOUT = (MDIV + K / 65536) * FIN / (PDIV * 2^SDIV) */
  72. fout = (m + k / 65536) * (freq / (p * (1 << s)));
  73. } else if (pllreg == VPLL) {
  74. k = k & 0xfff;
  75. /* FOUT = (MDIV + K / 1024) * FIN / (PDIV * 2^SDIV) */
  76. fout = (m + k / 1024) * (freq / (p * (1 << s)));
  77. } else {
  78. if (s < 1)
  79. s = 1;
  80. /* FOUT = MDIV * FIN / (PDIV * 2^(SDIV - 1)) */
  81. fout = m * (freq / (p * (1 << (s - 1))));
  82. }
  83. return fout;
  84. }
  85. /* exynos5: return pll clock frequency */
  86. static unsigned long exynos5_get_pll_clk(int pllreg)
  87. {
  88. struct exynos5_clock *clk =
  89. (struct exynos5_clock *)samsung_get_base_clock();
  90. unsigned long r, m, p, s, k = 0, mask, fout;
  91. unsigned int freq, pll_div2_sel, fout_sel;
  92. switch (pllreg) {
  93. case APLL:
  94. r = readl(&clk->apll_con0);
  95. break;
  96. case MPLL:
  97. r = readl(&clk->mpll_con0);
  98. break;
  99. case EPLL:
  100. r = readl(&clk->epll_con0);
  101. k = readl(&clk->epll_con1);
  102. break;
  103. case VPLL:
  104. r = readl(&clk->vpll_con0);
  105. k = readl(&clk->vpll_con1);
  106. break;
  107. case BPLL:
  108. r = readl(&clk->bpll_con0);
  109. break;
  110. default:
  111. printf("Unsupported PLL (%d)\n", pllreg);
  112. return 0;
  113. }
  114. /*
  115. * APLL_CON: MIDV [25:16]
  116. * MPLL_CON: MIDV [25:16]
  117. * EPLL_CON: MIDV [24:16]
  118. * VPLL_CON: MIDV [24:16]
  119. * BPLL_CON: MIDV [25:16]
  120. */
  121. if (pllreg == APLL || pllreg == MPLL || pllreg == BPLL)
  122. mask = 0x3ff;
  123. else
  124. mask = 0x1ff;
  125. m = (r >> 16) & mask;
  126. /* PDIV [13:8] */
  127. p = (r >> 8) & 0x3f;
  128. /* SDIV [2:0] */
  129. s = r & 0x7;
  130. freq = CONFIG_SYS_CLK_FREQ;
  131. if (pllreg == EPLL) {
  132. k = k & 0xffff;
  133. /* FOUT = (MDIV + K / 65536) * FIN / (PDIV * 2^SDIV) */
  134. fout = (m + k / 65536) * (freq / (p * (1 << s)));
  135. } else if (pllreg == VPLL) {
  136. k = k & 0xfff;
  137. /* FOUT = (MDIV + K / 1024) * FIN / (PDIV * 2^SDIV) */
  138. fout = (m + k / 1024) * (freq / (p * (1 << s)));
  139. } else {
  140. if (s < 1)
  141. s = 1;
  142. /* FOUT = MDIV * FIN / (PDIV * 2^(SDIV - 1)) */
  143. fout = m * (freq / (p * (1 << (s - 1))));
  144. }
  145. /* According to the user manual, in EVT1 MPLL and BPLL always gives
  146. * 1.6GHz clock, so divide by 2 to get 800MHz MPLL clock.*/
  147. if (pllreg == MPLL || pllreg == BPLL) {
  148. pll_div2_sel = readl(&clk->pll_div2_sel);
  149. switch (pllreg) {
  150. case MPLL:
  151. fout_sel = (pll_div2_sel >> MPLL_FOUT_SEL_SHIFT)
  152. & MPLL_FOUT_SEL_MASK;
  153. break;
  154. case BPLL:
  155. fout_sel = (pll_div2_sel >> BPLL_FOUT_SEL_SHIFT)
  156. & BPLL_FOUT_SEL_MASK;
  157. break;
  158. default:
  159. fout_sel = -1;
  160. break;
  161. }
  162. if (fout_sel == 0)
  163. fout /= 2;
  164. }
  165. return fout;
  166. }
  167. /* exynos4: return ARM clock frequency */
  168. static unsigned long exynos4_get_arm_clk(void)
  169. {
  170. struct exynos4_clock *clk =
  171. (struct exynos4_clock *)samsung_get_base_clock();
  172. unsigned long div;
  173. unsigned long armclk;
  174. unsigned int core_ratio;
  175. unsigned int core2_ratio;
  176. div = readl(&clk->div_cpu0);
  177. /* CORE_RATIO: [2:0], CORE2_RATIO: [30:28] */
  178. core_ratio = (div >> 0) & 0x7;
  179. core2_ratio = (div >> 28) & 0x7;
  180. armclk = get_pll_clk(APLL) / (core_ratio + 1);
  181. armclk /= (core2_ratio + 1);
  182. return armclk;
  183. }
  184. /* exynos5: return ARM clock frequency */
  185. static unsigned long exynos5_get_arm_clk(void)
  186. {
  187. struct exynos5_clock *clk =
  188. (struct exynos5_clock *)samsung_get_base_clock();
  189. unsigned long div;
  190. unsigned long armclk;
  191. unsigned int arm_ratio;
  192. unsigned int arm2_ratio;
  193. div = readl(&clk->div_cpu0);
  194. /* ARM_RATIO: [2:0], ARM2_RATIO: [30:28] */
  195. arm_ratio = (div >> 0) & 0x7;
  196. arm2_ratio = (div >> 28) & 0x7;
  197. armclk = get_pll_clk(APLL) / (arm_ratio + 1);
  198. armclk /= (arm2_ratio + 1);
  199. return armclk;
  200. }
  201. /* exynos4: return pwm clock frequency */
  202. static unsigned long exynos4_get_pwm_clk(void)
  203. {
  204. struct exynos4_clock *clk =
  205. (struct exynos4_clock *)samsung_get_base_clock();
  206. unsigned long pclk, sclk;
  207. unsigned int sel;
  208. unsigned int ratio;
  209. if (s5p_get_cpu_rev() == 0) {
  210. /*
  211. * CLK_SRC_PERIL0
  212. * PWM_SEL [27:24]
  213. */
  214. sel = readl(&clk->src_peril0);
  215. sel = (sel >> 24) & 0xf;
  216. if (sel == 0x6)
  217. sclk = get_pll_clk(MPLL);
  218. else if (sel == 0x7)
  219. sclk = get_pll_clk(EPLL);
  220. else if (sel == 0x8)
  221. sclk = get_pll_clk(VPLL);
  222. else
  223. return 0;
  224. /*
  225. * CLK_DIV_PERIL3
  226. * PWM_RATIO [3:0]
  227. */
  228. ratio = readl(&clk->div_peril3);
  229. ratio = ratio & 0xf;
  230. } else if (s5p_get_cpu_rev() == 1) {
  231. sclk = get_pll_clk(MPLL);
  232. ratio = 8;
  233. } else
  234. return 0;
  235. pclk = sclk / (ratio + 1);
  236. return pclk;
  237. }
  238. /* exynos5: return pwm clock frequency */
  239. static unsigned long exynos5_get_pwm_clk(void)
  240. {
  241. struct exynos5_clock *clk =
  242. (struct exynos5_clock *)samsung_get_base_clock();
  243. unsigned long pclk, sclk;
  244. unsigned int ratio;
  245. /*
  246. * CLK_DIV_PERIC3
  247. * PWM_RATIO [3:0]
  248. */
  249. ratio = readl(&clk->div_peric3);
  250. ratio = ratio & 0xf;
  251. sclk = get_pll_clk(MPLL);
  252. pclk = sclk / (ratio + 1);
  253. return pclk;
  254. }
  255. /* exynos4: return uart clock frequency */
  256. static unsigned long exynos4_get_uart_clk(int dev_index)
  257. {
  258. struct exynos4_clock *clk =
  259. (struct exynos4_clock *)samsung_get_base_clock();
  260. unsigned long uclk, sclk;
  261. unsigned int sel;
  262. unsigned int ratio;
  263. /*
  264. * CLK_SRC_PERIL0
  265. * UART0_SEL [3:0]
  266. * UART1_SEL [7:4]
  267. * UART2_SEL [8:11]
  268. * UART3_SEL [12:15]
  269. * UART4_SEL [16:19]
  270. * UART5_SEL [23:20]
  271. */
  272. sel = readl(&clk->src_peril0);
  273. sel = (sel >> (dev_index << 2)) & 0xf;
  274. if (sel == 0x6)
  275. sclk = get_pll_clk(MPLL);
  276. else if (sel == 0x7)
  277. sclk = get_pll_clk(EPLL);
  278. else if (sel == 0x8)
  279. sclk = get_pll_clk(VPLL);
  280. else
  281. return 0;
  282. /*
  283. * CLK_DIV_PERIL0
  284. * UART0_RATIO [3:0]
  285. * UART1_RATIO [7:4]
  286. * UART2_RATIO [8:11]
  287. * UART3_RATIO [12:15]
  288. * UART4_RATIO [16:19]
  289. * UART5_RATIO [23:20]
  290. */
  291. ratio = readl(&clk->div_peril0);
  292. ratio = (ratio >> (dev_index << 2)) & 0xf;
  293. uclk = sclk / (ratio + 1);
  294. return uclk;
  295. }
  296. /* exynos5: return uart clock frequency */
  297. static unsigned long exynos5_get_uart_clk(int dev_index)
  298. {
  299. struct exynos5_clock *clk =
  300. (struct exynos5_clock *)samsung_get_base_clock();
  301. unsigned long uclk, sclk;
  302. unsigned int sel;
  303. unsigned int ratio;
  304. /*
  305. * CLK_SRC_PERIC0
  306. * UART0_SEL [3:0]
  307. * UART1_SEL [7:4]
  308. * UART2_SEL [8:11]
  309. * UART3_SEL [12:15]
  310. * UART4_SEL [16:19]
  311. * UART5_SEL [23:20]
  312. */
  313. sel = readl(&clk->src_peric0);
  314. sel = (sel >> (dev_index << 2)) & 0xf;
  315. if (sel == 0x6)
  316. sclk = get_pll_clk(MPLL);
  317. else if (sel == 0x7)
  318. sclk = get_pll_clk(EPLL);
  319. else if (sel == 0x8)
  320. sclk = get_pll_clk(VPLL);
  321. else
  322. return 0;
  323. /*
  324. * CLK_DIV_PERIC0
  325. * UART0_RATIO [3:0]
  326. * UART1_RATIO [7:4]
  327. * UART2_RATIO [8:11]
  328. * UART3_RATIO [12:15]
  329. * UART4_RATIO [16:19]
  330. * UART5_RATIO [23:20]
  331. */
  332. ratio = readl(&clk->div_peric0);
  333. ratio = (ratio >> (dev_index << 2)) & 0xf;
  334. uclk = sclk / (ratio + 1);
  335. return uclk;
  336. }
  337. /* exynos4: set the mmc clock */
  338. static void exynos4_set_mmc_clk(int dev_index, unsigned int div)
  339. {
  340. struct exynos4_clock *clk =
  341. (struct exynos4_clock *)samsung_get_base_clock();
  342. unsigned int addr;
  343. unsigned int val;
  344. /*
  345. * CLK_DIV_FSYS1
  346. * MMC0_PRE_RATIO [15:8], MMC1_PRE_RATIO [31:24]
  347. * CLK_DIV_FSYS2
  348. * MMC2_PRE_RATIO [15:8], MMC3_PRE_RATIO [31:24]
  349. */
  350. if (dev_index < 2) {
  351. addr = (unsigned int)&clk->div_fsys1;
  352. } else {
  353. addr = (unsigned int)&clk->div_fsys2;
  354. dev_index -= 2;
  355. }
  356. val = readl(addr);
  357. val &= ~(0xff << ((dev_index << 4) + 8));
  358. val |= (div & 0xff) << ((dev_index << 4) + 8);
  359. writel(val, addr);
  360. }
  361. /* exynos5: set the mmc clock */
  362. static void exynos5_set_mmc_clk(int dev_index, unsigned int div)
  363. {
  364. struct exynos5_clock *clk =
  365. (struct exynos5_clock *)samsung_get_base_clock();
  366. unsigned int addr;
  367. unsigned int val;
  368. /*
  369. * CLK_DIV_FSYS1
  370. * MMC0_PRE_RATIO [15:8], MMC1_PRE_RATIO [31:24]
  371. * CLK_DIV_FSYS2
  372. * MMC2_PRE_RATIO [15:8], MMC3_PRE_RATIO [31:24]
  373. */
  374. if (dev_index < 2) {
  375. addr = (unsigned int)&clk->div_fsys1;
  376. } else {
  377. addr = (unsigned int)&clk->div_fsys2;
  378. dev_index -= 2;
  379. }
  380. val = readl(addr);
  381. val &= ~(0xff << ((dev_index << 4) + 8));
  382. val |= (div & 0xff) << ((dev_index << 4) + 8);
  383. writel(val, addr);
  384. }
  385. /* get_lcd_clk: return lcd clock frequency */
  386. static unsigned long exynos4_get_lcd_clk(void)
  387. {
  388. struct exynos4_clock *clk =
  389. (struct exynos4_clock *)samsung_get_base_clock();
  390. unsigned long pclk, sclk;
  391. unsigned int sel;
  392. unsigned int ratio;
  393. /*
  394. * CLK_SRC_LCD0
  395. * FIMD0_SEL [3:0]
  396. */
  397. sel = readl(&clk->src_lcd0);
  398. sel = sel & 0xf;
  399. /*
  400. * 0x6: SCLK_MPLL
  401. * 0x7: SCLK_EPLL
  402. * 0x8: SCLK_VPLL
  403. */
  404. if (sel == 0x6)
  405. sclk = get_pll_clk(MPLL);
  406. else if (sel == 0x7)
  407. sclk = get_pll_clk(EPLL);
  408. else if (sel == 0x8)
  409. sclk = get_pll_clk(VPLL);
  410. else
  411. return 0;
  412. /*
  413. * CLK_DIV_LCD0
  414. * FIMD0_RATIO [3:0]
  415. */
  416. ratio = readl(&clk->div_lcd0);
  417. ratio = ratio & 0xf;
  418. pclk = sclk / (ratio + 1);
  419. return pclk;
  420. }
  421. /* get_lcd_clk: return lcd clock frequency */
  422. static unsigned long exynos5_get_lcd_clk(void)
  423. {
  424. struct exynos5_clock *clk =
  425. (struct exynos5_clock *)samsung_get_base_clock();
  426. unsigned long pclk, sclk;
  427. unsigned int sel;
  428. unsigned int ratio;
  429. /*
  430. * CLK_SRC_LCD0
  431. * FIMD0_SEL [3:0]
  432. */
  433. sel = readl(&clk->src_disp1_0);
  434. sel = sel & 0xf;
  435. /*
  436. * 0x6: SCLK_MPLL
  437. * 0x7: SCLK_EPLL
  438. * 0x8: SCLK_VPLL
  439. */
  440. if (sel == 0x6)
  441. sclk = get_pll_clk(MPLL);
  442. else if (sel == 0x7)
  443. sclk = get_pll_clk(EPLL);
  444. else if (sel == 0x8)
  445. sclk = get_pll_clk(VPLL);
  446. else
  447. return 0;
  448. /*
  449. * CLK_DIV_LCD0
  450. * FIMD0_RATIO [3:0]
  451. */
  452. ratio = readl(&clk->div_disp1_0);
  453. ratio = ratio & 0xf;
  454. pclk = sclk / (ratio + 1);
  455. return pclk;
  456. }
  457. void exynos4_set_lcd_clk(void)
  458. {
  459. struct exynos4_clock *clk =
  460. (struct exynos4_clock *)samsung_get_base_clock();
  461. unsigned int cfg = 0;
  462. /*
  463. * CLK_GATE_BLOCK
  464. * CLK_CAM [0]
  465. * CLK_TV [1]
  466. * CLK_MFC [2]
  467. * CLK_G3D [3]
  468. * CLK_LCD0 [4]
  469. * CLK_LCD1 [5]
  470. * CLK_GPS [7]
  471. */
  472. cfg = readl(&clk->gate_block);
  473. cfg |= 1 << 4;
  474. writel(cfg, &clk->gate_block);
  475. /*
  476. * CLK_SRC_LCD0
  477. * FIMD0_SEL [3:0]
  478. * MDNIE0_SEL [7:4]
  479. * MDNIE_PWM0_SEL [8:11]
  480. * MIPI0_SEL [12:15]
  481. * set lcd0 src clock 0x6: SCLK_MPLL
  482. */
  483. cfg = readl(&clk->src_lcd0);
  484. cfg &= ~(0xf);
  485. cfg |= 0x6;
  486. writel(cfg, &clk->src_lcd0);
  487. /*
  488. * CLK_GATE_IP_LCD0
  489. * CLK_FIMD0 [0]
  490. * CLK_MIE0 [1]
  491. * CLK_MDNIE0 [2]
  492. * CLK_DSIM0 [3]
  493. * CLK_SMMUFIMD0 [4]
  494. * CLK_PPMULCD0 [5]
  495. * Gating all clocks for FIMD0
  496. */
  497. cfg = readl(&clk->gate_ip_lcd0);
  498. cfg |= 1 << 0;
  499. writel(cfg, &clk->gate_ip_lcd0);
  500. /*
  501. * CLK_DIV_LCD0
  502. * FIMD0_RATIO [3:0]
  503. * MDNIE0_RATIO [7:4]
  504. * MDNIE_PWM0_RATIO [11:8]
  505. * MDNIE_PWM_PRE_RATIO [15:12]
  506. * MIPI0_RATIO [19:16]
  507. * MIPI0_PRE_RATIO [23:20]
  508. * set fimd ratio
  509. */
  510. cfg &= ~(0xf);
  511. cfg |= 0x1;
  512. writel(cfg, &clk->div_lcd0);
  513. }
  514. void exynos5_set_lcd_clk(void)
  515. {
  516. struct exynos5_clock *clk =
  517. (struct exynos5_clock *)samsung_get_base_clock();
  518. unsigned int cfg = 0;
  519. /*
  520. * CLK_GATE_BLOCK
  521. * CLK_CAM [0]
  522. * CLK_TV [1]
  523. * CLK_MFC [2]
  524. * CLK_G3D [3]
  525. * CLK_LCD0 [4]
  526. * CLK_LCD1 [5]
  527. * CLK_GPS [7]
  528. */
  529. cfg = readl(&clk->gate_block);
  530. cfg |= 1 << 4;
  531. writel(cfg, &clk->gate_block);
  532. /*
  533. * CLK_SRC_LCD0
  534. * FIMD0_SEL [3:0]
  535. * MDNIE0_SEL [7:4]
  536. * MDNIE_PWM0_SEL [8:11]
  537. * MIPI0_SEL [12:15]
  538. * set lcd0 src clock 0x6: SCLK_MPLL
  539. */
  540. cfg = readl(&clk->src_disp1_0);
  541. cfg &= ~(0xf);
  542. cfg |= 0x8;
  543. writel(cfg, &clk->src_disp1_0);
  544. /*
  545. * CLK_GATE_IP_LCD0
  546. * CLK_FIMD0 [0]
  547. * CLK_MIE0 [1]
  548. * CLK_MDNIE0 [2]
  549. * CLK_DSIM0 [3]
  550. * CLK_SMMUFIMD0 [4]
  551. * CLK_PPMULCD0 [5]
  552. * Gating all clocks for FIMD0
  553. */
  554. cfg = readl(&clk->gate_ip_disp1);
  555. cfg |= 1 << 0;
  556. writel(cfg, &clk->gate_ip_disp1);
  557. /*
  558. * CLK_DIV_LCD0
  559. * FIMD0_RATIO [3:0]
  560. * MDNIE0_RATIO [7:4]
  561. * MDNIE_PWM0_RATIO [11:8]
  562. * MDNIE_PWM_PRE_RATIO [15:12]
  563. * MIPI0_RATIO [19:16]
  564. * MIPI0_PRE_RATIO [23:20]
  565. * set fimd ratio
  566. */
  567. cfg &= ~(0xf);
  568. cfg |= 0x0;
  569. writel(cfg, &clk->div_disp1_0);
  570. }
  571. void exynos4_set_mipi_clk(void)
  572. {
  573. struct exynos4_clock *clk =
  574. (struct exynos4_clock *)samsung_get_base_clock();
  575. unsigned int cfg = 0;
  576. /*
  577. * CLK_SRC_LCD0
  578. * FIMD0_SEL [3:0]
  579. * MDNIE0_SEL [7:4]
  580. * MDNIE_PWM0_SEL [8:11]
  581. * MIPI0_SEL [12:15]
  582. * set mipi0 src clock 0x6: SCLK_MPLL
  583. */
  584. cfg = readl(&clk->src_lcd0);
  585. cfg &= ~(0xf << 12);
  586. cfg |= (0x6 << 12);
  587. writel(cfg, &clk->src_lcd0);
  588. /*
  589. * CLK_SRC_MASK_LCD0
  590. * FIMD0_MASK [0]
  591. * MDNIE0_MASK [4]
  592. * MDNIE_PWM0_MASK [8]
  593. * MIPI0_MASK [12]
  594. * set src mask mipi0 0x1: Unmask
  595. */
  596. cfg = readl(&clk->src_mask_lcd0);
  597. cfg |= (0x1 << 12);
  598. writel(cfg, &clk->src_mask_lcd0);
  599. /*
  600. * CLK_GATE_IP_LCD0
  601. * CLK_FIMD0 [0]
  602. * CLK_MIE0 [1]
  603. * CLK_MDNIE0 [2]
  604. * CLK_DSIM0 [3]
  605. * CLK_SMMUFIMD0 [4]
  606. * CLK_PPMULCD0 [5]
  607. * Gating all clocks for MIPI0
  608. */
  609. cfg = readl(&clk->gate_ip_lcd0);
  610. cfg |= 1 << 3;
  611. writel(cfg, &clk->gate_ip_lcd0);
  612. /*
  613. * CLK_DIV_LCD0
  614. * FIMD0_RATIO [3:0]
  615. * MDNIE0_RATIO [7:4]
  616. * MDNIE_PWM0_RATIO [11:8]
  617. * MDNIE_PWM_PRE_RATIO [15:12]
  618. * MIPI0_RATIO [19:16]
  619. * MIPI0_PRE_RATIO [23:20]
  620. * set mipi ratio
  621. */
  622. cfg &= ~(0xf << 16);
  623. cfg |= (0x1 << 16);
  624. writel(cfg, &clk->div_lcd0);
  625. }
  626. /*
  627. * I2C
  628. *
  629. * exynos5: obtaining the I2C clock
  630. */
  631. static unsigned long exynos5_get_i2c_clk(void)
  632. {
  633. struct exynos5_clock *clk =
  634. (struct exynos5_clock *)samsung_get_base_clock();
  635. unsigned long aclk_66, aclk_66_pre, sclk;
  636. unsigned int ratio;
  637. sclk = get_pll_clk(MPLL);
  638. ratio = (readl(&clk->div_top1)) >> 24;
  639. ratio &= 0x7;
  640. aclk_66_pre = sclk / (ratio + 1);
  641. ratio = readl(&clk->div_top0);
  642. ratio &= 0x7;
  643. aclk_66 = aclk_66_pre / (ratio + 1);
  644. return aclk_66;
  645. }
  646. static unsigned long exynos4_get_i2c_clk(void)
  647. {
  648. struct exynos4_clock *clk =
  649. (struct exynos4_clock *)samsung_get_base_clock();
  650. unsigned long sclk, aclk_100;
  651. unsigned int ratio;
  652. sclk = get_pll_clk(APLL);
  653. ratio = (readl(&clk->div_top)) >> 4;
  654. ratio &= 0xf;
  655. aclk_100 = sclk / (ratio + 1);
  656. return aclk_100;
  657. }
  658. unsigned long get_pll_clk(int pllreg)
  659. {
  660. if (cpu_is_exynos5())
  661. return exynos5_get_pll_clk(pllreg);
  662. else
  663. return exynos4_get_pll_clk(pllreg);
  664. }
  665. unsigned long get_arm_clk(void)
  666. {
  667. if (cpu_is_exynos5())
  668. return exynos5_get_arm_clk();
  669. else
  670. return exynos4_get_arm_clk();
  671. }
  672. unsigned long get_i2c_clk(void)
  673. {
  674. if (cpu_is_exynos5()) {
  675. return exynos5_get_i2c_clk();
  676. } else if (cpu_is_exynos4()) {
  677. return exynos4_get_i2c_clk();
  678. } else {
  679. debug("I2C clock is not set for this CPU\n");
  680. return 0;
  681. }
  682. }
  683. unsigned long get_pwm_clk(void)
  684. {
  685. if (cpu_is_exynos5())
  686. return exynos5_get_pwm_clk();
  687. else
  688. return exynos4_get_pwm_clk();
  689. }
  690. unsigned long get_uart_clk(int dev_index)
  691. {
  692. if (cpu_is_exynos5())
  693. return exynos5_get_uart_clk(dev_index);
  694. else
  695. return exynos4_get_uart_clk(dev_index);
  696. }
  697. void set_mmc_clk(int dev_index, unsigned int div)
  698. {
  699. if (cpu_is_exynos5())
  700. exynos5_set_mmc_clk(dev_index, div);
  701. else
  702. exynos4_set_mmc_clk(dev_index, div);
  703. }
  704. unsigned long get_lcd_clk(void)
  705. {
  706. if (cpu_is_exynos4())
  707. return exynos4_get_lcd_clk();
  708. else
  709. return exynos5_get_lcd_clk();
  710. }
  711. void set_lcd_clk(void)
  712. {
  713. if (cpu_is_exynos4())
  714. exynos4_set_lcd_clk();
  715. else
  716. exynos5_set_lcd_clk();
  717. }
  718. void set_mipi_clk(void)
  719. {
  720. if (cpu_is_exynos4())
  721. exynos4_set_mipi_clk();
  722. }