3 * Sascha Hauer, Pengutronix
5 * (C) Copyright 2008-2010 Freescale Semiconductor, Inc.
7 * See file CREDITS for list of people who contributed to this
10 * This program is free software; you can redistribute it and/or
11 * modify it under the terms of the GNU General Public License as
12 * published by the Free Software Foundation; either version 2 of
13 * the License, or (at your option) any later version.
15 * This program is distributed in the hope that it will be useful,
16 * but WITHOUT ANY WARRANTY; without even the implied warranty of
17 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
18 * GNU General Public License for more details.
20 * You should have received a copy of the GNU General Public License
21 * along with this program; if not, write to the Free Software
22 * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
29 #include <asm/errno.h>
30 #include <asm/arch/imx-regs.h>
31 #include <asm/arch/crm_regs.h>
32 #include <asm/arch/clock.h>
33 #include <asm/arch/sys_proto.h>
34 #ifdef CONFIG_FSL_ESDHC
35 #include <fsl_esdhc.h>
39 #define CLK_CODE(arm, ahb, sel) (((arm) << 16) + ((ahb) << 8) + (sel))
40 #define CLK_CODE_ARM(c) (((c) >> 16) & 0xFF)
41 #define CLK_CODE_AHB(c) (((c) >> 8) & 0xFF)
42 #define CLK_CODE_PATH(c) ((c) & 0xFF)
44 #define CCM_GET_DIVIDER(x, m, o) (((x) & (m)) >> (o))
46 #ifdef CONFIG_FSL_ESDHC
47 DECLARE_GLOBAL_DATA_PTR;
50 static int g_clk_mux_auto[8] = {
51 CLK_CODE(1, 3, 0), CLK_CODE(1, 2, 1), CLK_CODE(2, 1, 1), -1,
52 CLK_CODE(1, 6, 0), CLK_CODE(1, 4, 1), CLK_CODE(2, 2, 1), -1,
55 static int g_clk_mux_consumer[16] = {
56 CLK_CODE(1, 4, 0), CLK_CODE(1, 3, 1), CLK_CODE(1, 3, 1), -1,
57 -1, -1, CLK_CODE(4, 1, 0), CLK_CODE(1, 5, 0),
58 CLK_CODE(1, 8, 1), CLK_CODE(1, 6, 1), CLK_CODE(2, 4, 0), -1,
59 -1, -1, CLK_CODE(4, 2, 0), -1,
62 static int hsp_div_table[3][16] = {
63 {4, 3, 2, -1, -1, -1, 1, 5, 4, 3, 2, -1, -1, -1, 1, -1},
64 {-1, -1, -1, -1, -1, -1, -1, -1, 8, 6, 4, -1, -1, -1, 2, -1},
65 {3, -1, -1, -1, -1, -1, -1, -1, 3, -1, -1, -1, -1, -1, -1, -1},
71 struct iim_regs *iim =
72 (struct iim_regs *)IIM_BASE_ADDR;
73 reg = readl(&iim->iim_srev);
75 reg = readw(ROMPATCH_REV);
81 return 0x35000 + (reg & 0xFF);
84 static u32 get_arm_div(u32 pdr0, u32 *fi, u32 *fd)
87 if (pdr0 & MXC_CCM_PDR0_AUTO_CON) {
88 pclk_mux = g_clk_mux_consumer +
89 ((pdr0 & MXC_CCM_PDR0_CON_MUX_DIV_MASK) >>
90 MXC_CCM_PDR0_CON_MUX_DIV_OFFSET);
92 pclk_mux = g_clk_mux_auto +
93 ((pdr0 & MXC_CCM_PDR0_AUTO_MUX_DIV_MASK) >>
94 MXC_CCM_PDR0_AUTO_MUX_DIV_OFFSET);
97 if ((*pclk_mux) == -1)
101 if (!CLK_CODE_PATH(*pclk_mux)) {
103 return CLK_CODE_ARM(*pclk_mux);
105 if (pdr0 & MXC_CCM_PDR0_AUTO_CON) {
113 return CLK_CODE_ARM(*pclk_mux);
116 static int get_ahb_div(u32 pdr0)
120 pclk_mux = g_clk_mux_consumer +
121 ((pdr0 & MXC_CCM_PDR0_CON_MUX_DIV_MASK) >>
122 MXC_CCM_PDR0_CON_MUX_DIV_OFFSET);
124 if ((*pclk_mux) == -1)
127 return CLK_CODE_AHB(*pclk_mux);
130 static u32 decode_pll(u32 reg, u32 infreq)
132 u32 mfi = (reg >> 10) & 0xf;
133 s32 mfn = reg & 0x3ff;
134 u32 mfd = (reg >> 16) & 0x3ff;
135 u32 pd = (reg >> 26) & 0xf;
137 mfi = mfi <= 5 ? 5 : mfi;
138 mfn = mfn >= 512 ? mfn - 1024 : mfn;
142 return lldiv(2 * (u64)infreq * (mfi * mfd + mfn),
146 static u32 get_mcu_main_clk(void)
148 u32 arm_div = 0, fi = 0, fd = 0;
149 struct ccm_regs *ccm =
150 (struct ccm_regs *)IMX_CCM_BASE;
151 arm_div = get_arm_div(readl(&ccm->pdr0), &fi, &fd);
152 fi *= decode_pll(readl(&ccm->mpctl), MXC_HCLK);
153 return fi / (arm_div * fd);
156 static u32 get_ipg_clk(void)
158 u32 freq = get_mcu_main_clk();
159 struct ccm_regs *ccm =
160 (struct ccm_regs *)IMX_CCM_BASE;
161 u32 pdr0 = readl(&ccm->pdr0);
163 return freq / (get_ahb_div(pdr0) * 2);
166 static u32 get_ipg_per_clk(void)
168 u32 freq = get_mcu_main_clk();
169 struct ccm_regs *ccm =
170 (struct ccm_regs *)IMX_CCM_BASE;
171 u32 pdr0 = readl(&ccm->pdr0);
172 u32 pdr4 = readl(&ccm->pdr4);
174 if (pdr0 & MXC_CCM_PDR0_PER_SEL) {
175 div = CCM_GET_DIVIDER(pdr4,
176 MXC_CCM_PDR4_PER0_PODF_MASK,
177 MXC_CCM_PDR4_PER0_PODF_OFFSET) + 1;
179 div = CCM_GET_DIVIDER(pdr0,
180 MXC_CCM_PDR0_PER_PODF_MASK,
181 MXC_CCM_PDR0_PER_PODF_OFFSET) + 1;
182 div *= get_ahb_div(pdr0);
187 u32 imx_get_uartclk(void)
190 struct ccm_regs *ccm =
191 (struct ccm_regs *)IMX_CCM_BASE;
192 u32 pdr4 = readl(&ccm->pdr4);
194 if (readl(&ccm->pdr3) & MXC_CCM_PDR3_UART_M_U)
195 freq = get_mcu_main_clk();
197 freq = decode_pll(readl(&ccm->ppctl), MXC_HCLK);
198 freq /= CCM_GET_DIVIDER(pdr4,
199 MXC_CCM_PDR4_UART_PODF_MASK,
200 MXC_CCM_PDR4_UART_PODF_OFFSET) + 1;
204 unsigned int mxc_get_main_clock(enum mxc_main_clock clk)
206 u32 nfc_pdf, hsp_podf;
207 u32 pll, ret_val = 0, usb_podf;
208 struct ccm_regs *ccm =
209 (struct ccm_regs *)IMX_CCM_BASE;
211 u32 reg = readl(&ccm->pdr0);
212 u32 reg4 = readl(&ccm->pdr4);
218 ret_val = get_mcu_main_clk();
221 ret_val = get_mcu_main_clk();
224 if (reg & CLKMODE_CONSUMER) {
225 hsp_podf = (reg >> 20) & 0x3;
226 pll = get_mcu_main_clk();
227 hsp_podf = hsp_div_table[hsp_podf][(reg>>16)&0xF];
229 ret_val = pll / hsp_podf;
231 puts("mismatch HSP with ARM clock setting\n");
235 ret_val = get_mcu_main_clk();
239 ret_val = get_ipg_clk();
242 ret_val = get_ipg_per_clk();
245 nfc_pdf = (reg4 >> 28) & 0xF;
246 pll = get_mcu_main_clk();
248 ret_val = pll / (nfc_pdf + 1);
251 usb_podf = (reg4 >> 22) & 0x3F;
253 pll = get_mcu_main_clk();
255 pll = decode_pll(readl(&ccm->ppctl), MXC_HCLK);
257 ret_val = pll / (usb_podf + 1);
260 printf("Unknown clock: %d\n", clk);
266 unsigned int mxc_get_peri_clock(enum mxc_peri_clock clk)
268 u32 ret_val = 0, pdf, pre_pdf, clk_sel;
269 struct ccm_regs *ccm =
270 (struct ccm_regs *)IMX_CCM_BASE;
271 u32 mpdr2 = readl(&ccm->pdr2);
272 u32 mpdr3 = readl(&ccm->pdr3);
273 u32 mpdr4 = readl(&ccm->pdr4);
279 clk_sel = mpdr3 & (1 << 14);
280 pdf = (mpdr4 >> 10) & 0x3F;
281 ret_val = ((clk_sel != 0) ? mxc_get_main_clock(CPU_CLK) :
282 decode_pll(readl(&ccm->ppctl), MXC_HCLK)) / (pdf + 1);
285 pre_pdf = (mpdr2 >> 24) & 0x7;
287 clk_sel = mpdr2 & (1 << 6);
288 ret_val = ((clk_sel != 0) ? mxc_get_main_clock(CPU_CLK) :
289 decode_pll(readl(&ccm->ppctl), MXC_HCLK)) /
290 ((pre_pdf + 1) * (pdf + 1));
293 pre_pdf = (mpdr2 >> 27) & 0x7;
294 pdf = (mpdr2 >> 8) & 0x3F;
295 clk_sel = mpdr2 & (1 << 6);
296 ret_val = ((clk_sel != 0) ? mxc_get_main_clock(CPU_CLK) :
297 decode_pll(readl(&ccm->ppctl), MXC_HCLK)) /
298 ((pre_pdf + 1) * (pdf + 1));
301 clk_sel = mpdr2 & (1 << 7);
302 pdf = (mpdr2 >> 16) & 0x3F;
303 ret_val = ((clk_sel != 0) ? mxc_get_main_clock(CPU_CLK) :
304 decode_pll(readl(&ccm->ppctl), MXC_HCLK)) / (pdf + 1);
307 pre_pdf = readl(&ccm->pdr1);
308 clk_sel = (pre_pdf & 0x80);
309 pdf = (pre_pdf >> 22) & 0x3F;
310 pre_pdf = (pre_pdf >> 28) & 0x7;
311 ret_val = ((clk_sel != 0) ? mxc_get_main_clock(CPU_CLK) :
312 decode_pll(readl(&ccm->ppctl), MXC_HCLK)) /
313 ((pre_pdf + 1) * (pdf + 1));
316 clk_sel = mpdr3 & 0x40;
318 ret_val = ((clk_sel != 0) ? mxc_get_main_clock(CPU_CLK) :
319 decode_pll(readl(&ccm->ppctl), MXC_HCLK)) / (pdf + 1);
322 clk_sel = mpdr3 & 0x40;
323 pdf = (mpdr3 >> 8) & 0x3F;
324 ret_val = ((clk_sel != 0) ? mxc_get_main_clock(CPU_CLK) :
325 decode_pll(readl(&ccm->ppctl), MXC_HCLK)) / (pdf + 1);
328 clk_sel = mpdr3 & 0x40;
329 pdf = (mpdr3 >> 16) & 0x3F;
330 ret_val = ((clk_sel != 0) ? mxc_get_main_clock(CPU_CLK) :
331 decode_pll(readl(&ccm->ppctl), MXC_HCLK)) / (pdf + 1);
334 clk_sel = mpdr3 & 0x400000;
335 pre_pdf = (mpdr3 >> 29) & 0x7;
336 pdf = (mpdr3 >> 23) & 0x3F;
337 ret_val = ((clk_sel != 0) ? mxc_get_main_clock(CPU_CLK) :
338 decode_pll(readl(&ccm->ppctl), MXC_HCLK)) /
339 ((pre_pdf + 1) * (pdf + 1));
342 printf("%s(): This clock: %d not supported yet\n",
350 unsigned int mxc_get_clock(enum mxc_clock clk)
354 return get_mcu_main_clk();
358 return get_ipg_clk();
360 return get_ipg_per_clk();
362 return imx_get_uartclk();
364 return mxc_get_peri_clock(ESDHC1_CLK);
366 return mxc_get_main_clock(USB_CLK);
368 return get_ipg_clk();
370 return get_ipg_clk();
375 #ifdef CONFIG_FEC_MXC
377 * The MX35 has no fuse for MAC, return a NULL MAC
379 void imx_get_mac_from_fuse(int dev_id, unsigned char *mac)
384 u32 imx_get_fecclk(void)
386 return mxc_get_clock(MXC_IPG_CLK);
390 int do_mx35_showclocks(cmd_tbl_t *cmdtp,
391 int flag, int argc, char * const argv[])
393 u32 cpufreq = get_mcu_main_clk();
394 printf("mx35 cpu clock: %dMHz\n", cpufreq / 1000000);
395 printf("ipg clock : %dHz\n", get_ipg_clk());
396 printf("ipg per clock : %dHz\n", get_ipg_per_clk());
397 printf("uart clock : %dHz\n", mxc_get_clock(MXC_UART_CLK));
403 clocks, CONFIG_SYS_MAXARGS, 1, do_mx35_showclocks,
408 #if defined(CONFIG_DISPLAY_CPUINFO)
409 static char *get_reset_cause(void)
411 /* read RCSR register from CCM module */
412 struct ccm_regs *ccm =
413 (struct ccm_regs *)IMX_CCM_BASE;
415 u32 cause = readl(&ccm->rcsr) & 0x0F;
427 return "unknown reset";
431 int print_cpuinfo(void)
433 u32 srev = get_cpu_rev();
435 printf("CPU: Freescale i.MX35 rev %d.%d at %d MHz.\n",
436 (srev & 0xF0) >> 4, (srev & 0x0F),
437 get_mcu_main_clk() / 1000000);
439 printf("Reset cause: %s\n", get_reset_cause());
446 * Initializes on-chip ethernet controllers.
447 * to override, implement board_eth_init()
449 int cpu_eth_init(bd_t *bis)
453 #if defined(CONFIG_FEC_MXC)
454 rc = fecmxc_initialize(bis);
460 #ifdef CONFIG_FSL_ESDHC
462 * Initializes on-chip MMC controllers.
463 * to override, implement board_mmc_init()
465 int cpu_mmc_init(bd_t *bis)
467 return fsl_esdhc_mmc_init(bis);
473 #ifdef CONFIG_FSL_ESDHC
474 gd->sdhc_clk = mxc_get_clock(MXC_ESDHC_CLK);
479 void reset_cpu(ulong addr)
481 struct wdog_regs *wdog = (struct wdog_regs *)WDOG_BASE_ADDR;
482 writew(4, &wdog->wcr);