2 * Copyright (C) 2010 Samsung Electronics
3 * Minkyu Kang <mk7.kang@samsung.com>
5 * See file CREDITS for list of people who contributed to this
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.
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.
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,
26 #include <asm/arch/clock.h>
27 #include <asm/arch/clk.h>
28 #include <asm/arch/periph.h>
30 /* Epll Clock division values to achive different frequency output */
31 static struct set_epll_con_val exynos5_epll_div[] = {
32 { 192000000, 0, 48, 3, 1, 0 },
33 { 180000000, 0, 45, 3, 1, 0 },
34 { 73728000, 1, 73, 3, 3, 47710 },
35 { 67737600, 1, 90, 4, 3, 20762 },
36 { 49152000, 0, 49, 3, 3, 9961 },
37 { 45158400, 0, 45, 3, 3, 10381 },
38 { 180633600, 0, 45, 3, 1, 10381 }
41 /* exynos: return pll clock frequency */
42 static int exynos_get_pll_clk(int pllreg, unsigned int r, unsigned int k)
44 unsigned long m, p, s = 0, mask, fout;
47 * APLL_CON: MIDV [25:16]
48 * MPLL_CON: MIDV [25:16]
49 * EPLL_CON: MIDV [24:16]
50 * VPLL_CON: MIDV [24:16]
51 * BPLL_CON: MIDV [25:16]: Exynos5
53 if (pllreg == APLL || pllreg == MPLL || pllreg == BPLL)
65 freq = CONFIG_SYS_CLK_FREQ;
69 /* FOUT = (MDIV + K / 65536) * FIN / (PDIV * 2^SDIV) */
70 fout = (m + k / 65536) * (freq / (p * (1 << s)));
71 } else if (pllreg == VPLL) {
73 /* FOUT = (MDIV + K / 1024) * FIN / (PDIV * 2^SDIV) */
74 fout = (m + k / 1024) * (freq / (p * (1 << s)));
78 /* FOUT = MDIV * FIN / (PDIV * 2^(SDIV - 1)) */
79 fout = m * (freq / (p * (1 << (s - 1))));
85 /* exynos4: return pll clock frequency */
86 static unsigned long exynos4_get_pll_clk(int pllreg)
88 struct exynos4_clock *clk =
89 (struct exynos4_clock *)samsung_get_base_clock();
90 unsigned long r, k = 0;
94 r = readl(&clk->apll_con0);
97 r = readl(&clk->mpll_con0);
100 r = readl(&clk->epll_con0);
101 k = readl(&clk->epll_con1);
104 r = readl(&clk->vpll_con0);
105 k = readl(&clk->vpll_con1);
108 printf("Unsupported PLL (%d)\n", pllreg);
112 return exynos_get_pll_clk(pllreg, r, k);
115 /* exynos4x12: return pll clock frequency */
116 static unsigned long exynos4x12_get_pll_clk(int pllreg)
118 struct exynos4x12_clock *clk =
119 (struct exynos4x12_clock *)samsung_get_base_clock();
120 unsigned long r, k = 0;
124 r = readl(&clk->apll_con0);
127 r = readl(&clk->mpll_con0);
130 r = readl(&clk->epll_con0);
131 k = readl(&clk->epll_con1);
134 r = readl(&clk->vpll_con0);
135 k = readl(&clk->vpll_con1);
138 printf("Unsupported PLL (%d)\n", pllreg);
142 return exynos_get_pll_clk(pllreg, r, k);
145 /* exynos5: return pll clock frequency */
146 static unsigned long exynos5_get_pll_clk(int pllreg)
148 struct exynos5_clock *clk =
149 (struct exynos5_clock *)samsung_get_base_clock();
150 unsigned long r, k = 0, fout;
151 unsigned int pll_div2_sel, fout_sel;
155 r = readl(&clk->apll_con0);
158 r = readl(&clk->mpll_con0);
161 r = readl(&clk->epll_con0);
162 k = readl(&clk->epll_con1);
165 r = readl(&clk->vpll_con0);
166 k = readl(&clk->vpll_con1);
169 r = readl(&clk->bpll_con0);
172 printf("Unsupported PLL (%d)\n", pllreg);
176 fout = exynos_get_pll_clk(pllreg, r, k);
178 /* According to the user manual, in EVT1 MPLL and BPLL always gives
179 * 1.6GHz clock, so divide by 2 to get 800MHz MPLL clock.*/
180 if (pllreg == MPLL || pllreg == BPLL) {
181 pll_div2_sel = readl(&clk->pll_div2_sel);
185 fout_sel = (pll_div2_sel >> MPLL_FOUT_SEL_SHIFT)
186 & MPLL_FOUT_SEL_MASK;
189 fout_sel = (pll_div2_sel >> BPLL_FOUT_SEL_SHIFT)
190 & BPLL_FOUT_SEL_MASK;
204 /* exynos4: return ARM clock frequency */
205 static unsigned long exynos4_get_arm_clk(void)
207 struct exynos4_clock *clk =
208 (struct exynos4_clock *)samsung_get_base_clock();
210 unsigned long armclk;
211 unsigned int core_ratio;
212 unsigned int core2_ratio;
214 div = readl(&clk->div_cpu0);
216 /* CORE_RATIO: [2:0], CORE2_RATIO: [30:28] */
217 core_ratio = (div >> 0) & 0x7;
218 core2_ratio = (div >> 28) & 0x7;
220 armclk = get_pll_clk(APLL) / (core_ratio + 1);
221 armclk /= (core2_ratio + 1);
226 /* exynos4x12: return ARM clock frequency */
227 static unsigned long exynos4x12_get_arm_clk(void)
229 struct exynos4x12_clock *clk =
230 (struct exynos4x12_clock *)samsung_get_base_clock();
232 unsigned long armclk;
233 unsigned int core_ratio;
234 unsigned int core2_ratio;
236 div = readl(&clk->div_cpu0);
238 /* CORE_RATIO: [2:0], CORE2_RATIO: [30:28] */
239 core_ratio = (div >> 0) & 0x7;
240 core2_ratio = (div >> 28) & 0x7;
242 armclk = get_pll_clk(APLL) / (core_ratio + 1);
243 armclk /= (core2_ratio + 1);
248 /* exynos5: return ARM clock frequency */
249 static unsigned long exynos5_get_arm_clk(void)
251 struct exynos5_clock *clk =
252 (struct exynos5_clock *)samsung_get_base_clock();
254 unsigned long armclk;
255 unsigned int arm_ratio;
256 unsigned int arm2_ratio;
258 div = readl(&clk->div_cpu0);
260 /* ARM_RATIO: [2:0], ARM2_RATIO: [30:28] */
261 arm_ratio = (div >> 0) & 0x7;
262 arm2_ratio = (div >> 28) & 0x7;
264 armclk = get_pll_clk(APLL) / (arm_ratio + 1);
265 armclk /= (arm2_ratio + 1);
270 /* exynos4: return pwm clock frequency */
271 static unsigned long exynos4_get_pwm_clk(void)
273 struct exynos4_clock *clk =
274 (struct exynos4_clock *)samsung_get_base_clock();
275 unsigned long pclk, sclk;
279 if (s5p_get_cpu_rev() == 0) {
284 sel = readl(&clk->src_peril0);
285 sel = (sel >> 24) & 0xf;
288 sclk = get_pll_clk(MPLL);
290 sclk = get_pll_clk(EPLL);
292 sclk = get_pll_clk(VPLL);
300 ratio = readl(&clk->div_peril3);
302 } else if (s5p_get_cpu_rev() == 1) {
303 sclk = get_pll_clk(MPLL);
308 pclk = sclk / (ratio + 1);
313 /* exynos4x12: return pwm clock frequency */
314 static unsigned long exynos4x12_get_pwm_clk(void)
316 unsigned long pclk, sclk;
319 sclk = get_pll_clk(MPLL);
322 pclk = sclk / (ratio + 1);
327 /* exynos5: return pwm clock frequency */
328 static unsigned long exynos5_get_pwm_clk(void)
330 struct exynos5_clock *clk =
331 (struct exynos5_clock *)samsung_get_base_clock();
332 unsigned long pclk, sclk;
339 ratio = readl(&clk->div_peric3);
341 sclk = get_pll_clk(MPLL);
343 pclk = sclk / (ratio + 1);
348 /* exynos4: return uart clock frequency */
349 static unsigned long exynos4_get_uart_clk(int dev_index)
351 struct exynos4_clock *clk =
352 (struct exynos4_clock *)samsung_get_base_clock();
353 unsigned long uclk, sclk;
366 sel = readl(&clk->src_peril0);
367 sel = (sel >> (dev_index << 2)) & 0xf;
370 sclk = get_pll_clk(MPLL);
372 sclk = get_pll_clk(EPLL);
374 sclk = get_pll_clk(VPLL);
383 * UART3_RATIO [12:15]
384 * UART4_RATIO [16:19]
385 * UART5_RATIO [23:20]
387 ratio = readl(&clk->div_peril0);
388 ratio = (ratio >> (dev_index << 2)) & 0xf;
390 uclk = sclk / (ratio + 1);
395 /* exynos4x12: return uart clock frequency */
396 static unsigned long exynos4x12_get_uart_clk(int dev_index)
398 struct exynos4x12_clock *clk =
399 (struct exynos4x12_clock *)samsung_get_base_clock();
400 unsigned long uclk, sclk;
412 sel = readl(&clk->src_peril0);
413 sel = (sel >> (dev_index << 2)) & 0xf;
416 sclk = get_pll_clk(MPLL);
418 sclk = get_pll_clk(EPLL);
420 sclk = get_pll_clk(VPLL);
429 * UART3_RATIO [12:15]
430 * UART4_RATIO [16:19]
432 ratio = readl(&clk->div_peril0);
433 ratio = (ratio >> (dev_index << 2)) & 0xf;
435 uclk = sclk / (ratio + 1);
440 /* exynos5: return uart clock frequency */
441 static unsigned long exynos5_get_uart_clk(int dev_index)
443 struct exynos5_clock *clk =
444 (struct exynos5_clock *)samsung_get_base_clock();
445 unsigned long uclk, sclk;
458 sel = readl(&clk->src_peric0);
459 sel = (sel >> (dev_index << 2)) & 0xf;
462 sclk = get_pll_clk(MPLL);
464 sclk = get_pll_clk(EPLL);
466 sclk = get_pll_clk(VPLL);
475 * UART3_RATIO [12:15]
476 * UART4_RATIO [16:19]
477 * UART5_RATIO [23:20]
479 ratio = readl(&clk->div_peric0);
480 ratio = (ratio >> (dev_index << 2)) & 0xf;
482 uclk = sclk / (ratio + 1);
487 static unsigned long exynos4_get_mmc_clk(int dev_index)
489 struct exynos4_clock *clk =
490 (struct exynos4_clock *)samsung_get_base_clock();
491 unsigned long uclk, sclk;
492 unsigned int sel, ratio, pre_ratio;
495 sel = readl(&clk->src_fsys);
496 sel = (sel >> (dev_index << 2)) & 0xf;
499 sclk = get_pll_clk(MPLL);
501 sclk = get_pll_clk(EPLL);
503 sclk = get_pll_clk(VPLL);
510 ratio = readl(&clk->div_fsys1);
511 pre_ratio = readl(&clk->div_fsys1);
515 ratio = readl(&clk->div_fsys2);
516 pre_ratio = readl(&clk->div_fsys2);
519 ratio = readl(&clk->div_fsys3);
520 pre_ratio = readl(&clk->div_fsys3);
526 if (dev_index == 1 || dev_index == 3)
529 ratio = (ratio >> shift) & 0xf;
530 pre_ratio = (pre_ratio >> (shift + 8)) & 0xff;
531 uclk = (sclk / (ratio + 1)) / (pre_ratio + 1);
536 static unsigned long exynos5_get_mmc_clk(int dev_index)
538 struct exynos5_clock *clk =
539 (struct exynos5_clock *)samsung_get_base_clock();
540 unsigned long uclk, sclk;
541 unsigned int sel, ratio, pre_ratio;
544 sel = readl(&clk->src_fsys);
545 sel = (sel >> (dev_index << 2)) & 0xf;
548 sclk = get_pll_clk(MPLL);
550 sclk = get_pll_clk(EPLL);
552 sclk = get_pll_clk(VPLL);
559 ratio = readl(&clk->div_fsys1);
560 pre_ratio = readl(&clk->div_fsys1);
564 ratio = readl(&clk->div_fsys2);
565 pre_ratio = readl(&clk->div_fsys2);
571 if (dev_index == 1 || dev_index == 3)
574 ratio = (ratio >> shift) & 0xf;
575 pre_ratio = (pre_ratio >> (shift + 8)) & 0xff;
576 uclk = (sclk / (ratio + 1)) / (pre_ratio + 1);
581 /* exynos4: set the mmc clock */
582 static void exynos4_set_mmc_clk(int dev_index, unsigned int div)
584 struct exynos4_clock *clk =
585 (struct exynos4_clock *)samsung_get_base_clock();
591 * MMC0_PRE_RATIO [15:8], MMC1_PRE_RATIO [31:24]
593 * MMC2_PRE_RATIO [15:8], MMC3_PRE_RATIO [31:24]
596 addr = (unsigned int)&clk->div_fsys1;
598 addr = (unsigned int)&clk->div_fsys2;
603 val &= ~(0xff << ((dev_index << 4) + 8));
604 val |= (div & 0xff) << ((dev_index << 4) + 8);
608 /* exynos4x12: set the mmc clock */
609 static void exynos4x12_set_mmc_clk(int dev_index, unsigned int div)
611 struct exynos4x12_clock *clk =
612 (struct exynos4x12_clock *)samsung_get_base_clock();
618 * MMC0_PRE_RATIO [15:8], MMC1_PRE_RATIO [31:24]
620 * MMC2_PRE_RATIO [15:8], MMC3_PRE_RATIO [31:24]
623 addr = (unsigned int)&clk->div_fsys1;
625 addr = (unsigned int)&clk->div_fsys2;
630 val &= ~(0xff << ((dev_index << 4) + 8));
631 val |= (div & 0xff) << ((dev_index << 4) + 8);
635 /* exynos5: set the mmc clock */
636 static void exynos5_set_mmc_clk(int dev_index, unsigned int div)
638 struct exynos5_clock *clk =
639 (struct exynos5_clock *)samsung_get_base_clock();
645 * MMC0_PRE_RATIO [15:8], MMC1_PRE_RATIO [31:24]
647 * MMC2_PRE_RATIO [15:8], MMC3_PRE_RATIO [31:24]
650 addr = (unsigned int)&clk->div_fsys1;
652 addr = (unsigned int)&clk->div_fsys2;
657 val &= ~(0xff << ((dev_index << 4) + 8));
658 val |= (div & 0xff) << ((dev_index << 4) + 8);
662 /* get_lcd_clk: return lcd clock frequency */
663 static unsigned long exynos4_get_lcd_clk(void)
665 struct exynos4_clock *clk =
666 (struct exynos4_clock *)samsung_get_base_clock();
667 unsigned long pclk, sclk;
675 sel = readl(&clk->src_lcd0);
684 sclk = get_pll_clk(MPLL);
686 sclk = get_pll_clk(EPLL);
688 sclk = get_pll_clk(VPLL);
696 ratio = readl(&clk->div_lcd0);
699 pclk = sclk / (ratio + 1);
704 /* get_lcd_clk: return lcd clock frequency */
705 static unsigned long exynos5_get_lcd_clk(void)
707 struct exynos5_clock *clk =
708 (struct exynos5_clock *)samsung_get_base_clock();
709 unsigned long pclk, sclk;
717 sel = readl(&clk->src_disp1_0);
726 sclk = get_pll_clk(MPLL);
728 sclk = get_pll_clk(EPLL);
730 sclk = get_pll_clk(VPLL);
738 ratio = readl(&clk->div_disp1_0);
741 pclk = sclk / (ratio + 1);
746 void exynos4_set_lcd_clk(void)
748 struct exynos4_clock *clk =
749 (struct exynos4_clock *)samsung_get_base_clock();
750 unsigned int cfg = 0;
762 cfg = readl(&clk->gate_block);
764 writel(cfg, &clk->gate_block);
770 * MDNIE_PWM0_SEL [8:11]
772 * set lcd0 src clock 0x6: SCLK_MPLL
774 cfg = readl(&clk->src_lcd0);
777 writel(cfg, &clk->src_lcd0);
787 * Gating all clocks for FIMD0
789 cfg = readl(&clk->gate_ip_lcd0);
791 writel(cfg, &clk->gate_ip_lcd0);
797 * MDNIE_PWM0_RATIO [11:8]
798 * MDNIE_PWM_PRE_RATIO [15:12]
799 * MIPI0_RATIO [19:16]
800 * MIPI0_PRE_RATIO [23:20]
805 writel(cfg, &clk->div_lcd0);
808 void exynos5_set_lcd_clk(void)
810 struct exynos5_clock *clk =
811 (struct exynos5_clock *)samsung_get_base_clock();
812 unsigned int cfg = 0;
824 cfg = readl(&clk->gate_block);
826 writel(cfg, &clk->gate_block);
832 * MDNIE_PWM0_SEL [8:11]
834 * set lcd0 src clock 0x6: SCLK_MPLL
836 cfg = readl(&clk->src_disp1_0);
839 writel(cfg, &clk->src_disp1_0);
849 * Gating all clocks for FIMD0
851 cfg = readl(&clk->gate_ip_disp1);
853 writel(cfg, &clk->gate_ip_disp1);
859 * MDNIE_PWM0_RATIO [11:8]
860 * MDNIE_PWM_PRE_RATIO [15:12]
861 * MIPI0_RATIO [19:16]
862 * MIPI0_PRE_RATIO [23:20]
867 writel(cfg, &clk->div_disp1_0);
870 void exynos4_set_mipi_clk(void)
872 struct exynos4_clock *clk =
873 (struct exynos4_clock *)samsung_get_base_clock();
874 unsigned int cfg = 0;
880 * MDNIE_PWM0_SEL [8:11]
882 * set mipi0 src clock 0x6: SCLK_MPLL
884 cfg = readl(&clk->src_lcd0);
887 writel(cfg, &clk->src_lcd0);
893 * MDNIE_PWM0_MASK [8]
895 * set src mask mipi0 0x1: Unmask
897 cfg = readl(&clk->src_mask_lcd0);
899 writel(cfg, &clk->src_mask_lcd0);
909 * Gating all clocks for MIPI0
911 cfg = readl(&clk->gate_ip_lcd0);
913 writel(cfg, &clk->gate_ip_lcd0);
919 * MDNIE_PWM0_RATIO [11:8]
920 * MDNIE_PWM_PRE_RATIO [15:12]
921 * MIPI0_RATIO [19:16]
922 * MIPI0_PRE_RATIO [23:20]
927 writel(cfg, &clk->div_lcd0);
933 * exynos5: obtaining the I2C clock
935 static unsigned long exynos5_get_i2c_clk(void)
937 struct exynos5_clock *clk =
938 (struct exynos5_clock *)samsung_get_base_clock();
939 unsigned long aclk_66, aclk_66_pre, sclk;
942 sclk = get_pll_clk(MPLL);
944 ratio = (readl(&clk->div_top1)) >> 24;
946 aclk_66_pre = sclk / (ratio + 1);
947 ratio = readl(&clk->div_top0);
949 aclk_66 = aclk_66_pre / (ratio + 1);
953 int exynos5_set_epll_clk(unsigned long rate)
955 unsigned int epll_con, epll_con_k;
957 unsigned int lockcnt;
959 struct exynos5_clock *clk =
960 (struct exynos5_clock *)samsung_get_base_clock();
962 epll_con = readl(&clk->epll_con0);
963 epll_con &= ~((EPLL_CON0_LOCK_DET_EN_MASK <<
964 EPLL_CON0_LOCK_DET_EN_SHIFT) |
965 EPLL_CON0_MDIV_MASK << EPLL_CON0_MDIV_SHIFT |
966 EPLL_CON0_PDIV_MASK << EPLL_CON0_PDIV_SHIFT |
967 EPLL_CON0_SDIV_MASK << EPLL_CON0_SDIV_SHIFT);
969 for (i = 0; i < ARRAY_SIZE(exynos5_epll_div); i++) {
970 if (exynos5_epll_div[i].freq_out == rate)
974 if (i == ARRAY_SIZE(exynos5_epll_div))
977 epll_con_k = exynos5_epll_div[i].k_dsm << 0;
978 epll_con |= exynos5_epll_div[i].en_lock_det <<
979 EPLL_CON0_LOCK_DET_EN_SHIFT;
980 epll_con |= exynos5_epll_div[i].m_div << EPLL_CON0_MDIV_SHIFT;
981 epll_con |= exynos5_epll_div[i].p_div << EPLL_CON0_PDIV_SHIFT;
982 epll_con |= exynos5_epll_div[i].s_div << EPLL_CON0_SDIV_SHIFT;
985 * Required period ( in cycles) to genarate a stable clock output.
986 * The maximum clock time can be up to 3000 * PDIV cycles of PLLs
987 * frequency input (as per spec)
989 lockcnt = 3000 * exynos5_epll_div[i].p_div;
991 writel(lockcnt, &clk->epll_lock);
992 writel(epll_con, &clk->epll_con0);
993 writel(epll_con_k, &clk->epll_con1);
995 start = get_timer(0);
997 while (!(readl(&clk->epll_con0) &
998 (0x1 << EXYNOS5_EPLLCON0_LOCKED_SHIFT))) {
999 if (get_timer(start) > TIMEOUT_EPLL_LOCK) {
1000 debug("%s: Timeout waiting for EPLL lock\n", __func__);
1007 void exynos5_set_i2s_clk_source(void)
1009 struct exynos5_clock *clk =
1010 (struct exynos5_clock *)samsung_get_base_clock();
1012 clrsetbits_le32(&clk->src_peric1, AUDIO1_SEL_MASK,
1013 (CLK_SRC_SCLK_EPLL));
1016 int exynos5_set_i2s_clk_prescaler(unsigned int src_frq,
1017 unsigned int dst_frq)
1019 struct exynos5_clock *clk =
1020 (struct exynos5_clock *)samsung_get_base_clock();
1023 if ((dst_frq == 0) || (src_frq == 0)) {
1024 debug("%s: Invalid requency input for prescaler\n", __func__);
1025 debug("src frq = %d des frq = %d ", src_frq, dst_frq);
1029 div = (src_frq / dst_frq);
1030 if (div > AUDIO_1_RATIO_MASK) {
1031 debug("%s: Frequency ratio is out of range\n", __func__);
1032 debug("src frq = %d des frq = %d ", src_frq, dst_frq);
1035 clrsetbits_le32(&clk->div_peric4, AUDIO_1_RATIO_MASK,
1036 (div & AUDIO_1_RATIO_MASK));
1041 * Linearly searches for the most accurate main and fine stage clock scalars
1042 * (divisors) for a specified target frequency and scalar bit sizes by checking
1043 * all multiples of main_scalar_bits values. Will always return scalars up to or
1044 * slower than target.
1046 * @param main_scalar_bits Number of main scalar bits, must be > 0 and < 32
1047 * @param fine_scalar_bits Number of fine scalar bits, must be > 0 and < 32
1048 * @param input_freq Clock frequency to be scaled in Hz
1049 * @param target_freq Desired clock frequency in Hz
1050 * @param best_fine_scalar Pointer to store the fine stage divisor
1052 * @return best_main_scalar Main scalar for desired frequency or -1 if none
1055 static int clock_calc_best_scalar(unsigned int main_scaler_bits,
1056 unsigned int fine_scalar_bits, unsigned int input_rate,
1057 unsigned int target_rate, unsigned int *best_fine_scalar)
1060 int best_main_scalar = -1;
1061 unsigned int best_error = target_rate;
1062 const unsigned int cap = (1 << fine_scalar_bits) - 1;
1063 const unsigned int loops = 1 << main_scaler_bits;
1065 debug("Input Rate is %u, Target is %u, Cap is %u\n", input_rate,
1068 assert(best_fine_scalar != NULL);
1069 assert(main_scaler_bits <= fine_scalar_bits);
1071 *best_fine_scalar = 1;
1073 if (input_rate == 0 || target_rate == 0)
1076 if (target_rate >= input_rate)
1079 for (i = 1; i <= loops; i++) {
1080 const unsigned int effective_div = max(min(input_rate / i /
1081 target_rate, cap), 1);
1082 const unsigned int effective_rate = input_rate / i /
1084 const int error = target_rate - effective_rate;
1086 debug("%d|effdiv:%u, effrate:%u, error:%d\n", i, effective_div,
1087 effective_rate, error);
1089 if (error >= 0 && error <= best_error) {
1091 best_main_scalar = i;
1092 *best_fine_scalar = effective_div;
1096 return best_main_scalar;
1099 static int exynos5_set_spi_clk(enum periph_id periph_id,
1102 struct exynos5_clock *clk =
1103 (struct exynos5_clock *)samsung_get_base_clock();
1106 unsigned shift, pre_shift;
1107 unsigned mask = 0xff;
1110 main = clock_calc_best_scalar(4, 8, 400000000, rate, &fine);
1112 debug("%s: Cannot set clock rate for periph %d",
1113 __func__, periph_id);
1119 switch (periph_id) {
1120 case PERIPH_ID_SPI0:
1121 reg = &clk->div_peric1;
1125 case PERIPH_ID_SPI1:
1126 reg = &clk->div_peric1;
1130 case PERIPH_ID_SPI2:
1131 reg = &clk->div_peric2;
1135 case PERIPH_ID_SPI3:
1136 reg = &clk->sclk_div_isp;
1140 case PERIPH_ID_SPI4:
1141 reg = &clk->sclk_div_isp;
1146 debug("%s: Unsupported peripheral ID %d\n", __func__,
1150 clrsetbits_le32(reg, mask << shift, (main & mask) << shift);
1151 clrsetbits_le32(reg, mask << pre_shift, (fine & mask) << pre_shift);
1156 static unsigned long exynos4_get_i2c_clk(void)
1158 struct exynos4_clock *clk =
1159 (struct exynos4_clock *)samsung_get_base_clock();
1160 unsigned long sclk, aclk_100;
1163 sclk = get_pll_clk(APLL);
1165 ratio = (readl(&clk->div_top)) >> 4;
1167 aclk_100 = sclk / (ratio + 1);
1171 unsigned long get_pll_clk(int pllreg)
1173 if (cpu_is_exynos5())
1174 return exynos5_get_pll_clk(pllreg);
1176 if (proid_is_exynos4412())
1177 return exynos4x12_get_pll_clk(pllreg);
1178 return exynos4_get_pll_clk(pllreg);
1182 unsigned long get_arm_clk(void)
1184 if (cpu_is_exynos5())
1185 return exynos5_get_arm_clk();
1187 if (proid_is_exynos4412())
1188 return exynos4x12_get_arm_clk();
1189 return exynos4_get_arm_clk();
1193 unsigned long get_i2c_clk(void)
1195 if (cpu_is_exynos5()) {
1196 return exynos5_get_i2c_clk();
1197 } else if (cpu_is_exynos4()) {
1198 return exynos4_get_i2c_clk();
1200 debug("I2C clock is not set for this CPU\n");
1205 unsigned long get_pwm_clk(void)
1207 if (cpu_is_exynos5())
1208 return exynos5_get_pwm_clk();
1210 if (proid_is_exynos4412())
1211 return exynos4x12_get_pwm_clk();
1212 return exynos4_get_pwm_clk();
1216 unsigned long get_uart_clk(int dev_index)
1218 if (cpu_is_exynos5())
1219 return exynos5_get_uart_clk(dev_index);
1221 if (proid_is_exynos4412())
1222 return exynos4x12_get_uart_clk(dev_index);
1223 return exynos4_get_uart_clk(dev_index);
1227 unsigned long get_mmc_clk(int dev_index)
1229 if (cpu_is_exynos5())
1230 return exynos5_get_mmc_clk(dev_index);
1232 return exynos4_get_mmc_clk(dev_index);
1235 void set_mmc_clk(int dev_index, unsigned int div)
1237 if (cpu_is_exynos5())
1238 exynos5_set_mmc_clk(dev_index, div);
1240 if (proid_is_exynos4412())
1241 exynos4x12_set_mmc_clk(dev_index, div);
1242 exynos4_set_mmc_clk(dev_index, div);
1246 unsigned long get_lcd_clk(void)
1248 if (cpu_is_exynos4())
1249 return exynos4_get_lcd_clk();
1251 return exynos5_get_lcd_clk();
1254 void set_lcd_clk(void)
1256 if (cpu_is_exynos4())
1257 exynos4_set_lcd_clk();
1259 exynos5_set_lcd_clk();
1262 void set_mipi_clk(void)
1264 if (cpu_is_exynos4())
1265 exynos4_set_mipi_clk();
1268 int set_spi_clk(int periph_id, unsigned int rate)
1270 if (cpu_is_exynos5())
1271 return exynos5_set_spi_clk(periph_id, rate);
1276 int set_i2s_clk_prescaler(unsigned int src_frq, unsigned int dst_frq)
1279 if (cpu_is_exynos5())
1280 return exynos5_set_i2s_clk_prescaler(src_frq, dst_frq);
1285 void set_i2s_clk_source(void)
1287 if (cpu_is_exynos5())
1288 exynos5_set_i2s_clk_source();
1291 int set_epll_clk(unsigned long rate)
1293 if (cpu_is_exynos5())
1294 return exynos5_set_epll_clk(rate);