2 * Copyright (C) 2009-2010 Freescale Semiconductor, Inc. All Rights Reserved.
4 * This program is free software; you can redistribute it and/or modify
5 * it under the terms of the GNU General Public License as published by
6 * the Free Software Foundation; either version 2 of the License, or
7 * (at your option) any later version.
9 * This program is distributed in the hope that it will be useful,
10 * but WITHOUT ANY WARRANTY; without even the implied warranty of
11 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
12 * GNU General Public License for more details.
14 * You should have received a copy of the GNU General Public License along
15 * with this program; if not, write to the Free Software Foundation, Inc.,
16 * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
20 #include <linux/delay.h>
21 #include <linux/clk.h>
23 #include <linux/jiffies.h>
24 #include <linux/clkdev.h>
26 #include <asm/clkdev.h>
27 #include <asm/div64.h>
29 #include <mach/mx23.h>
30 #include <mach/common.h>
31 #include <mach/clock.h>
33 #include "regs-clkctrl-mx23.h"
35 #define CLKCTRL_BASE_ADDR MX23_IO_ADDRESS(MX23_CLKCTRL_BASE_ADDR)
36 #define DIGCTRL_BASE_ADDR MX23_IO_ADDRESS(MX23_DIGCTL_BASE_ADDR)
38 #define PARENT_RATE_SHIFT 8
40 static int _raw_clk_enable(struct clk
*clk
)
44 if (clk
->enable_reg
) {
45 reg
= __raw_readl(clk
->enable_reg
);
46 reg
&= ~(1 << clk
->enable_shift
);
47 __raw_writel(reg
, clk
->enable_reg
);
53 static void _raw_clk_disable(struct clk
*clk
)
57 if (clk
->enable_reg
) {
58 reg
= __raw_readl(clk
->enable_reg
);
59 reg
|= 1 << clk
->enable_shift
;
60 __raw_writel(reg
, clk
->enable_reg
);
67 static unsigned long ref_xtal_clk_get_rate(struct clk
*clk
)
72 static struct clk ref_xtal_clk
= {
73 .get_rate
= ref_xtal_clk_get_rate
,
79 static unsigned long pll_clk_get_rate(struct clk
*clk
)
84 static int pll_clk_enable(struct clk
*clk
)
86 __raw_writel(BM_CLKCTRL_PLLCTRL0_POWER
|
87 BM_CLKCTRL_PLLCTRL0_EN_USB_CLKS
,
88 CLKCTRL_BASE_ADDR
+ HW_CLKCTRL_PLLCTRL0_SET
);
90 /* Only a 10us delay is need. PLLCTRL1 LOCK bitfied is only a timer
91 * and is incorrect (excessive). Per definition of the PLLCTRL0
92 * POWER field, waiting at least 10us.
99 static void pll_clk_disable(struct clk
*clk
)
101 __raw_writel(BM_CLKCTRL_PLLCTRL0_POWER
|
102 BM_CLKCTRL_PLLCTRL0_EN_USB_CLKS
,
103 CLKCTRL_BASE_ADDR
+ HW_CLKCTRL_PLLCTRL0_CLR
);
106 static struct clk pll_clk
= {
107 .get_rate
= pll_clk_get_rate
,
108 .enable
= pll_clk_enable
,
109 .disable
= pll_clk_disable
,
110 .parent
= &ref_xtal_clk
,
116 #define _CLK_GET_RATE_REF(name, sr, ss) \
117 static unsigned long name##_get_rate(struct clk *clk) \
119 unsigned long parent_rate; \
122 reg = __raw_readl(CLKCTRL_BASE_ADDR + HW_CLKCTRL_##sr); \
123 div = (reg >> BP_CLKCTRL_##sr##_##ss##FRAC) & 0x3f; \
124 parent_rate = clk_get_rate(clk->parent); \
126 return SH_DIV((parent_rate >> PARENT_RATE_SHIFT) * 18, \
127 div, PARENT_RATE_SHIFT); \
130 _CLK_GET_RATE_REF(ref_cpu_clk
, FRAC
, CPU
)
131 _CLK_GET_RATE_REF(ref_emi_clk
, FRAC
, EMI
)
132 _CLK_GET_RATE_REF(ref_pix_clk
, FRAC
, PIX
)
133 _CLK_GET_RATE_REF(ref_io_clk
, FRAC
, IO
)
135 #define _DEFINE_CLOCK_REF(name, er, es) \
136 static struct clk name = { \
137 .enable_reg = CLKCTRL_BASE_ADDR + HW_CLKCTRL_##er, \
138 .enable_shift = BP_CLKCTRL_##er##_CLKGATE##es, \
139 .get_rate = name##_get_rate, \
140 .enable = _raw_clk_enable, \
141 .disable = _raw_clk_disable, \
142 .parent = &pll_clk, \
145 _DEFINE_CLOCK_REF(ref_cpu_clk
, FRAC
, CPU
);
146 _DEFINE_CLOCK_REF(ref_emi_clk
, FRAC
, EMI
);
147 _DEFINE_CLOCK_REF(ref_pix_clk
, FRAC
, PIX
);
148 _DEFINE_CLOCK_REF(ref_io_clk
, FRAC
, IO
);
155 static unsigned long rtc_clk_get_rate(struct clk
*clk
)
157 /* ref_xtal_clk is implemented as the only parent */
158 return clk_get_rate(clk
->parent
) / 768;
161 static unsigned long clk32k_clk_get_rate(struct clk
*clk
)
163 return clk
->parent
->get_rate(clk
->parent
) / 750;
166 #define _CLK_GET_RATE(name, rs) \
167 static unsigned long name##_get_rate(struct clk *clk) \
171 reg = __raw_readl(CLKCTRL_BASE_ADDR + HW_CLKCTRL_##rs); \
173 if (clk->parent == &ref_xtal_clk) \
174 div = (reg & BM_CLKCTRL_##rs##_DIV_XTAL) >> \
175 BP_CLKCTRL_##rs##_DIV_XTAL; \
177 div = (reg & BM_CLKCTRL_##rs##_DIV_##rs) >> \
178 BP_CLKCTRL_##rs##_DIV_##rs; \
183 return clk_get_rate(clk->parent) / div; \
186 _CLK_GET_RATE(cpu_clk
, CPU
)
187 _CLK_GET_RATE(emi_clk
, EMI
)
189 #define _CLK_GET_RATE1(name, rs) \
190 static unsigned long name##_get_rate(struct clk *clk) \
194 reg = __raw_readl(CLKCTRL_BASE_ADDR + HW_CLKCTRL_##rs); \
195 div = (reg & BM_CLKCTRL_##rs##_DIV) >> BP_CLKCTRL_##rs##_DIV; \
200 return clk_get_rate(clk->parent) / div; \
203 _CLK_GET_RATE1(hbus_clk
, HBUS
)
204 _CLK_GET_RATE1(xbus_clk
, XBUS
)
205 _CLK_GET_RATE1(ssp_clk
, SSP
)
206 _CLK_GET_RATE1(gpmi_clk
, GPMI
)
207 _CLK_GET_RATE1(lcdif_clk
, PIX
)
209 #define _CLK_GET_RATE_STUB(name) \
210 static unsigned long name##_get_rate(struct clk *clk) \
212 return clk_get_rate(clk->parent); \
215 _CLK_GET_RATE_STUB(uart_clk
)
216 _CLK_GET_RATE_STUB(audio_clk
)
217 _CLK_GET_RATE_STUB(pwm_clk
)
222 static int cpu_clk_set_rate(struct clk
*clk
, unsigned long rate
)
224 u32 reg
, bm_busy
, div_max
, d
, f
, div
, frac
;
225 unsigned long diff
, parent_rate
, calc_rate
;
228 parent_rate
= clk_get_rate(clk
->parent
);
230 if (clk
->parent
== &ref_xtal_clk
) {
231 div_max
= BM_CLKCTRL_CPU_DIV_XTAL
>> BP_CLKCTRL_CPU_DIV_XTAL
;
232 bm_busy
= BM_CLKCTRL_CPU_BUSY_REF_XTAL
;
233 div
= DIV_ROUND_UP(parent_rate
, rate
);
234 if (div
== 0 || div
> div_max
)
237 div_max
= BM_CLKCTRL_CPU_DIV_CPU
>> BP_CLKCTRL_CPU_DIV_CPU
;
238 bm_busy
= BM_CLKCTRL_CPU_BUSY_REF_CPU
;
239 rate
>>= PARENT_RATE_SHIFT
;
240 parent_rate
>>= PARENT_RATE_SHIFT
;
243 for (d
= 1; d
<= div_max
; d
++) {
244 f
= parent_rate
* 18 / d
/ rate
;
245 if ((parent_rate
* 18 / d
) % rate
)
247 if (f
< 18 || f
> 35)
250 calc_rate
= parent_rate
* 18 / f
/ d
;
251 if (calc_rate
> rate
)
254 if (rate
- calc_rate
< diff
) {
257 diff
= rate
- calc_rate
;
264 if (diff
== parent_rate
)
267 reg
= __raw_readl(CLKCTRL_BASE_ADDR
+ HW_CLKCTRL_FRAC
);
268 reg
&= ~BM_CLKCTRL_FRAC_CPUFRAC
;
270 __raw_writel(reg
, CLKCTRL_BASE_ADDR
+ HW_CLKCTRL_FRAC
);
273 reg
= __raw_readl(CLKCTRL_BASE_ADDR
+ HW_CLKCTRL_CPU
);
274 reg
&= ~BM_CLKCTRL_CPU_DIV_CPU
;
275 reg
|= div
<< BP_CLKCTRL_CPU_DIV_CPU
;
276 __raw_writel(reg
, CLKCTRL_BASE_ADDR
+ HW_CLKCTRL_CPU
);
278 for (i
= 10000; i
; i
--)
279 if (!(__raw_readl(CLKCTRL_BASE_ADDR
+
280 HW_CLKCTRL_CPU
) & bm_busy
))
283 pr_err("%s: divider writing timeout\n", __func__
);
290 #define _CLK_SET_RATE(name, dr) \
291 static int name##_set_rate(struct clk *clk, unsigned long rate) \
293 u32 reg, div_max, div; \
294 unsigned long parent_rate; \
297 parent_rate = clk_get_rate(clk->parent); \
298 div_max = BM_CLKCTRL_##dr##_DIV >> BP_CLKCTRL_##dr##_DIV; \
300 div = DIV_ROUND_UP(parent_rate, rate); \
301 if (div == 0 || div > div_max) \
304 reg = __raw_readl(CLKCTRL_BASE_ADDR + HW_CLKCTRL_##dr); \
305 reg &= ~BM_CLKCTRL_##dr##_DIV; \
306 reg |= div << BP_CLKCTRL_##dr##_DIV; \
307 if (reg & (1 << clk->enable_shift)) { \
308 pr_err("%s: clock is gated\n", __func__); \
311 __raw_writel(reg, CLKCTRL_BASE_ADDR + HW_CLKCTRL_##dr); \
313 for (i = 10000; i; i--) \
314 if (!(__raw_readl(CLKCTRL_BASE_ADDR + \
315 HW_CLKCTRL_##dr) & BM_CLKCTRL_##dr##_BUSY)) \
318 pr_err("%s: divider writing timeout\n", __func__); \
325 _CLK_SET_RATE(xbus_clk
, XBUS
)
326 _CLK_SET_RATE(ssp_clk
, SSP
)
327 _CLK_SET_RATE(gpmi_clk
, GPMI
)
328 _CLK_SET_RATE(lcdif_clk
, PIX
)
330 #define _CLK_SET_RATE_STUB(name) \
331 static int name##_set_rate(struct clk *clk, unsigned long rate) \
336 _CLK_SET_RATE_STUB(emi_clk
)
337 _CLK_SET_RATE_STUB(uart_clk
)
338 _CLK_SET_RATE_STUB(audio_clk
)
339 _CLK_SET_RATE_STUB(pwm_clk
)
340 _CLK_SET_RATE_STUB(clk32k_clk
)
345 #define _CLK_SET_PARENT(name, bit) \
346 static int name##_set_parent(struct clk *clk, struct clk *parent) \
348 if (parent != clk->parent) { \
349 __raw_writel(BM_CLKCTRL_CLKSEQ_BYPASS_##bit, \
350 CLKCTRL_BASE_ADDR + HW_CLKCTRL_CLKSEQ_TOG); \
351 clk->parent = parent; \
357 _CLK_SET_PARENT(cpu_clk
, CPU
)
358 _CLK_SET_PARENT(emi_clk
, EMI
)
359 _CLK_SET_PARENT(ssp_clk
, SSP
)
360 _CLK_SET_PARENT(gpmi_clk
, GPMI
)
361 _CLK_SET_PARENT(lcdif_clk
, PIX
)
363 #define _CLK_SET_PARENT_STUB(name) \
364 static int name##_set_parent(struct clk *clk, struct clk *parent) \
366 if (parent != clk->parent) \
372 _CLK_SET_PARENT_STUB(uart_clk
)
373 _CLK_SET_PARENT_STUB(audio_clk
)
374 _CLK_SET_PARENT_STUB(pwm_clk
)
375 _CLK_SET_PARENT_STUB(clk32k_clk
)
380 static struct clk cpu_clk
= {
381 .get_rate
= cpu_clk_get_rate
,
382 .set_rate
= cpu_clk_set_rate
,
383 .set_parent
= cpu_clk_set_parent
,
384 .parent
= &ref_cpu_clk
,
387 static struct clk hbus_clk
= {
388 .get_rate
= hbus_clk_get_rate
,
392 static struct clk xbus_clk
= {
393 .get_rate
= xbus_clk_get_rate
,
394 .set_rate
= xbus_clk_set_rate
,
395 .parent
= &ref_xtal_clk
,
398 static struct clk rtc_clk
= {
399 .get_rate
= rtc_clk_get_rate
,
400 .parent
= &ref_xtal_clk
,
403 /* usb_clk gate is controlled in DIGCTRL other than CLKCTRL */
404 static struct clk usb_clk
= {
405 .enable_reg
= DIGCTRL_BASE_ADDR
,
407 .enable
= _raw_clk_enable
,
408 .disable
= _raw_clk_disable
,
412 #define _DEFINE_CLOCK(name, er, es, p) \
413 static struct clk name = { \
414 .enable_reg = CLKCTRL_BASE_ADDR + HW_CLKCTRL_##er, \
415 .enable_shift = BP_CLKCTRL_##er##_##es, \
416 .get_rate = name##_get_rate, \
417 .set_rate = name##_set_rate, \
418 .set_parent = name##_set_parent, \
419 .enable = _raw_clk_enable, \
420 .disable = _raw_clk_disable, \
424 _DEFINE_CLOCK(emi_clk
, EMI
, CLKGATE
, &ref_xtal_clk
);
425 _DEFINE_CLOCK(ssp_clk
, SSP
, CLKGATE
, &ref_xtal_clk
);
426 _DEFINE_CLOCK(gpmi_clk
, GPMI
, CLKGATE
, &ref_xtal_clk
);
427 _DEFINE_CLOCK(lcdif_clk
, PIX
, CLKGATE
, &ref_xtal_clk
);
428 _DEFINE_CLOCK(uart_clk
, XTAL
, UART_CLK_GATE
, &ref_xtal_clk
);
429 _DEFINE_CLOCK(audio_clk
, XTAL
, FILT_CLK24M_GATE
, &ref_xtal_clk
);
430 _DEFINE_CLOCK(pwm_clk
, XTAL
, PWM_CLK24M_GATE
, &ref_xtal_clk
);
431 _DEFINE_CLOCK(clk32k_clk
, XTAL
, TIMROT_CLK32K_GATE
, &ref_xtal_clk
);
433 #define _REGISTER_CLOCK(d, n, c) \
440 static struct clk_lookup lookups
[] = {
441 /* for amba bus driver */
442 _REGISTER_CLOCK("duart", "apb_pclk", xbus_clk
)
443 /* for amba-pl011 driver */
444 _REGISTER_CLOCK("duart", NULL
, uart_clk
)
445 _REGISTER_CLOCK("mxs-auart.0", NULL
, uart_clk
)
446 _REGISTER_CLOCK("rtc", NULL
, rtc_clk
)
447 _REGISTER_CLOCK("mxs-dma-apbh", NULL
, hbus_clk
)
448 _REGISTER_CLOCK("mxs-dma-apbx", NULL
, xbus_clk
)
449 _REGISTER_CLOCK("mxs-mmc.0", NULL
, ssp_clk
)
450 _REGISTER_CLOCK("mxs-mmc.1", NULL
, ssp_clk
)
451 _REGISTER_CLOCK(NULL
, "usb", usb_clk
)
452 _REGISTER_CLOCK(NULL
, "audio", audio_clk
)
453 _REGISTER_CLOCK("mxs-pwm.0", NULL
, pwm_clk
)
454 _REGISTER_CLOCK("mxs-pwm.1", NULL
, pwm_clk
)
455 _REGISTER_CLOCK("mxs-pwm.2", NULL
, pwm_clk
)
456 _REGISTER_CLOCK("mxs-pwm.3", NULL
, pwm_clk
)
457 _REGISTER_CLOCK("mxs-pwm.4", NULL
, pwm_clk
)
458 _REGISTER_CLOCK("imx23-fb", NULL
, lcdif_clk
)
461 static int clk_misc_init(void)
466 /* Fix up parent per register setting */
467 reg
= __raw_readl(CLKCTRL_BASE_ADDR
+ HW_CLKCTRL_CLKSEQ
);
468 cpu_clk
.parent
= (reg
& BM_CLKCTRL_CLKSEQ_BYPASS_CPU
) ?
469 &ref_xtal_clk
: &ref_cpu_clk
;
470 emi_clk
.parent
= (reg
& BM_CLKCTRL_CLKSEQ_BYPASS_EMI
) ?
471 &ref_xtal_clk
: &ref_emi_clk
;
472 ssp_clk
.parent
= (reg
& BM_CLKCTRL_CLKSEQ_BYPASS_SSP
) ?
473 &ref_xtal_clk
: &ref_io_clk
;
474 gpmi_clk
.parent
= (reg
& BM_CLKCTRL_CLKSEQ_BYPASS_GPMI
) ?
475 &ref_xtal_clk
: &ref_io_clk
;
476 lcdif_clk
.parent
= (reg
& BM_CLKCTRL_CLKSEQ_BYPASS_PIX
) ?
477 &ref_xtal_clk
: &ref_pix_clk
;
479 /* Use int div over frac when both are available */
480 __raw_writel(BM_CLKCTRL_CPU_DIV_XTAL_FRAC_EN
,
481 CLKCTRL_BASE_ADDR
+ HW_CLKCTRL_CPU_CLR
);
482 __raw_writel(BM_CLKCTRL_CPU_DIV_CPU_FRAC_EN
,
483 CLKCTRL_BASE_ADDR
+ HW_CLKCTRL_CPU_CLR
);
484 __raw_writel(BM_CLKCTRL_HBUS_DIV_FRAC_EN
,
485 CLKCTRL_BASE_ADDR
+ HW_CLKCTRL_HBUS_CLR
);
487 reg
= __raw_readl(CLKCTRL_BASE_ADDR
+ HW_CLKCTRL_XBUS
);
488 reg
&= ~BM_CLKCTRL_XBUS_DIV_FRAC_EN
;
489 __raw_writel(reg
, CLKCTRL_BASE_ADDR
+ HW_CLKCTRL_XBUS
);
491 reg
= __raw_readl(CLKCTRL_BASE_ADDR
+ HW_CLKCTRL_SSP
);
492 reg
&= ~BM_CLKCTRL_SSP_DIV_FRAC_EN
;
493 __raw_writel(reg
, CLKCTRL_BASE_ADDR
+ HW_CLKCTRL_SSP
);
495 reg
= __raw_readl(CLKCTRL_BASE_ADDR
+ HW_CLKCTRL_GPMI
);
496 reg
&= ~BM_CLKCTRL_GPMI_DIV_FRAC_EN
;
497 __raw_writel(reg
, CLKCTRL_BASE_ADDR
+ HW_CLKCTRL_GPMI
);
499 reg
= __raw_readl(CLKCTRL_BASE_ADDR
+ HW_CLKCTRL_PIX
);
500 reg
&= ~BM_CLKCTRL_PIX_DIV_FRAC_EN
;
501 __raw_writel(reg
, CLKCTRL_BASE_ADDR
+ HW_CLKCTRL_PIX
);
504 * Set safe hbus clock divider. A divider of 3 ensure that
505 * the Vddd voltage required for the cpu clock is sufficiently
506 * high for the hbus clock.
508 reg
= __raw_readl(CLKCTRL_BASE_ADDR
+ HW_CLKCTRL_HBUS
);
509 reg
&= BM_CLKCTRL_HBUS_DIV
;
510 reg
|= 3 << BP_CLKCTRL_HBUS_DIV
;
511 __raw_writel(reg
, CLKCTRL_BASE_ADDR
+ HW_CLKCTRL_HBUS
);
513 for (i
= 10000; i
; i
--)
514 if (!(__raw_readl(CLKCTRL_BASE_ADDR
+
515 HW_CLKCTRL_HBUS
) & BM_CLKCTRL_HBUS_BUSY
))
518 pr_err("%s: divider writing timeout\n", __func__
);
522 /* Gate off cpu clock in WFI for power saving */
523 __raw_writel(BM_CLKCTRL_CPU_INTERRUPT_WAIT
,
524 CLKCTRL_BASE_ADDR
+ HW_CLKCTRL_CPU_SET
);
527 * 480 MHz seems too high to be ssp clock source directly,
528 * so set frac to get a 288 MHz ref_io.
530 reg
= __raw_readl(CLKCTRL_BASE_ADDR
+ HW_CLKCTRL_FRAC
);
531 reg
&= ~BM_CLKCTRL_FRAC_IOFRAC
;
532 reg
|= 30 << BP_CLKCTRL_FRAC_IOFRAC
;
533 __raw_writel(reg
, CLKCTRL_BASE_ADDR
+ HW_CLKCTRL_FRAC
);
538 int __init
mx23_clocks_init(void)
543 * source ssp clock from ref_io than ref_xtal,
544 * as ref_xtal only provides 24 MHz as maximum.
546 clk_set_parent(&ssp_clk
, &ref_io_clk
);
548 clk_enable(&cpu_clk
);
549 clk_enable(&hbus_clk
);
550 clk_enable(&xbus_clk
);
551 clk_enable(&emi_clk
);
552 clk_enable(&uart_clk
);
554 clkdev_add_table(lookups
, ARRAY_SIZE(lookups
));
556 mxs_timer_init(&clk32k_clk
, MX23_INT_TIMER0
);