blob: 8ea7f016c2dd8aa7381fe21493bdd2001640ce59 [file] [log] [blame]
Peng Fan99878462019-08-27 06:25:51 +00001// SPDX-License-Identifier: GPL-2.0+
2/*
3 * Copyright 2018-2019 NXP
4 *
5 * Peng Fan <peng.fan@nxp.com>
6 */
7
8#include <common.h>
9#include <asm/arch/clock.h>
10#include <asm/arch/imx-regs.h>
11#include <asm/arch/sys_proto.h>
12#include <asm/io.h>
Peng Fan99878462019-08-27 06:25:51 +000013#include <div64.h>
14#include <errno.h>
Simon Glassdbd79542020-05-10 11:40:11 -060015#include <linux/delay.h>
Peng Fan99878462019-08-27 06:25:51 +000016
17DECLARE_GLOBAL_DATA_PTR;
18
19static struct anamix_pll *ana_pll = (struct anamix_pll *)ANATOP_BASE_ADDR;
20
21void enable_ocotp_clk(unsigned char enable)
22{
Peng Fan60c29bb2019-12-30 16:52:30 +080023 clock_enable(CCGR_OCOTP, !!enable);
Peng Fan99878462019-08-27 06:25:51 +000024}
25
26int enable_i2c_clk(unsigned char enable, unsigned i2c_num)
27{
Peng Fan60c29bb2019-12-30 16:52:30 +080028 /* 0 - 3 is valid i2c num */
29 if (i2c_num > 3)
30 return -EINVAL;
Peng Fan99878462019-08-27 06:25:51 +000031
Peng Fan60c29bb2019-12-30 16:52:30 +080032 clock_enable(CCGR_I2C1 + i2c_num, !!enable);
Peng Fan99878462019-08-27 06:25:51 +000033
Peng Fan60c29bb2019-12-30 16:52:30 +080034 return 0;
Peng Fan99878462019-08-27 06:25:51 +000035}
36
37#ifdef CONFIG_SPL_BUILD
38static struct imx_int_pll_rate_table imx8mm_fracpll_tbl[] = {
Peng Fand29bf222019-12-27 11:40:55 +080039 PLL_1443X_RATE(1000000000U, 250, 3, 1, 0),
Peng Fan99878462019-08-27 06:25:51 +000040 PLL_1443X_RATE(800000000U, 300, 9, 0, 0),
41 PLL_1443X_RATE(750000000U, 250, 8, 0, 0),
42 PLL_1443X_RATE(650000000U, 325, 3, 2, 0),
43 PLL_1443X_RATE(600000000U, 300, 3, 2, 0),
44 PLL_1443X_RATE(594000000U, 99, 1, 2, 0),
45 PLL_1443X_RATE(400000000U, 300, 9, 1, 0),
46 PLL_1443X_RATE(266666667U, 400, 9, 2, 0),
47 PLL_1443X_RATE(167000000U, 334, 3, 4, 0),
48 PLL_1443X_RATE(100000000U, 300, 9, 3, 0),
49};
50
Alifer Moraes39931102020-01-14 15:54:59 -030051static int fracpll_configure(enum pll_clocks pll, u32 freq)
Peng Fan99878462019-08-27 06:25:51 +000052{
53 int i;
54 u32 tmp, div_val;
55 void *pll_base;
56 struct imx_int_pll_rate_table *rate;
57
58 for (i = 0; i < ARRAY_SIZE(imx8mm_fracpll_tbl); i++) {
59 if (freq == imx8mm_fracpll_tbl[i].rate)
60 break;
61 }
62
63 if (i == ARRAY_SIZE(imx8mm_fracpll_tbl)) {
64 printf("No matched freq table %u\n", freq);
65 return -EINVAL;
66 }
67
68 rate = &imx8mm_fracpll_tbl[i];
69
70 switch (pll) {
71 case ANATOP_DRAM_PLL:
72 setbits_le32(GPC_BASE_ADDR + 0xEC, 1 << 7);
73 setbits_le32(GPC_BASE_ADDR + 0xF8, 1 << 5);
74 writel(SRC_DDR1_ENABLE_MASK, SRC_BASE_ADDR + 0x1004);
75
76 pll_base = &ana_pll->dram_pll_gnrl_ctl;
77 break;
78 case ANATOP_VIDEO_PLL:
79 pll_base = &ana_pll->video_pll1_gnrl_ctl;
80 break;
81 default:
82 return 0;
83 }
84 /* Bypass clock and set lock to pll output lock */
85 tmp = readl(pll_base);
86 tmp |= BYPASS_MASK;
87 writel(tmp, pll_base);
88
89 /* Enable RST */
90 tmp &= ~RST_MASK;
91 writel(tmp, pll_base);
92
93 div_val = (rate->mdiv << MDIV_SHIFT) | (rate->pdiv << PDIV_SHIFT) |
94 (rate->sdiv << SDIV_SHIFT);
95 writel(div_val, pll_base + 4);
96 writel(rate->kdiv << KDIV_SHIFT, pll_base + 8);
97
98 __udelay(100);
99
100 /* Disable RST */
101 tmp |= RST_MASK;
102 writel(tmp, pll_base);
103
104 /* Wait Lock*/
105 while (!(readl(pll_base) & LOCK_STATUS))
106 ;
107
108 /* Bypass */
109 tmp &= ~BYPASS_MASK;
110 writel(tmp, pll_base);
111
112 return 0;
113}
114
115void dram_pll_init(ulong pll_val)
116{
117 fracpll_configure(ANATOP_DRAM_PLL, pll_val);
118}
119
120static struct dram_bypass_clk_setting imx8mm_dram_bypass_tbl[] = {
121 DRAM_BYPASS_ROOT_CONFIG(MHZ(100), 2, CLK_ROOT_PRE_DIV1, 2,
122 CLK_ROOT_PRE_DIV2),
123 DRAM_BYPASS_ROOT_CONFIG(MHZ(250), 3, CLK_ROOT_PRE_DIV2, 2,
124 CLK_ROOT_PRE_DIV2),
125 DRAM_BYPASS_ROOT_CONFIG(MHZ(400), 1, CLK_ROOT_PRE_DIV2, 3,
126 CLK_ROOT_PRE_DIV2),
127};
128
129void dram_enable_bypass(ulong clk_val)
130{
131 int i;
132 struct dram_bypass_clk_setting *config;
133
134 for (i = 0; i < ARRAY_SIZE(imx8mm_dram_bypass_tbl); i++) {
135 if (clk_val == imx8mm_dram_bypass_tbl[i].clk)
136 break;
137 }
138
139 if (i == ARRAY_SIZE(imx8mm_dram_bypass_tbl)) {
140 printf("No matched freq table %lu\n", clk_val);
141 return;
142 }
143
144 config = &imx8mm_dram_bypass_tbl[i];
145
146 clock_set_target_val(DRAM_ALT_CLK_ROOT, CLK_ROOT_ON |
147 CLK_ROOT_SOURCE_SEL(config->alt_root_sel) |
148 CLK_ROOT_PRE_DIV(config->alt_pre_div));
149 clock_set_target_val(DRAM_APB_CLK_ROOT, CLK_ROOT_ON |
150 CLK_ROOT_SOURCE_SEL(config->apb_root_sel) |
151 CLK_ROOT_PRE_DIV(config->apb_pre_div));
152 clock_set_target_val(DRAM_SEL_CFG, CLK_ROOT_ON |
153 CLK_ROOT_SOURCE_SEL(1));
154}
155
156void dram_disable_bypass(void)
157{
158 clock_set_target_val(DRAM_SEL_CFG, CLK_ROOT_ON |
159 CLK_ROOT_SOURCE_SEL(0));
160 clock_set_target_val(DRAM_APB_CLK_ROOT, CLK_ROOT_ON |
161 CLK_ROOT_SOURCE_SEL(4) |
162 CLK_ROOT_PRE_DIV(CLK_ROOT_PRE_DIV5));
163}
164#endif
165
166void init_uart_clk(u32 index)
167{
168 /*
169 * set uart clock root
170 * 24M OSC
171 */
172 switch (index) {
173 case 0:
174 clock_enable(CCGR_UART1, 0);
175 clock_set_target_val(UART1_CLK_ROOT, CLK_ROOT_ON |
176 CLK_ROOT_SOURCE_SEL(0));
177 clock_enable(CCGR_UART1, 1);
178 return;
179 case 1:
180 clock_enable(CCGR_UART2, 0);
181 clock_set_target_val(UART2_CLK_ROOT, CLK_ROOT_ON |
182 CLK_ROOT_SOURCE_SEL(0));
183 clock_enable(CCGR_UART2, 1);
184 return;
185 case 2:
186 clock_enable(CCGR_UART3, 0);
187 clock_set_target_val(UART3_CLK_ROOT, CLK_ROOT_ON |
188 CLK_ROOT_SOURCE_SEL(0));
189 clock_enable(CCGR_UART3, 1);
190 return;
191 case 3:
192 clock_enable(CCGR_UART4, 0);
193 clock_set_target_val(UART4_CLK_ROOT, CLK_ROOT_ON |
194 CLK_ROOT_SOURCE_SEL(0));
195 clock_enable(CCGR_UART4, 1);
196 return;
197 default:
198 printf("Invalid uart index\n");
199 return;
200 }
201}
202
203void init_wdog_clk(void)
204{
205 clock_enable(CCGR_WDOG1, 0);
206 clock_enable(CCGR_WDOG2, 0);
207 clock_enable(CCGR_WDOG3, 0);
208 clock_set_target_val(WDOG_CLK_ROOT, CLK_ROOT_ON |
209 CLK_ROOT_SOURCE_SEL(0));
210 clock_enable(CCGR_WDOG1, 1);
211 clock_enable(CCGR_WDOG2, 1);
212 clock_enable(CCGR_WDOG3, 1);
213}
214
215int clock_init(void)
216{
217 u32 val_cfg0;
218
219 /*
220 * The gate is not exported to clk tree, so configure them here.
221 * According to ANAMIX SPEC
222 * sys pll1 fixed at 800MHz
223 * sys pll2 fixed at 1GHz
224 * Here we only enable the outputs.
225 */
226 val_cfg0 = readl(&ana_pll->sys_pll1_gnrl_ctl);
227 val_cfg0 |= INTPLL_CLKE_MASK | INTPLL_DIV2_CLKE_MASK |
228 INTPLL_DIV3_CLKE_MASK | INTPLL_DIV4_CLKE_MASK |
229 INTPLL_DIV5_CLKE_MASK | INTPLL_DIV6_CLKE_MASK |
230 INTPLL_DIV8_CLKE_MASK | INTPLL_DIV10_CLKE_MASK |
231 INTPLL_DIV20_CLKE_MASK;
232 writel(val_cfg0, &ana_pll->sys_pll1_gnrl_ctl);
233
234 val_cfg0 = readl(&ana_pll->sys_pll2_gnrl_ctl);
235 val_cfg0 |= INTPLL_CLKE_MASK | INTPLL_DIV2_CLKE_MASK |
236 INTPLL_DIV3_CLKE_MASK | INTPLL_DIV4_CLKE_MASK |
237 INTPLL_DIV5_CLKE_MASK | INTPLL_DIV6_CLKE_MASK |
238 INTPLL_DIV8_CLKE_MASK | INTPLL_DIV10_CLKE_MASK |
239 INTPLL_DIV20_CLKE_MASK;
240 writel(val_cfg0, &ana_pll->sys_pll2_gnrl_ctl);
241
242 /* config GIC to sys_pll2_100m */
243 clock_enable(CCGR_GIC, 0);
244 clock_set_target_val(GIC_CLK_ROOT, CLK_ROOT_ON |
245 CLK_ROOT_SOURCE_SEL(3));
246 clock_enable(CCGR_GIC, 1);
247
248 clock_set_target_val(NAND_USDHC_BUS_CLK_ROOT, CLK_ROOT_ON |
249 CLK_ROOT_SOURCE_SEL(1));
250
251 clock_enable(CCGR_DDR1, 0);
252 clock_set_target_val(DRAM_ALT_CLK_ROOT, CLK_ROOT_ON |
253 CLK_ROOT_SOURCE_SEL(1));
254 clock_set_target_val(DRAM_APB_CLK_ROOT, CLK_ROOT_ON |
255 CLK_ROOT_SOURCE_SEL(1));
256 clock_enable(CCGR_DDR1, 1);
257
258 init_wdog_clk();
259
260 clock_enable(CCGR_TEMP_SENSOR, 1);
261
262 clock_enable(CCGR_SEC_DEBUG, 1);
263
264 return 0;
265};
266
267u32 imx_get_uartclk(void)
268{
269 return 24000000U;
270}
271
Alifer Moraes39931102020-01-14 15:54:59 -0300272static u32 decode_intpll(enum clk_root_src intpll)
Peng Fan60c29bb2019-12-30 16:52:30 +0800273{
274 u32 pll_gnrl_ctl, pll_div_ctl, pll_clke_mask;
275 u32 main_div, pre_div, post_div, div;
276 u64 freq;
277
278 switch (intpll) {
279 case ARM_PLL_CLK:
280 pll_gnrl_ctl = readl(&ana_pll->arm_pll_gnrl_ctl);
281 pll_div_ctl = readl(&ana_pll->arm_pll_div_ctl);
282 break;
283 case GPU_PLL_CLK:
284 pll_gnrl_ctl = readl(&ana_pll->gpu_pll_gnrl_ctl);
285 pll_div_ctl = readl(&ana_pll->gpu_pll_div_ctl);
286 break;
287 case VPU_PLL_CLK:
288 pll_gnrl_ctl = readl(&ana_pll->vpu_pll_gnrl_ctl);
289 pll_div_ctl = readl(&ana_pll->vpu_pll_div_ctl);
290 break;
291 case SYSTEM_PLL1_800M_CLK:
292 case SYSTEM_PLL1_400M_CLK:
293 case SYSTEM_PLL1_266M_CLK:
294 case SYSTEM_PLL1_200M_CLK:
295 case SYSTEM_PLL1_160M_CLK:
296 case SYSTEM_PLL1_133M_CLK:
297 case SYSTEM_PLL1_100M_CLK:
298 case SYSTEM_PLL1_80M_CLK:
299 case SYSTEM_PLL1_40M_CLK:
300 pll_gnrl_ctl = readl(&ana_pll->sys_pll1_gnrl_ctl);
301 pll_div_ctl = readl(&ana_pll->sys_pll1_div_ctl);
302 break;
303 case SYSTEM_PLL2_1000M_CLK:
304 case SYSTEM_PLL2_500M_CLK:
305 case SYSTEM_PLL2_333M_CLK:
306 case SYSTEM_PLL2_250M_CLK:
307 case SYSTEM_PLL2_200M_CLK:
308 case SYSTEM_PLL2_166M_CLK:
309 case SYSTEM_PLL2_125M_CLK:
310 case SYSTEM_PLL2_100M_CLK:
311 case SYSTEM_PLL2_50M_CLK:
312 pll_gnrl_ctl = readl(&ana_pll->sys_pll2_gnrl_ctl);
313 pll_div_ctl = readl(&ana_pll->sys_pll2_div_ctl);
314 break;
315 case SYSTEM_PLL3_CLK:
316 pll_gnrl_ctl = readl(&ana_pll->sys_pll3_gnrl_ctl);
317 pll_div_ctl = readl(&ana_pll->sys_pll3_div_ctl);
318 break;
319 default:
320 return -EINVAL;
321 }
322
323 /* Only support SYS_XTAL 24M, PAD_CLK not take into consideration */
324 if ((pll_gnrl_ctl & INTPLL_REF_CLK_SEL_MASK) != 0)
325 return 0;
326
327 if ((pll_gnrl_ctl & INTPLL_RST_MASK) == 0)
328 return 0;
329
330 /*
331 * When BYPASS is equal to 1, PLL enters the bypass mode
332 * regardless of the values of RESETB
333 */
334 if (pll_gnrl_ctl & INTPLL_BYPASS_MASK)
335 return 24000000u;
336
337 if (!(pll_gnrl_ctl & INTPLL_LOCK_MASK)) {
338 puts("pll not locked\n");
339 return 0;
340 }
341
342 switch (intpll) {
343 case ARM_PLL_CLK:
344 case GPU_PLL_CLK:
345 case VPU_PLL_CLK:
346 case SYSTEM_PLL3_CLK:
347 case SYSTEM_PLL1_800M_CLK:
348 case SYSTEM_PLL2_1000M_CLK:
349 pll_clke_mask = INTPLL_CLKE_MASK;
350 div = 1;
351 break;
352
353 case SYSTEM_PLL1_400M_CLK:
354 case SYSTEM_PLL2_500M_CLK:
355 pll_clke_mask = INTPLL_DIV2_CLKE_MASK;
356 div = 2;
357 break;
358
359 case SYSTEM_PLL1_266M_CLK:
360 case SYSTEM_PLL2_333M_CLK:
361 pll_clke_mask = INTPLL_DIV3_CLKE_MASK;
362 div = 3;
363 break;
364
365 case SYSTEM_PLL1_200M_CLK:
366 case SYSTEM_PLL2_250M_CLK:
367 pll_clke_mask = INTPLL_DIV4_CLKE_MASK;
368 div = 4;
369 break;
370
371 case SYSTEM_PLL1_160M_CLK:
372 case SYSTEM_PLL2_200M_CLK:
373 pll_clke_mask = INTPLL_DIV5_CLKE_MASK;
374 div = 5;
375 break;
376
377 case SYSTEM_PLL1_133M_CLK:
378 case SYSTEM_PLL2_166M_CLK:
379 pll_clke_mask = INTPLL_DIV6_CLKE_MASK;
380 div = 6;
381 break;
382
383 case SYSTEM_PLL1_100M_CLK:
384 case SYSTEM_PLL2_125M_CLK:
385 pll_clke_mask = INTPLL_DIV8_CLKE_MASK;
386 div = 8;
387 break;
388
389 case SYSTEM_PLL1_80M_CLK:
390 case SYSTEM_PLL2_100M_CLK:
391 pll_clke_mask = INTPLL_DIV10_CLKE_MASK;
392 div = 10;
393 break;
394
395 case SYSTEM_PLL1_40M_CLK:
396 case SYSTEM_PLL2_50M_CLK:
397 pll_clke_mask = INTPLL_DIV20_CLKE_MASK;
398 div = 20;
399 break;
400 default:
401 return -EINVAL;
402 }
403
404 if ((pll_gnrl_ctl & pll_clke_mask) == 0)
405 return 0;
406
407 main_div = (pll_div_ctl & INTPLL_MAIN_DIV_MASK) >>
408 INTPLL_MAIN_DIV_SHIFT;
409 pre_div = (pll_div_ctl & INTPLL_PRE_DIV_MASK) >>
410 INTPLL_PRE_DIV_SHIFT;
411 post_div = (pll_div_ctl & INTPLL_POST_DIV_MASK) >>
412 INTPLL_POST_DIV_SHIFT;
413
414 /* FFVCO = (m * FFIN) / p, FFOUT = (m * FFIN) / (p * 2^s) */
415 freq = 24000000ULL * main_div;
416 return lldiv(freq, pre_div * (1 << post_div) * div);
417}
418
Alifer Moraes39931102020-01-14 15:54:59 -0300419static u32 decode_fracpll(enum clk_root_src frac_pll)
Peng Fan60c29bb2019-12-30 16:52:30 +0800420{
421 u32 pll_gnrl_ctl, pll_fdiv_ctl0, pll_fdiv_ctl1;
422 u32 main_div, pre_div, post_div, k;
423
424 switch (frac_pll) {
425 case DRAM_PLL1_CLK:
426 pll_gnrl_ctl = readl(&ana_pll->dram_pll_gnrl_ctl);
427 pll_fdiv_ctl0 = readl(&ana_pll->dram_pll_fdiv_ctl0);
428 pll_fdiv_ctl1 = readl(&ana_pll->dram_pll_fdiv_ctl1);
429 break;
430 case AUDIO_PLL1_CLK:
431 pll_gnrl_ctl = readl(&ana_pll->audio_pll1_gnrl_ctl);
432 pll_fdiv_ctl0 = readl(&ana_pll->audio_pll1_fdiv_ctl0);
433 pll_fdiv_ctl1 = readl(&ana_pll->audio_pll1_fdiv_ctl1);
434 break;
435 case AUDIO_PLL2_CLK:
436 pll_gnrl_ctl = readl(&ana_pll->audio_pll2_gnrl_ctl);
437 pll_fdiv_ctl0 = readl(&ana_pll->audio_pll2_fdiv_ctl0);
438 pll_fdiv_ctl1 = readl(&ana_pll->audio_pll2_fdiv_ctl1);
439 break;
440 case VIDEO_PLL_CLK:
441 pll_gnrl_ctl = readl(&ana_pll->video_pll1_gnrl_ctl);
442 pll_fdiv_ctl0 = readl(&ana_pll->video_pll1_fdiv_ctl0);
443 pll_fdiv_ctl1 = readl(&ana_pll->video_pll1_fdiv_ctl1);
444 break;
445 default:
446 printf("Not supported\n");
447 return 0;
448 }
449
450 /* Only support SYS_XTAL 24M, PAD_CLK not take into consideration */
Ye Licc643ea2020-03-23 19:54:29 -0700451 if ((pll_gnrl_ctl & GENMASK(1, 0)) != 0)
Peng Fan60c29bb2019-12-30 16:52:30 +0800452 return 0;
453
Ye Licc643ea2020-03-23 19:54:29 -0700454 if ((pll_gnrl_ctl & RST_MASK) == 0)
Peng Fan60c29bb2019-12-30 16:52:30 +0800455 return 0;
456 /*
457 * When BYPASS is equal to 1, PLL enters the bypass mode
458 * regardless of the values of RESETB
459 */
Ye Licc643ea2020-03-23 19:54:29 -0700460 if (pll_gnrl_ctl & BYPASS_MASK)
Peng Fan60c29bb2019-12-30 16:52:30 +0800461 return 24000000u;
462
Ye Licc643ea2020-03-23 19:54:29 -0700463 if (!(pll_gnrl_ctl & LOCK_STATUS)) {
Peng Fan60c29bb2019-12-30 16:52:30 +0800464 puts("pll not locked\n");
465 return 0;
466 }
467
Ye Licc643ea2020-03-23 19:54:29 -0700468 if (!(pll_gnrl_ctl & CLKE_MASK))
Peng Fan60c29bb2019-12-30 16:52:30 +0800469 return 0;
470
Ye Licc643ea2020-03-23 19:54:29 -0700471 main_div = (pll_fdiv_ctl0 & MDIV_MASK) >>
472 MDIV_SHIFT;
473 pre_div = (pll_fdiv_ctl0 & PDIV_MASK) >>
474 PDIV_SHIFT;
475 post_div = (pll_fdiv_ctl0 & SDIV_MASK) >>
476 SDIV_SHIFT;
Peng Fan60c29bb2019-12-30 16:52:30 +0800477
Ye Licc643ea2020-03-23 19:54:29 -0700478 k = pll_fdiv_ctl1 & KDIV_MASK;
Peng Fan60c29bb2019-12-30 16:52:30 +0800479
480 return lldiv((main_div * 65536 + k) * 24000000ULL,
481 65536 * pre_div * (1 << post_div));
482}
483
Alifer Moraes39931102020-01-14 15:54:59 -0300484static u32 get_root_src_clk(enum clk_root_src root_src)
Peng Fan60c29bb2019-12-30 16:52:30 +0800485{
486 switch (root_src) {
487 case OSC_24M_CLK:
488 return 24000000u;
489 case OSC_HDMI_CLK:
490 return 26000000u;
491 case OSC_32K_CLK:
492 return 32000u;
493 case ARM_PLL_CLK:
494 case GPU_PLL_CLK:
495 case VPU_PLL_CLK:
496 case SYSTEM_PLL1_800M_CLK:
497 case SYSTEM_PLL1_400M_CLK:
498 case SYSTEM_PLL1_266M_CLK:
499 case SYSTEM_PLL1_200M_CLK:
500 case SYSTEM_PLL1_160M_CLK:
501 case SYSTEM_PLL1_133M_CLK:
502 case SYSTEM_PLL1_100M_CLK:
503 case SYSTEM_PLL1_80M_CLK:
504 case SYSTEM_PLL1_40M_CLK:
505 case SYSTEM_PLL2_1000M_CLK:
506 case SYSTEM_PLL2_500M_CLK:
507 case SYSTEM_PLL2_333M_CLK:
508 case SYSTEM_PLL2_250M_CLK:
509 case SYSTEM_PLL2_200M_CLK:
510 case SYSTEM_PLL2_166M_CLK:
511 case SYSTEM_PLL2_125M_CLK:
512 case SYSTEM_PLL2_100M_CLK:
513 case SYSTEM_PLL2_50M_CLK:
514 case SYSTEM_PLL3_CLK:
515 return decode_intpll(root_src);
516 case DRAM_PLL1_CLK:
517 case AUDIO_PLL1_CLK:
518 case AUDIO_PLL2_CLK:
519 case VIDEO_PLL_CLK:
520 return decode_fracpll(root_src);
521 default:
522 return 0;
523 }
524
525 return 0;
526}
527
Alifer Moraes39931102020-01-14 15:54:59 -0300528static u32 get_root_clk(enum clk_root_index clock_id)
Peng Fan60c29bb2019-12-30 16:52:30 +0800529{
530 enum clk_root_src root_src;
531 u32 post_podf, pre_podf, root_src_clk;
532
533 if (clock_root_enabled(clock_id) <= 0)
534 return 0;
535
536 if (clock_get_prediv(clock_id, &pre_podf) < 0)
537 return 0;
538
539 if (clock_get_postdiv(clock_id, &post_podf) < 0)
540 return 0;
541
542 if (clock_get_src(clock_id, &root_src) < 0)
543 return 0;
544
545 root_src_clk = get_root_src_clk(root_src);
546
547 return root_src_clk / (post_podf + 1) / (pre_podf + 1);
548}
549
Peng Fan99878462019-08-27 06:25:51 +0000550u32 mxc_get_clock(enum mxc_clock clk)
551{
Peng Fan60c29bb2019-12-30 16:52:30 +0800552 u32 val;
Peng Fan99878462019-08-27 06:25:51 +0000553
554 switch (clk) {
Peng Fan99878462019-08-27 06:25:51 +0000555 case MXC_ARM_CLK:
Peng Fan60c29bb2019-12-30 16:52:30 +0800556 return get_root_clk(ARM_A53_CLK_ROOT);
557 case MXC_IPG_CLK:
558 clock_get_target_val(IPG_CLK_ROOT, &val);
559 val = val & 0x3;
560 return get_root_clk(AHB_CLK_ROOT) / 2 / (val + 1);
561 case MXC_CSPI_CLK:
562 return get_root_clk(ECSPI1_CLK_ROOT);
563 case MXC_ESDHC_CLK:
564 return get_root_clk(USDHC1_CLK_ROOT);
565 case MXC_ESDHC2_CLK:
566 return get_root_clk(USDHC2_CLK_ROOT);
567 case MXC_ESDHC3_CLK:
568 return get_root_clk(USDHC3_CLK_ROOT);
569 case MXC_I2C_CLK:
570 return get_root_clk(I2C1_CLK_ROOT);
571 case MXC_UART_CLK:
572 return get_root_clk(UART1_CLK_ROOT);
573 case MXC_QSPI_CLK:
574 return get_root_clk(QSPI_CLK_ROOT);
Peng Fan99878462019-08-27 06:25:51 +0000575 default:
Peng Fan60c29bb2019-12-30 16:52:30 +0800576 printf("Unsupported mxc_clock %d\n", clk);
577 break;
Peng Fan99878462019-08-27 06:25:51 +0000578 }
579
580 return 0;
581}
Marek Vasut363725d2020-04-24 21:37:26 +0200582
583#ifdef CONFIG_FEC_MXC
584int set_clk_enet(enum enet_freq type)
585{
586 u32 target;
587 u32 enet1_ref;
588
589 switch (type) {
590 case ENET_125MHZ:
591 enet1_ref = ENET1_REF_CLK_ROOT_FROM_PLL_ENET_MAIN_125M_CLK;
592 break;
593 case ENET_50MHZ:
594 enet1_ref = ENET1_REF_CLK_ROOT_FROM_PLL_ENET_MAIN_50M_CLK;
595 break;
596 case ENET_25MHZ:
597 enet1_ref = ENET1_REF_CLK_ROOT_FROM_PLL_ENET_MAIN_25M_CLK;
598 break;
599 default:
600 return -EINVAL;
601 }
602
603 /* disable the clock first */
604 clock_enable(CCGR_ENET1, 0);
605 clock_enable(CCGR_SIM_ENET, 0);
606
607 /* set enet axi clock 266Mhz */
608 target = CLK_ROOT_ON | ENET_AXI_CLK_ROOT_FROM_SYS1_PLL_266M |
609 CLK_ROOT_PRE_DIV(CLK_ROOT_PRE_DIV1) |
610 CLK_ROOT_POST_DIV(CLK_ROOT_POST_DIV1);
611 clock_set_target_val(ENET_AXI_CLK_ROOT, target);
612
613 target = CLK_ROOT_ON | enet1_ref |
614 CLK_ROOT_PRE_DIV(CLK_ROOT_PRE_DIV1) |
615 CLK_ROOT_POST_DIV(CLK_ROOT_POST_DIV1);
616 clock_set_target_val(ENET_REF_CLK_ROOT, target);
617
618 target = CLK_ROOT_ON |
619 ENET1_TIME_CLK_ROOT_FROM_PLL_ENET_MAIN_100M_CLK |
620 CLK_ROOT_PRE_DIV(CLK_ROOT_PRE_DIV1) |
621 CLK_ROOT_POST_DIV(CLK_ROOT_POST_DIV4);
622 clock_set_target_val(ENET_TIMER_CLK_ROOT, target);
623
624 /* enable clock */
625 clock_enable(CCGR_SIM_ENET, 1);
626 clock_enable(CCGR_ENET1, 1);
627
628 return 0;
629}
630#endif