2 * Copyright (C) 2009 by Sascha Hauer, Pengutronix
4 * This program is free software; you can redistribute it and/or
5 * modify it under the terms of the GNU General Public License
6 * as published by the Free Software Foundation; either version 2
7 * of the License, or (at your option) any later version.
8 * This program is distributed in the hope that it will be useful,
9 * but WITHOUT ANY WARRANTY; without even the implied warranty of
10 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
11 * GNU General Public License for more details.
13 * You should have received a copy of the GNU General Public License
14 * along with this program; if not, write to the Free Software
15 * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston,
19 #include <linux/kernel.h>
20 #include <linux/init.h>
21 #include <linux/list.h>
22 #include <linux/clk.h>
25 #include <asm/clkdev.h>
27 #include <mach/clock.h>
28 #include <mach/hardware.h>
29 #include <mach/common.h>
31 #define CCM_BASE IO_ADDRESS(CCM_BASE_ADDR)
40 #define CCM_MPCTL 0x1C
41 #define CCM_PPCTL 0x20
49 #ifdef HAVE_SET_RATE_SUPPORT
50 static void calc_dividers(u32 div
, u32
*pre
, u32
*post
, u32 maxpost
)
52 u32 min_pre
, temp_pre
, old_err
, err
;
54 min_pre
= (div
- 1) / maxpost
+ 1;
57 for (temp_pre
= 8; temp_pre
>= min_pre
; temp_pre
--) {
58 if (div
> (temp_pre
* maxpost
))
61 if (div
< (temp_pre
* temp_pre
))
79 *post
= (div
+ *pre
- 1) / *pre
;
82 /* get the best values for a 3-bit divider combined with a 6-bit divider */
83 static void calc_dividers_3_6(u32 div
, u32
*pre
, u32
*post
)
88 } else if (div
>= 64) {
89 calc_dividers(div
, pre
, post
, 64);
90 } else if (div
<= 8) {
99 /* get the best values for two cascaded 3-bit dividers */
100 static void calc_dividers_3_3(u32 div
, u32
*pre
, u32
*post
)
104 } else if (div
> 8) {
105 calc_dividers(div
, pre
, post
, 8);
113 static unsigned long get_rate_mpll(void)
115 ulong mpctl
= __raw_readl(CCM_BASE
+ CCM_MPCTL
);
117 return mxc_decode_pll(mpctl
, 24000000);
120 static unsigned long get_rate_ppll(void)
122 ulong ppctl
= __raw_readl(CCM_BASE
+ CCM_PPCTL
);
124 return mxc_decode_pll(ppctl
, 24000000);
128 unsigned char arm
, ahb
, sel
;
131 static struct arm_ahb_div clk_consumer
[] = {
132 { .arm
= 1, .ahb
= 4, .sel
= 0},
133 { .arm
= 1, .ahb
= 3, .sel
= 1},
134 { .arm
= 2, .ahb
= 2, .sel
= 0},
135 { .arm
= 0, .ahb
= 0, .sel
= 0},
136 { .arm
= 0, .ahb
= 0, .sel
= 0},
137 { .arm
= 0, .ahb
= 0, .sel
= 0},
138 { .arm
= 4, .ahb
= 1, .sel
= 0},
139 { .arm
= 1, .ahb
= 5, .sel
= 0},
140 { .arm
= 1, .ahb
= 8, .sel
= 0},
141 { .arm
= 1, .ahb
= 6, .sel
= 1},
142 { .arm
= 2, .ahb
= 4, .sel
= 0},
143 { .arm
= 0, .ahb
= 0, .sel
= 0},
144 { .arm
= 0, .ahb
= 0, .sel
= 0},
145 { .arm
= 0, .ahb
= 0, .sel
= 0},
146 { .arm
= 4, .ahb
= 2, .sel
= 0},
147 { .arm
= 0, .ahb
= 0, .sel
= 0},
150 static unsigned long get_rate_arm(void)
152 unsigned long pdr0
= __raw_readl(CCM_BASE
+ CCM_PDR0
);
153 struct arm_ahb_div
*aad
;
154 unsigned long fref
= get_rate_mpll();
156 aad
= &clk_consumer
[(pdr0
>> 16) & 0xf];
160 return fref
/ aad
->arm
;
163 static unsigned long get_rate_ahb(struct clk
*clk
)
165 unsigned long pdr0
= __raw_readl(CCM_BASE
+ CCM_PDR0
);
166 struct arm_ahb_div
*aad
;
167 unsigned long fref
= get_rate_mpll();
169 aad
= &clk_consumer
[(pdr0
>> 16) & 0xf];
171 return fref
/ aad
->ahb
;
174 static unsigned long get_rate_ipg(struct clk
*clk
)
176 return get_rate_ahb(NULL
) >> 1;
179 static unsigned long get_3_3_div(unsigned long in
)
181 return (((in
>> 3) & 0x7) + 1) * ((in
& 0x7) + 1);
184 static unsigned long get_rate_uart(struct clk
*clk
)
186 unsigned long pdr3
= __raw_readl(CCM_BASE
+ CCM_PDR3
);
187 unsigned long pdr4
= __raw_readl(CCM_BASE
+ CCM_PDR4
);
188 unsigned long div
= get_3_3_div(pdr4
>> 10);
190 if (pdr3
& (1 << 14))
191 return get_rate_arm() / div
;
193 return get_rate_ppll() / div
;
196 static unsigned long get_rate_sdhc(struct clk
*clk
)
198 unsigned long pdr3
= __raw_readl(CCM_BASE
+ CCM_PDR3
);
199 unsigned long div
, rate
;
202 rate
= get_rate_arm();
204 rate
= get_rate_ppll();
212 div
= (pdr3
>> 8) & 0x3f;
215 div
= (pdr3
>> 16) & 0x3f;
219 return rate
/ get_3_3_div(div
);
222 static unsigned long get_rate_mshc(struct clk
*clk
)
224 unsigned long pdr1
= __raw_readl(CCM_BASE
+ CCM_PDR1
);
225 unsigned long div1
, div2
, rate
;
228 rate
= get_rate_arm();
230 rate
= get_rate_ppll();
232 div1
= (pdr1
>> 29) & 0x7;
233 div2
= (pdr1
>> 22) & 0x3f;
235 return rate
/ ((div1
+ 1) * (div2
+ 1));
238 static unsigned long get_rate_ssi(struct clk
*clk
)
240 unsigned long pdr2
= __raw_readl(CCM_BASE
+ CCM_PDR2
);
241 unsigned long div1
, div2
, rate
;
244 rate
= get_rate_arm();
246 rate
= get_rate_ppll();
252 div2
= (pdr2
>> 24) & 0x7;
255 div1
= (pdr2
>> 8) & 0x3f;
256 div2
= (pdr2
>> 27) & 0x7;
260 return rate
/ ((div1
+ 1) * (div2
+ 1));
263 static unsigned long get_rate_csi(struct clk
*clk
)
265 unsigned long pdr2
= __raw_readl(CCM_BASE
+ CCM_PDR2
);
269 rate
= get_rate_arm();
271 rate
= get_rate_ppll();
273 return rate
/ get_3_3_div((pdr2
>> 16) & 0x3f);
276 static unsigned long get_rate_ipg_per(struct clk
*clk
)
278 unsigned long pdr0
= __raw_readl(CCM_BASE
+ CCM_PDR0
);
279 unsigned long pdr4
= __raw_readl(CCM_BASE
+ CCM_PDR4
);
280 unsigned long div1
, div2
;
282 if (pdr0
& (1 << 26)) {
283 div1
= (pdr4
>> 19) & 0x7;
284 div2
= (pdr4
>> 16) & 0x7;
285 return get_rate_arm() / ((div1
+ 1) * (div2
+ 1));
287 div1
= (pdr0
>> 12) & 0x7;
288 return get_rate_ahb(NULL
) / div1
;
292 static int clk_cgr_enable(struct clk
*clk
)
296 reg
= __raw_readl(clk
->enable_reg
);
297 reg
|= 3 << clk
->enable_shift
;
298 __raw_writel(reg
, clk
->enable_reg
);
303 static void clk_cgr_disable(struct clk
*clk
)
307 reg
= __raw_readl(clk
->enable_reg
);
308 reg
&= ~(3 << clk
->enable_shift
);
309 __raw_writel(reg
, clk
->enable_reg
);
312 #define DEFINE_CLOCK(name, i, er, es, gr, sr) \
313 static struct clk name = { \
315 .enable_reg = CCM_BASE + er, \
316 .enable_shift = es, \
319 .enable = clk_cgr_enable, \
320 .disable = clk_cgr_disable, \
323 DEFINE_CLOCK(asrc_clk
, 0, CCM_CGR0
, 0, NULL
, NULL
);
324 DEFINE_CLOCK(ata_clk
, 0, CCM_CGR0
, 2, get_rate_ipg
, NULL
);
325 DEFINE_CLOCK(audmux_clk
, 0, CCM_CGR0
, 4, NULL
, NULL
);
326 DEFINE_CLOCK(can1_clk
, 0, CCM_CGR0
, 6, get_rate_ipg
, NULL
);
327 DEFINE_CLOCK(can2_clk
, 1, CCM_CGR0
, 8, get_rate_ipg
, NULL
);
328 DEFINE_CLOCK(cspi1_clk
, 0, CCM_CGR0
, 10, get_rate_ipg
, NULL
);
329 DEFINE_CLOCK(cspi2_clk
, 1, CCM_CGR0
, 12, get_rate_ipg
, NULL
);
330 DEFINE_CLOCK(ect_clk
, 0, CCM_CGR0
, 14, get_rate_ipg
, NULL
);
331 DEFINE_CLOCK(edio_clk
, 0, CCM_CGR0
, 16, NULL
, NULL
);
332 DEFINE_CLOCK(emi_clk
, 0, CCM_CGR0
, 18, get_rate_ipg
, NULL
);
333 DEFINE_CLOCK(epit1_clk
, 0, CCM_CGR0
, 20, get_rate_ipg_per
, NULL
);
334 DEFINE_CLOCK(epit2_clk
, 1, CCM_CGR0
, 22, get_rate_ipg_per
, NULL
);
335 DEFINE_CLOCK(esai_clk
, 0, CCM_CGR0
, 24, NULL
, NULL
);
336 DEFINE_CLOCK(esdhc1_clk
, 0, CCM_CGR0
, 26, get_rate_sdhc
, NULL
);
337 DEFINE_CLOCK(esdhc2_clk
, 1, CCM_CGR0
, 28, get_rate_sdhc
, NULL
);
338 DEFINE_CLOCK(esdhc3_clk
, 2, CCM_CGR0
, 30, get_rate_sdhc
, NULL
);
340 DEFINE_CLOCK(fec_clk
, 0, CCM_CGR1
, 0, get_rate_ipg
, NULL
);
341 DEFINE_CLOCK(gpio1_clk
, 0, CCM_CGR1
, 2, NULL
, NULL
);
342 DEFINE_CLOCK(gpio2_clk
, 1, CCM_CGR1
, 4, NULL
, NULL
);
343 DEFINE_CLOCK(gpio3_clk
, 2, CCM_CGR1
, 6, NULL
, NULL
);
344 DEFINE_CLOCK(gpt_clk
, 0, CCM_CGR1
, 8, get_rate_ipg
, NULL
);
345 DEFINE_CLOCK(i2c1_clk
, 0, CCM_CGR1
, 10, get_rate_ipg_per
, NULL
);
346 DEFINE_CLOCK(i2c2_clk
, 1, CCM_CGR1
, 12, get_rate_ipg_per
, NULL
);
347 DEFINE_CLOCK(i2c3_clk
, 2, CCM_CGR1
, 14, get_rate_ipg_per
, NULL
);
348 DEFINE_CLOCK(iomuxc_clk
, 0, CCM_CGR1
, 16, NULL
, NULL
);
349 DEFINE_CLOCK(ipu_clk
, 0, CCM_CGR1
, 18, NULL
, NULL
);
350 DEFINE_CLOCK(kpp_clk
, 0, CCM_CGR1
, 20, get_rate_ipg
, NULL
);
351 DEFINE_CLOCK(mlb_clk
, 0, CCM_CGR1
, 22, get_rate_ahb
, NULL
);
352 DEFINE_CLOCK(mshc_clk
, 0, CCM_CGR1
, 24, get_rate_mshc
, NULL
);
353 DEFINE_CLOCK(owire_clk
, 0, CCM_CGR1
, 26, get_rate_ipg_per
, NULL
);
354 DEFINE_CLOCK(pwm_clk
, 0, CCM_CGR1
, 28, get_rate_ipg_per
, NULL
);
355 DEFINE_CLOCK(rngc_clk
, 0, CCM_CGR1
, 30, get_rate_ipg
, NULL
);
357 DEFINE_CLOCK(rtc_clk
, 0, CCM_CGR2
, 0, get_rate_ipg
, NULL
);
358 DEFINE_CLOCK(rtic_clk
, 0, CCM_CGR2
, 2, get_rate_ahb
, NULL
);
359 DEFINE_CLOCK(scc_clk
, 0, CCM_CGR2
, 4, get_rate_ipg
, NULL
);
360 DEFINE_CLOCK(sdma_clk
, 0, CCM_CGR2
, 6, NULL
, NULL
);
361 DEFINE_CLOCK(spba_clk
, 0, CCM_CGR2
, 8, get_rate_ipg
, NULL
);
362 DEFINE_CLOCK(spdif_clk
, 0, CCM_CGR2
, 10, NULL
, NULL
);
363 DEFINE_CLOCK(ssi1_clk
, 0, CCM_CGR2
, 12, get_rate_ssi
, NULL
);
364 DEFINE_CLOCK(ssi2_clk
, 1, CCM_CGR2
, 14, get_rate_ssi
, NULL
);
365 DEFINE_CLOCK(uart1_clk
, 0, CCM_CGR2
, 16, get_rate_uart
, NULL
);
366 DEFINE_CLOCK(uart2_clk
, 1, CCM_CGR2
, 18, get_rate_uart
, NULL
);
367 DEFINE_CLOCK(uart3_clk
, 2, CCM_CGR2
, 20, get_rate_uart
, NULL
);
368 DEFINE_CLOCK(usbotg_clk
, 0, CCM_CGR2
, 22, NULL
, NULL
);
369 DEFINE_CLOCK(wdog_clk
, 0, CCM_CGR2
, 24, NULL
, NULL
);
370 DEFINE_CLOCK(max_clk
, 0, CCM_CGR2
, 26, NULL
, NULL
);
371 DEFINE_CLOCK(admux_clk
, 0, CCM_CGR2
, 30, NULL
, NULL
);
373 DEFINE_CLOCK(csi_clk
, 0, CCM_CGR3
, 0, get_rate_csi
, NULL
);
374 DEFINE_CLOCK(iim_clk
, 0, CCM_CGR3
, 2, NULL
, NULL
);
375 DEFINE_CLOCK(gpu2d_clk
, 0, CCM_CGR3
, 4, NULL
, NULL
);
377 #define _REGISTER_CLOCK(d, n, c) \
384 static struct clk_lookup lookups
[] = {
385 _REGISTER_CLOCK(NULL
, "asrc", asrc_clk
)
386 _REGISTER_CLOCK(NULL
, "ata", ata_clk
)
387 _REGISTER_CLOCK(NULL
, "audmux", audmux_clk
)
388 _REGISTER_CLOCK(NULL
, "can", can1_clk
)
389 _REGISTER_CLOCK(NULL
, "can", can2_clk
)
390 _REGISTER_CLOCK("spi_imx.0", NULL
, cspi1_clk
)
391 _REGISTER_CLOCK("spi_imx.1", NULL
, cspi2_clk
)
392 _REGISTER_CLOCK(NULL
, "ect", ect_clk
)
393 _REGISTER_CLOCK(NULL
, "edio", edio_clk
)
394 _REGISTER_CLOCK(NULL
, "emi", emi_clk
)
395 _REGISTER_CLOCK(NULL
, "epit", epit1_clk
)
396 _REGISTER_CLOCK(NULL
, "epit", epit2_clk
)
397 _REGISTER_CLOCK(NULL
, "esai", esai_clk
)
398 _REGISTER_CLOCK(NULL
, "sdhc", esdhc1_clk
)
399 _REGISTER_CLOCK(NULL
, "sdhc", esdhc2_clk
)
400 _REGISTER_CLOCK(NULL
, "sdhc", esdhc3_clk
)
401 _REGISTER_CLOCK("fec.0", NULL
, fec_clk
)
402 _REGISTER_CLOCK(NULL
, "gpio", gpio1_clk
)
403 _REGISTER_CLOCK(NULL
, "gpio", gpio2_clk
)
404 _REGISTER_CLOCK(NULL
, "gpio", gpio3_clk
)
405 _REGISTER_CLOCK("gpt.0", NULL
, gpt_clk
)
406 _REGISTER_CLOCK("imx-i2c.0", NULL
, i2c1_clk
)
407 _REGISTER_CLOCK("imx-i2c.1", NULL
, i2c2_clk
)
408 _REGISTER_CLOCK("imx-i2c.2", NULL
, i2c3_clk
)
409 _REGISTER_CLOCK(NULL
, "iomuxc", iomuxc_clk
)
410 _REGISTER_CLOCK("ipu-core", NULL
, ipu_clk
)
411 _REGISTER_CLOCK("mx3_sdc_fb", NULL
, ipu_clk
)
412 _REGISTER_CLOCK(NULL
, "kpp", kpp_clk
)
413 _REGISTER_CLOCK(NULL
, "mlb", mlb_clk
)
414 _REGISTER_CLOCK(NULL
, "mshc", mshc_clk
)
415 _REGISTER_CLOCK("mxc_w1", NULL
, owire_clk
)
416 _REGISTER_CLOCK(NULL
, "pwm", pwm_clk
)
417 _REGISTER_CLOCK(NULL
, "rngc", rngc_clk
)
418 _REGISTER_CLOCK(NULL
, "rtc", rtc_clk
)
419 _REGISTER_CLOCK(NULL
, "rtic", rtic_clk
)
420 _REGISTER_CLOCK(NULL
, "scc", scc_clk
)
421 _REGISTER_CLOCK(NULL
, "sdma", sdma_clk
)
422 _REGISTER_CLOCK(NULL
, "spba", spba_clk
)
423 _REGISTER_CLOCK(NULL
, "spdif", spdif_clk
)
424 _REGISTER_CLOCK(NULL
, "ssi", ssi1_clk
)
425 _REGISTER_CLOCK(NULL
, "ssi", ssi2_clk
)
426 _REGISTER_CLOCK("imx-uart.0", NULL
, uart1_clk
)
427 _REGISTER_CLOCK("imx-uart.1", NULL
, uart2_clk
)
428 _REGISTER_CLOCK("imx-uart.2", NULL
, uart3_clk
)
429 _REGISTER_CLOCK(NULL
, "usbotg", usbotg_clk
)
430 _REGISTER_CLOCK("mxc_wdt.0", NULL
, wdog_clk
)
431 _REGISTER_CLOCK(NULL
, "max", max_clk
)
432 _REGISTER_CLOCK(NULL
, "admux", admux_clk
)
433 _REGISTER_CLOCK(NULL
, "csi", csi_clk
)
434 _REGISTER_CLOCK(NULL
, "iim", iim_clk
)
435 _REGISTER_CLOCK(NULL
, "gpu2d", gpu2d_clk
)
438 int __init
mx35_clocks_init()
443 #ifdef CONFIG_DEBUG_LL_CONSOLE
447 for (i
= 0; i
< ARRAY_SIZE(lookups
); i
++)
448 clkdev_add(&lookups
[i
]);
450 /* Turn off all clocks except the ones we need to survive, namely:
451 * EMI, GPIO1/2/3, GPT, IOMUX, MAX and eventually uart
453 __raw_writel((3 << 18), CCM_BASE
+ CCM_CGR0
);
454 __raw_writel((3 << 2) | (3 << 4) | (3 << 6) | (3 << 8) | (3 << 16),
455 CCM_BASE
+ CCM_CGR1
);
456 __raw_writel((3 << 26) | ll
, CCM_BASE
+ CCM_CGR2
);
457 __raw_writel(0, CCM_BASE
+ CCM_CGR3
);
459 mxc_timer_init(&gpt_clk
);