2 * linux/arch/arm/plat-omap/clock.c
4 * Copyright (C) 2004 Nokia corporation
5 * Written by Tuukka Tikkanen <tuukka.tikkanen@elektrobit.com>
7 * This program is free software; you can redistribute it and/or modify
8 * it under the terms of the GNU General Public License version 2 as
9 * published by the Free Software Foundation.
11 #include <linux/module.h>
12 #include <linux/kernel.h>
13 #include <linux/list.h>
14 #include <linux/errno.h>
15 #include <linux/err.h>
18 #include <asm/semaphore.h>
19 #include <asm/hardware/clock.h>
20 #include <asm/arch/board.h>
21 #include <asm/arch/usb.h>
26 static LIST_HEAD(clocks
);
27 static DECLARE_MUTEX(clocks_sem
);
28 static DEFINE_SPINLOCK(clockfw_lock
);
29 static void propagate_rate(struct clk
* clk
);
30 /* UART clock function */
31 static int set_uart_rate(struct clk
* clk
, unsigned long rate
);
32 /* External clock (MCLK & BCLK) functions */
33 static int set_ext_clk_rate(struct clk
* clk
, unsigned long rate
);
34 static long round_ext_clk_rate(struct clk
* clk
, unsigned long rate
);
35 static void init_ext_clk(struct clk
* clk
);
36 /* MPU virtual clock functions */
37 static int select_table_rate(struct clk
* clk
, unsigned long rate
);
38 static long round_to_table_rate(struct clk
* clk
, unsigned long rate
);
39 void clk_setdpll(__u16
, __u16
);
41 static struct mpu_rate rate_table
[] = {
42 /* MPU MHz, xtal MHz, dpll1 MHz, CKCTL, DPLL_CTL
43 * armdiv, dspdiv, dspmmu, tcdiv, perdiv, lcddiv
45 #if defined(CONFIG_OMAP_ARM_216MHZ)
46 { 216000000, 12000000, 216000000, 0x050d, 0x2910 }, /* 1/1/2/2/2/8 */
48 #if defined(CONFIG_OMAP_ARM_195MHZ)
49 { 195000000, 13000000, 195000000, 0x050e, 0x2790 }, /* 1/1/2/2/4/8 */
51 #if defined(CONFIG_OMAP_ARM_192MHZ)
52 { 192000000, 19200000, 192000000, 0x050f, 0x2510 }, /* 1/1/2/2/8/8 */
53 { 192000000, 12000000, 192000000, 0x050f, 0x2810 }, /* 1/1/2/2/8/8 */
54 { 96000000, 12000000, 192000000, 0x055f, 0x2810 }, /* 2/2/2/2/8/8 */
55 { 48000000, 12000000, 192000000, 0x0baf, 0x2810 }, /* 4/8/4/4/8/8 */
56 { 24000000, 12000000, 192000000, 0x0fff, 0x2810 }, /* 8/8/8/8/8/8 */
58 #if defined(CONFIG_OMAP_ARM_182MHZ)
59 { 182000000, 13000000, 182000000, 0x050e, 0x2710 }, /* 1/1/2/2/4/8 */
61 #if defined(CONFIG_OMAP_ARM_168MHZ)
62 { 168000000, 12000000, 168000000, 0x010f, 0x2710 }, /* 1/1/1/2/8/8 */
64 #if defined(CONFIG_OMAP_ARM_150MHZ)
65 { 150000000, 12000000, 150000000, 0x010a, 0x2cb0 }, /* 1/1/1/2/4/4 */
67 #if defined(CONFIG_OMAP_ARM_120MHZ)
68 { 120000000, 12000000, 120000000, 0x010a, 0x2510 }, /* 1/1/1/2/4/4 */
70 #if defined(CONFIG_OMAP_ARM_96MHZ)
71 { 96000000, 12000000, 96000000, 0x0005, 0x2410 }, /* 1/1/1/1/2/2 */
73 #if defined(CONFIG_OMAP_ARM_60MHZ)
74 { 60000000, 12000000, 60000000, 0x0005, 0x2290 }, /* 1/1/1/1/2/2 */
76 #if defined(CONFIG_OMAP_ARM_30MHZ)
77 { 30000000, 12000000, 60000000, 0x0555, 0x2290 }, /* 2/2/2/2/2/2 */
83 static void ckctl_recalc(struct clk
* clk
);
84 int __clk_enable(struct clk
*clk
);
85 void __clk_disable(struct clk
*clk
);
86 void __clk_unuse(struct clk
*clk
);
87 int __clk_use(struct clk
*clk
);
90 static void followparent_recalc(struct clk
* clk
)
92 clk
->rate
= clk
->parent
->rate
;
96 static void watchdog_recalc(struct clk
* clk
)
98 clk
->rate
= clk
->parent
->rate
/ 14;
101 static void uart_recalc(struct clk
* clk
)
103 unsigned int val
= omap_readl(clk
->enable_reg
);
104 if (val
& clk
->enable_bit
)
105 clk
->rate
= 48000000;
107 clk
->rate
= 12000000;
110 static struct clk ck_ref
= {
113 .flags
= CLOCK_IN_OMAP1510
| CLOCK_IN_OMAP16XX
|
117 static struct clk ck_dpll1
= {
120 .flags
= CLOCK_IN_OMAP1510
| CLOCK_IN_OMAP16XX
|
121 RATE_PROPAGATES
| ALWAYS_ENABLED
,
124 static struct clk ck_dpll1out
= {
125 .name
= "ck_dpll1out",
127 .flags
= CLOCK_IN_OMAP16XX
,
128 .enable_reg
= ARM_IDLECT2
,
129 .enable_bit
= EN_CKOUT_ARM
,
130 .recalc
= &followparent_recalc
,
133 static struct clk arm_ck
= {
136 .flags
= CLOCK_IN_OMAP1510
| CLOCK_IN_OMAP16XX
|
137 RATE_CKCTL
| RATE_PROPAGATES
| ALWAYS_ENABLED
,
138 .rate_offset
= CKCTL_ARMDIV_OFFSET
,
139 .recalc
= &ckctl_recalc
,
142 static struct clk armper_ck
= {
145 .flags
= CLOCK_IN_OMAP1510
| CLOCK_IN_OMAP16XX
|
147 .enable_reg
= ARM_IDLECT2
,
148 .enable_bit
= EN_PERCK
,
149 .rate_offset
= CKCTL_PERDIV_OFFSET
,
150 .recalc
= &ckctl_recalc
,
153 static struct clk arm_gpio_ck
= {
154 .name
= "arm_gpio_ck",
156 .flags
= CLOCK_IN_OMAP1510
,
157 .enable_reg
= ARM_IDLECT2
,
158 .enable_bit
= EN_GPIOCK
,
159 .recalc
= &followparent_recalc
,
162 static struct clk armxor_ck
= {
165 .flags
= CLOCK_IN_OMAP1510
| CLOCK_IN_OMAP16XX
,
166 .enable_reg
= ARM_IDLECT2
,
167 .enable_bit
= EN_XORPCK
,
168 .recalc
= &followparent_recalc
,
171 static struct clk armtim_ck
= {
174 .flags
= CLOCK_IN_OMAP1510
| CLOCK_IN_OMAP16XX
,
175 .enable_reg
= ARM_IDLECT2
,
176 .enable_bit
= EN_TIMCK
,
177 .recalc
= &followparent_recalc
,
180 static struct clk armwdt_ck
= {
183 .flags
= CLOCK_IN_OMAP1510
| CLOCK_IN_OMAP16XX
,
184 .enable_reg
= ARM_IDLECT2
,
185 .enable_bit
= EN_WDTCK
,
186 .recalc
= &watchdog_recalc
,
189 static struct clk arminth_ck16xx
= {
190 .name
= "arminth_ck",
192 .flags
= CLOCK_IN_OMAP16XX
| ALWAYS_ENABLED
,
193 .recalc
= &followparent_recalc
,
194 /* Note: On 16xx the frequency can be divided by 2 by programming
195 * ARM_CKCTL:ARM_INTHCK_SEL(14) to 1
197 * 1510 version is in TC clocks.
201 static struct clk dsp_ck
= {
204 .flags
= CLOCK_IN_OMAP1510
| CLOCK_IN_OMAP16XX
|
206 .enable_reg
= ARM_CKCTL
,
207 .enable_bit
= EN_DSPCK
,
208 .rate_offset
= CKCTL_DSPDIV_OFFSET
,
209 .recalc
= &ckctl_recalc
,
212 static struct clk dspmmu_ck
= {
215 .flags
= CLOCK_IN_OMAP1510
| CLOCK_IN_OMAP16XX
|
216 RATE_CKCTL
| ALWAYS_ENABLED
,
217 .rate_offset
= CKCTL_DSPMMUDIV_OFFSET
,
218 .recalc
= &ckctl_recalc
,
221 static struct clk dspper_ck
= {
224 .flags
= CLOCK_IN_OMAP1510
| CLOCK_IN_OMAP16XX
|
225 RATE_CKCTL
| DSP_DOMAIN_CLOCK
| VIRTUAL_IO_ADDRESS
,
226 .enable_reg
= DSP_IDLECT2
,
227 .enable_bit
= EN_PERCK
,
228 .rate_offset
= CKCTL_PERDIV_OFFSET
,
229 .recalc
= &followparent_recalc
,
230 //.recalc = &ckctl_recalc,
233 static struct clk dspxor_ck
= {
236 .flags
= CLOCK_IN_OMAP1510
| CLOCK_IN_OMAP16XX
|
237 DSP_DOMAIN_CLOCK
| VIRTUAL_IO_ADDRESS
,
238 .enable_reg
= DSP_IDLECT2
,
239 .enable_bit
= EN_XORPCK
,
240 .recalc
= &followparent_recalc
,
243 static struct clk dsptim_ck
= {
246 .flags
= CLOCK_IN_OMAP1510
| CLOCK_IN_OMAP16XX
|
247 DSP_DOMAIN_CLOCK
| VIRTUAL_IO_ADDRESS
,
248 .enable_reg
= DSP_IDLECT2
,
249 .enable_bit
= EN_DSPTIMCK
,
250 .recalc
= &followparent_recalc
,
253 static struct clk tc_ck
= {
256 .flags
= CLOCK_IN_OMAP1510
| CLOCK_IN_OMAP16XX
| CLOCK_IN_OMAP730
|
257 RATE_CKCTL
| RATE_PROPAGATES
| ALWAYS_ENABLED
,
258 .rate_offset
= CKCTL_TCDIV_OFFSET
,
259 .recalc
= &ckctl_recalc
,
262 static struct clk arminth_ck1510
= {
263 .name
= "arminth_ck",
265 .flags
= CLOCK_IN_OMAP1510
| ALWAYS_ENABLED
,
266 .recalc
= &followparent_recalc
,
267 /* Note: On 1510 the frequency follows TC_CK
269 * 16xx version is in MPU clocks.
273 static struct clk tipb_ck
= {
276 .flags
= CLOCK_IN_OMAP1510
| ALWAYS_ENABLED
,
277 .recalc
= &followparent_recalc
,
280 static struct clk l3_ocpi_ck
= {
281 .name
= "l3_ocpi_ck",
283 .flags
= CLOCK_IN_OMAP16XX
,
284 .enable_reg
= ARM_IDLECT3
,
285 .enable_bit
= EN_OCPI_CK
,
286 .recalc
= &followparent_recalc
,
289 static struct clk tc1_ck
= {
292 .flags
= CLOCK_IN_OMAP16XX
,
293 .enable_reg
= ARM_IDLECT3
,
294 .enable_bit
= EN_TC1_CK
,
295 .recalc
= &followparent_recalc
,
298 static struct clk tc2_ck
= {
301 .flags
= CLOCK_IN_OMAP16XX
,
302 .enable_reg
= ARM_IDLECT3
,
303 .enable_bit
= EN_TC2_CK
,
304 .recalc
= &followparent_recalc
,
307 static struct clk dma_ck
= {
310 .flags
= CLOCK_IN_OMAP1510
| CLOCK_IN_OMAP16XX
|
312 .recalc
= &followparent_recalc
,
315 static struct clk dma_lcdfree_ck
= {
316 .name
= "dma_lcdfree_ck",
318 .flags
= CLOCK_IN_OMAP16XX
| ALWAYS_ENABLED
,
319 .recalc
= &followparent_recalc
,
322 static struct clk api_ck
= {
325 .flags
= CLOCK_IN_OMAP1510
| CLOCK_IN_OMAP16XX
,
326 .enable_reg
= ARM_IDLECT2
,
327 .enable_bit
= EN_APICK
,
328 .recalc
= &followparent_recalc
,
331 static struct clk lb_ck
= {
334 .flags
= CLOCK_IN_OMAP1510
,
335 .enable_reg
= ARM_IDLECT2
,
336 .enable_bit
= EN_LBCK
,
337 .recalc
= &followparent_recalc
,
340 static struct clk rhea1_ck
= {
343 .flags
= CLOCK_IN_OMAP16XX
| ALWAYS_ENABLED
,
344 .recalc
= &followparent_recalc
,
347 static struct clk rhea2_ck
= {
350 .flags
= CLOCK_IN_OMAP16XX
| ALWAYS_ENABLED
,
351 .recalc
= &followparent_recalc
,
354 static struct clk lcd_ck
= {
357 .flags
= CLOCK_IN_OMAP1510
| CLOCK_IN_OMAP16XX
| CLOCK_IN_OMAP730
|
359 .enable_reg
= ARM_IDLECT2
,
360 .enable_bit
= EN_LCDCK
,
361 .rate_offset
= CKCTL_LCDDIV_OFFSET
,
362 .recalc
= &ckctl_recalc
,
365 static struct clk uart1_1510
= {
367 /* Direct from ULPD, no parent */
369 .flags
= CLOCK_IN_OMAP1510
| ENABLE_REG_32BIT
| ALWAYS_ENABLED
,
370 .enable_reg
= MOD_CONF_CTRL_0
,
371 .enable_bit
= 29, /* Chooses between 12MHz and 48MHz */
372 .set_rate
= &set_uart_rate
,
373 .recalc
= &uart_recalc
,
376 static struct clk uart1_16xx
= {
378 /* Direct from ULPD, no parent */
380 .flags
= CLOCK_IN_OMAP16XX
| RATE_FIXED
| ENABLE_REG_32BIT
,
381 .enable_reg
= MOD_CONF_CTRL_0
,
385 static struct clk uart2_ck
= {
387 /* Direct from ULPD, no parent */
389 .flags
= CLOCK_IN_OMAP1510
| CLOCK_IN_OMAP16XX
| ENABLE_REG_32BIT
|
391 .enable_reg
= MOD_CONF_CTRL_0
,
392 .enable_bit
= 30, /* Chooses between 12MHz and 48MHz */
393 .set_rate
= &set_uart_rate
,
394 .recalc
= &uart_recalc
,
397 static struct clk uart3_1510
= {
399 /* Direct from ULPD, no parent */
401 .flags
= CLOCK_IN_OMAP1510
| ENABLE_REG_32BIT
| ALWAYS_ENABLED
,
402 .enable_reg
= MOD_CONF_CTRL_0
,
403 .enable_bit
= 31, /* Chooses between 12MHz and 48MHz */
404 .set_rate
= &set_uart_rate
,
405 .recalc
= &uart_recalc
,
408 static struct clk uart3_16xx
= {
410 /* Direct from ULPD, no parent */
412 .flags
= CLOCK_IN_OMAP16XX
| RATE_FIXED
| ENABLE_REG_32BIT
,
413 .enable_reg
= MOD_CONF_CTRL_0
,
417 static struct clk usb_clko
= { /* 6 MHz output on W4_USB_CLKO */
419 /* Direct from ULPD, no parent */
421 .flags
= CLOCK_IN_OMAP1510
| CLOCK_IN_OMAP16XX
|
422 RATE_FIXED
| ENABLE_REG_32BIT
,
423 .enable_reg
= ULPD_CLOCK_CTRL
,
424 .enable_bit
= USB_MCLK_EN_BIT
,
427 static struct clk usb_hhc_ck1510
= {
428 .name
= "usb_hhc_ck",
429 /* Direct from ULPD, no parent */
430 .rate
= 48000000, /* Actually 2 clocks, 12MHz and 48MHz */
431 .flags
= CLOCK_IN_OMAP1510
|
432 RATE_FIXED
| ENABLE_REG_32BIT
,
433 .enable_reg
= MOD_CONF_CTRL_0
,
434 .enable_bit
= USB_HOST_HHC_UHOST_EN
,
437 static struct clk usb_hhc_ck16xx
= {
438 .name
= "usb_hhc_ck",
439 /* Direct from ULPD, no parent */
441 /* OTG_SYSCON_2.OTG_PADEN == 0 (not 1510-compatible) */
442 .flags
= CLOCK_IN_OMAP16XX
|
443 RATE_FIXED
| ENABLE_REG_32BIT
,
444 .enable_reg
= OTG_BASE
+ 0x08 /* OTG_SYSCON_2 */,
445 .enable_bit
= 8 /* UHOST_EN */,
448 static struct clk usb_dc_ck
= {
450 /* Direct from ULPD, no parent */
452 .flags
= CLOCK_IN_OMAP16XX
| RATE_FIXED
,
453 .enable_reg
= SOFT_REQ_REG
,
457 static struct clk mclk_1510
= {
459 /* Direct from ULPD, no parent. May be enabled by ext hardware. */
461 .flags
= CLOCK_IN_OMAP1510
| RATE_FIXED
,
464 static struct clk mclk_16xx
= {
466 /* Direct from ULPD, no parent. May be enabled by ext hardware. */
467 .flags
= CLOCK_IN_OMAP16XX
,
468 .enable_reg
= COM_CLK_DIV_CTRL_SEL
,
469 .enable_bit
= COM_ULPD_PLL_CLK_REQ
,
470 .set_rate
= &set_ext_clk_rate
,
471 .round_rate
= &round_ext_clk_rate
,
472 .init
= &init_ext_clk
,
475 static struct clk bclk_1510
= {
477 /* Direct from ULPD, no parent. May be enabled by ext hardware. */
479 .flags
= CLOCK_IN_OMAP1510
| RATE_FIXED
,
482 static struct clk bclk_16xx
= {
484 /* Direct from ULPD, no parent. May be enabled by ext hardware. */
485 .flags
= CLOCK_IN_OMAP16XX
,
486 .enable_reg
= SWD_CLK_DIV_CTRL_SEL
,
487 .enable_bit
= SWD_ULPD_PLL_CLK_REQ
,
488 .set_rate
= &set_ext_clk_rate
,
489 .round_rate
= &round_ext_clk_rate
,
490 .init
= &init_ext_clk
,
493 static struct clk mmc1_ck
= {
495 /* Functional clock is direct from ULPD, interface clock is ARMPER */
496 .parent
= &armper_ck
,
498 .flags
= CLOCK_IN_OMAP1510
| CLOCK_IN_OMAP16XX
|
499 RATE_FIXED
| ENABLE_REG_32BIT
,
500 .enable_reg
= MOD_CONF_CTRL_0
,
504 static struct clk mmc2_ck
= {
506 /* Functional clock is direct from ULPD, interface clock is ARMPER */
507 .parent
= &armper_ck
,
509 .flags
= CLOCK_IN_OMAP16XX
|
510 RATE_FIXED
| ENABLE_REG_32BIT
,
511 .enable_reg
= MOD_CONF_CTRL_0
,
515 static struct clk virtual_ck_mpu
= {
517 .flags
= CLOCK_IN_OMAP1510
| CLOCK_IN_OMAP16XX
|
518 VIRTUAL_CLOCK
| ALWAYS_ENABLED
,
519 .parent
= &arm_ck
, /* Is smarter alias for */
520 .recalc
= &followparent_recalc
,
521 .set_rate
= &select_table_rate
,
522 .round_rate
= &round_to_table_rate
,
526 static struct clk
* onchip_clks
[] = {
527 /* non-ULPD clocks */
538 &arminth_ck1510
, &arminth_ck16xx
,
565 &usb_hhc_ck1510
, &usb_hhc_ck16xx
,
567 &mclk_1510
, &mclk_16xx
,
568 &bclk_1510
, &bclk_16xx
,
575 struct clk
*clk_get(struct device
*dev
, const char *id
)
577 struct clk
*p
, *clk
= ERR_PTR(-ENOENT
);
580 list_for_each_entry(p
, &clocks
, node
) {
581 if (strcmp(id
, p
->name
) == 0 && try_module_get(p
->owner
)) {
590 EXPORT_SYMBOL(clk_get
);
593 void clk_put(struct clk
*clk
)
595 if (clk
&& !IS_ERR(clk
))
596 module_put(clk
->owner
);
598 EXPORT_SYMBOL(clk_put
);
601 int __clk_enable(struct clk
*clk
)
606 if (clk
->flags
& ALWAYS_ENABLED
)
609 if (unlikely(clk
->enable_reg
== 0)) {
610 printk(KERN_ERR
"clock.c: Enable for %s without enable code\n",
615 if (clk
->flags
& DSP_DOMAIN_CLOCK
) {
619 if (clk
->flags
& ENABLE_REG_32BIT
) {
620 if (clk
->flags
& VIRTUAL_IO_ADDRESS
) {
621 regval32
= __raw_readl(clk
->enable_reg
);
622 regval32
|= (1 << clk
->enable_bit
);
623 __raw_writel(regval32
, clk
->enable_reg
);
625 regval32
= omap_readl(clk
->enable_reg
);
626 regval32
|= (1 << clk
->enable_bit
);
627 omap_writel(regval32
, clk
->enable_reg
);
630 if (clk
->flags
& VIRTUAL_IO_ADDRESS
) {
631 regval16
= __raw_readw(clk
->enable_reg
);
632 regval16
|= (1 << clk
->enable_bit
);
633 __raw_writew(regval16
, clk
->enable_reg
);
635 regval16
= omap_readw(clk
->enable_reg
);
636 regval16
|= (1 << clk
->enable_bit
);
637 omap_writew(regval16
, clk
->enable_reg
);
641 if (clk
->flags
& DSP_DOMAIN_CLOCK
) {
642 __clk_unuse(&api_ck
);
649 void __clk_disable(struct clk
*clk
)
654 if (clk
->enable_reg
== 0)
657 if (clk
->flags
& DSP_DOMAIN_CLOCK
) {
661 if (clk
->flags
& ENABLE_REG_32BIT
) {
662 if (clk
->flags
& VIRTUAL_IO_ADDRESS
) {
663 regval32
= __raw_readl(clk
->enable_reg
);
664 regval32
&= ~(1 << clk
->enable_bit
);
665 __raw_writel(regval32
, clk
->enable_reg
);
667 regval32
= omap_readl(clk
->enable_reg
);
668 regval32
&= ~(1 << clk
->enable_bit
);
669 omap_writel(regval32
, clk
->enable_reg
);
672 if (clk
->flags
& VIRTUAL_IO_ADDRESS
) {
673 regval16
= __raw_readw(clk
->enable_reg
);
674 regval16
&= ~(1 << clk
->enable_bit
);
675 __raw_writew(regval16
, clk
->enable_reg
);
677 regval16
= omap_readw(clk
->enable_reg
);
678 regval16
&= ~(1 << clk
->enable_bit
);
679 omap_writew(regval16
, clk
->enable_reg
);
683 if (clk
->flags
& DSP_DOMAIN_CLOCK
) {
684 __clk_unuse(&api_ck
);
689 void __clk_unuse(struct clk
*clk
)
691 if (clk
->usecount
> 0 && !(--clk
->usecount
)) {
693 if (likely(clk
->parent
))
694 __clk_unuse(clk
->parent
);
699 int __clk_use(struct clk
*clk
)
702 if (clk
->usecount
++ == 0) {
703 if (likely(clk
->parent
))
704 ret
= __clk_use(clk
->parent
);
706 if (unlikely(ret
!= 0)) {
711 ret
= __clk_enable(clk
);
713 if (unlikely(ret
!= 0) && clk
->parent
) {
714 __clk_unuse(clk
->parent
);
723 int clk_enable(struct clk
*clk
)
728 spin_lock_irqsave(&clockfw_lock
, flags
);
729 ret
= __clk_enable(clk
);
730 spin_unlock_irqrestore(&clockfw_lock
, flags
);
733 EXPORT_SYMBOL(clk_enable
);
736 void clk_disable(struct clk
*clk
)
740 spin_lock_irqsave(&clockfw_lock
, flags
);
742 spin_unlock_irqrestore(&clockfw_lock
, flags
);
744 EXPORT_SYMBOL(clk_disable
);
747 int clk_use(struct clk
*clk
)
752 spin_lock_irqsave(&clockfw_lock
, flags
);
753 ret
= __clk_use(clk
);
754 spin_unlock_irqrestore(&clockfw_lock
, flags
);
757 EXPORT_SYMBOL(clk_use
);
760 void clk_unuse(struct clk
*clk
)
764 spin_lock_irqsave(&clockfw_lock
, flags
);
766 spin_unlock_irqrestore(&clockfw_lock
, flags
);
768 EXPORT_SYMBOL(clk_unuse
);
771 int clk_get_usecount(struct clk
*clk
)
773 return clk
->usecount
;
775 EXPORT_SYMBOL(clk_get_usecount
);
778 unsigned long clk_get_rate(struct clk
*clk
)
782 EXPORT_SYMBOL(clk_get_rate
);
785 static __u16
verify_ckctl_value(__u16 newval
)
787 /* This function checks for following limitations set
788 * by the hardware (all conditions must be true):
789 * DSPMMU_CK == DSP_CK or DSPMMU_CK == DSP_CK/2
794 * In addition following rules are enforced:
798 * However, maximum frequencies are not checked for!
807 per_exp
= (newval
>> CKCTL_PERDIV_OFFSET
) & 3;
808 lcd_exp
= (newval
>> CKCTL_LCDDIV_OFFSET
) & 3;
809 arm_exp
= (newval
>> CKCTL_ARMDIV_OFFSET
) & 3;
810 dsp_exp
= (newval
>> CKCTL_DSPDIV_OFFSET
) & 3;
811 tc_exp
= (newval
>> CKCTL_TCDIV_OFFSET
) & 3;
812 dspmmu_exp
= (newval
>> CKCTL_DSPMMUDIV_OFFSET
) & 3;
814 if (dspmmu_exp
< dsp_exp
)
815 dspmmu_exp
= dsp_exp
;
816 if (dspmmu_exp
> dsp_exp
+1)
817 dspmmu_exp
= dsp_exp
+1;
818 if (tc_exp
< arm_exp
)
820 if (tc_exp
< dspmmu_exp
)
822 if (tc_exp
> lcd_exp
)
824 if (tc_exp
> per_exp
)
828 newval
|= per_exp
<< CKCTL_PERDIV_OFFSET
;
829 newval
|= lcd_exp
<< CKCTL_LCDDIV_OFFSET
;
830 newval
|= arm_exp
<< CKCTL_ARMDIV_OFFSET
;
831 newval
|= dsp_exp
<< CKCTL_DSPDIV_OFFSET
;
832 newval
|= tc_exp
<< CKCTL_TCDIV_OFFSET
;
833 newval
|= dspmmu_exp
<< CKCTL_DSPMMUDIV_OFFSET
;
839 static int calc_dsor_exp(struct clk
*clk
, unsigned long rate
)
841 /* Note: If target frequency is too low, this function will return 4,
842 * which is invalid value. Caller must check for this value and act
845 * Note: This function does not check for following limitations set
846 * by the hardware (all conditions must be true):
847 * DSPMMU_CK == DSP_CK or DSPMMU_CK == DSP_CK/2
852 unsigned long realrate
;
856 if (unlikely(!(clk
->flags
& RATE_CKCTL
)))
859 parent
= clk
->parent
;
860 if (unlikely(parent
== 0))
863 realrate
= parent
->rate
;
864 for (dsor_exp
=0; dsor_exp
<4; dsor_exp
++) {
865 if (realrate
<= rate
)
875 static void ckctl_recalc(struct clk
* clk
)
879 /* Calculate divisor encoded as 2-bit exponent */
880 if (clk
->flags
& DSP_DOMAIN_CLOCK
) {
881 /* The clock control bits are in DSP domain,
882 * so api_ck is needed for access.
883 * Note that DSP_CKCTL virt addr = phys addr, so
884 * we must use __raw_readw() instead of omap_readw().
887 dsor
= 1 << (3 & (__raw_readw(DSP_CKCTL
) >> clk
->rate_offset
));
888 __clk_unuse(&api_ck
);
890 dsor
= 1 << (3 & (omap_readw(ARM_CKCTL
) >> clk
->rate_offset
));
892 if (unlikely(clk
->rate
== clk
->parent
->rate
/ dsor
))
893 return; /* No change, quick exit */
894 clk
->rate
= clk
->parent
->rate
/ dsor
;
896 if (unlikely(clk
->flags
& RATE_PROPAGATES
))
901 long clk_round_rate(struct clk
*clk
, unsigned long rate
)
905 if (clk
->flags
& RATE_FIXED
)
908 if (clk
->flags
& RATE_CKCTL
) {
909 dsor_exp
= calc_dsor_exp(clk
, rate
);
914 return clk
->parent
->rate
/ (1 << dsor_exp
);
917 if(clk
->round_rate
!= 0)
918 return clk
->round_rate(clk
, rate
);
922 EXPORT_SYMBOL(clk_round_rate
);
925 static void propagate_rate(struct clk
* clk
)
929 for (clkp
= onchip_clks
; clkp
< onchip_clks
+ARRAY_SIZE(onchip_clks
); clkp
++) {
930 if (likely((*clkp
)->parent
!= clk
)) continue;
931 if (likely((*clkp
)->recalc
))
932 (*clkp
)->recalc(*clkp
);
937 static int select_table_rate(struct clk
* clk
, unsigned long rate
)
939 /* Find the highest supported frequency <= rate and switch to it */
940 struct mpu_rate
* ptr
;
942 if (clk
!= &virtual_ck_mpu
)
945 for (ptr
= rate_table
; ptr
->rate
; ptr
++) {
946 if (ptr
->xtal
!= ck_ref
.rate
)
949 /* DPLL1 cannot be reprogrammed without risking system crash */
950 if (likely(ck_dpll1
.rate
!=0) && ptr
->pll_rate
!= ck_dpll1
.rate
)
953 /* Can check only after xtal frequency check */
954 if (ptr
->rate
<= rate
)
962 * In most cases we should not need to reprogram DPLL.
963 * Reprogramming the DPLL is tricky, it must be done from SRAM.
965 omap_sram_reprogram_clock(ptr
->dpllctl_val
, ptr
->ckctl_val
);
967 ck_dpll1
.rate
= ptr
->pll_rate
;
968 propagate_rate(&ck_dpll1
);
973 static long round_to_table_rate(struct clk
* clk
, unsigned long rate
)
975 /* Find the highest supported frequency <= rate */
976 struct mpu_rate
* ptr
;
979 if (clk
!= &virtual_ck_mpu
)
982 highest_rate
= -EINVAL
;
984 for (ptr
= rate_table
; ptr
->rate
; ptr
++) {
985 if (ptr
->xtal
!= ck_ref
.rate
)
988 highest_rate
= ptr
->rate
;
990 /* Can check only after xtal frequency check */
991 if (ptr
->rate
<= rate
)
999 int clk_set_rate(struct clk
*clk
, unsigned long rate
)
1004 unsigned long flags
;
1006 if (clk
->flags
& RATE_CKCTL
) {
1007 dsor_exp
= calc_dsor_exp(clk
, rate
);
1013 spin_lock_irqsave(&clockfw_lock
, flags
);
1014 regval
= omap_readw(ARM_CKCTL
);
1015 regval
&= ~(3 << clk
->rate_offset
);
1016 regval
|= dsor_exp
<< clk
->rate_offset
;
1017 regval
= verify_ckctl_value(regval
);
1018 omap_writew(regval
, ARM_CKCTL
);
1019 clk
->rate
= clk
->parent
->rate
/ (1 << dsor_exp
);
1020 spin_unlock_irqrestore(&clockfw_lock
, flags
);
1022 } else if(clk
->set_rate
!= 0) {
1023 spin_lock_irqsave(&clockfw_lock
, flags
);
1024 ret
= clk
->set_rate(clk
, rate
);
1025 spin_unlock_irqrestore(&clockfw_lock
, flags
);
1028 if (unlikely(ret
== 0 && (clk
->flags
& RATE_PROPAGATES
)))
1029 propagate_rate(clk
);
1033 EXPORT_SYMBOL(clk_set_rate
);
1036 static unsigned calc_ext_dsor(unsigned long rate
)
1040 /* MCLK and BCLK divisor selection is not linear:
1041 * freq = 96MHz / dsor
1043 * RATIO_SEL range: dsor <-> RATIO_SEL
1044 * 0..6: (RATIO_SEL+2) <-> (dsor-2)
1045 * 6..48: (8+(RATIO_SEL-6)*2) <-> ((dsor-8)/2+6)
1046 * Minimum dsor is 2 and maximum is 96. Odd divisors starting from 9
1049 for (dsor
= 2; dsor
< 96; ++dsor
) {
1050 if ((dsor
& 1) && dsor
> 8)
1052 if (rate
>= 96000000 / dsor
)
1058 /* Only needed on 1510 */
1059 static int set_uart_rate(struct clk
* clk
, unsigned long rate
)
1063 val
= omap_readl(clk
->enable_reg
);
1064 if (rate
== 12000000)
1065 val
&= ~(1 << clk
->enable_bit
);
1066 else if (rate
== 48000000)
1067 val
|= (1 << clk
->enable_bit
);
1070 omap_writel(val
, clk
->enable_reg
);
1076 static int set_ext_clk_rate(struct clk
* clk
, unsigned long rate
)
1081 dsor
= calc_ext_dsor(rate
);
1082 clk
->rate
= 96000000 / dsor
;
1084 ratio_bits
= ((dsor
- 8) / 2 + 6) << 2;
1086 ratio_bits
= (dsor
- 2) << 2;
1088 ratio_bits
|= omap_readw(clk
->enable_reg
) & ~0xfd;
1089 omap_writew(ratio_bits
, clk
->enable_reg
);
1095 static long round_ext_clk_rate(struct clk
* clk
, unsigned long rate
)
1097 return 96000000 / calc_ext_dsor(rate
);
1101 static void init_ext_clk(struct clk
* clk
)
1106 /* Determine current rate and ensure clock is based on 96MHz APLL */
1107 ratio_bits
= omap_readw(clk
->enable_reg
) & ~1;
1108 omap_writew(ratio_bits
, clk
->enable_reg
);
1110 ratio_bits
= (ratio_bits
& 0xfc) >> 2;
1112 dsor
= (ratio_bits
- 6) * 2 + 8;
1114 dsor
= ratio_bits
+ 2;
1116 clk
-> rate
= 96000000 / dsor
;
1120 int clk_register(struct clk
*clk
)
1123 list_add(&clk
->node
, &clocks
);
1129 EXPORT_SYMBOL(clk_register
);
1131 void clk_unregister(struct clk
*clk
)
1134 list_del(&clk
->node
);
1137 EXPORT_SYMBOL(clk_unregister
);
1139 #ifdef CONFIG_OMAP_RESET_CLOCKS
1141 * Resets some clocks that may be left on from bootloader,
1142 * but leaves serial clocks on. See also omap_late_clk_reset().
1144 static inline void omap_early_clk_reset(void)
1146 //omap_writel(0x3 << 29, MOD_CONF_CTRL_0);
1149 #define omap_early_clk_reset() {}
1152 int __init
clk_init(void)
1155 const struct omap_clock_config
*info
;
1156 int crystal_type
= 0; /* Default 12 MHz */
1158 omap_early_clk_reset();
1160 for (clkp
= onchip_clks
; clkp
< onchip_clks
+ARRAY_SIZE(onchip_clks
); clkp
++) {
1161 if (((*clkp
)->flags
&CLOCK_IN_OMAP1510
) && cpu_is_omap1510()) {
1162 clk_register(*clkp
);
1166 if (((*clkp
)->flags
&CLOCK_IN_OMAP16XX
) && cpu_is_omap16xx()) {
1167 clk_register(*clkp
);
1171 if (((*clkp
)->flags
&CLOCK_IN_OMAP730
) && cpu_is_omap730()) {
1172 clk_register(*clkp
);
1177 info
= omap_get_config(OMAP_TAG_CLOCK
, struct omap_clock_config
);
1179 if (!cpu_is_omap1510())
1180 crystal_type
= info
->system_clock_type
;
1183 #if defined(CONFIG_ARCH_OMAP730)
1184 ck_ref
.rate
= 13000000;
1185 #elif defined(CONFIG_ARCH_OMAP16XX)
1186 if (crystal_type
== 2)
1187 ck_ref
.rate
= 19200000;
1190 printk("Clocks: ARM_SYSST: 0x%04x DPLL_CTL: 0x%04x ARM_CKCTL: 0x%04x\n",
1191 omap_readw(ARM_SYSST
), omap_readw(DPLL_CTL
),
1192 omap_readw(ARM_CKCTL
));
1194 /* We want to be in syncronous scalable mode */
1195 omap_writew(0x1000, ARM_SYSST
);
1197 #ifdef CONFIG_OMAP_CLOCKS_SET_BY_BOOTLOADER
1198 /* Use values set by bootloader. Determine PLL rate and recalculate
1199 * dependent clocks as if kernel had changed PLL or divisors.
1202 unsigned pll_ctl_val
= omap_readw(DPLL_CTL
);
1204 ck_dpll1
.rate
= ck_ref
.rate
; /* Base xtal rate */
1205 if (pll_ctl_val
& 0x10) {
1206 /* PLL enabled, apply multiplier and divisor */
1207 if (pll_ctl_val
& 0xf80)
1208 ck_dpll1
.rate
*= (pll_ctl_val
& 0xf80) >> 7;
1209 ck_dpll1
.rate
/= ((pll_ctl_val
& 0x60) >> 5) + 1;
1211 /* PLL disabled, apply bypass divisor */
1212 switch (pll_ctl_val
& 0xc) {
1224 propagate_rate(&ck_dpll1
);
1226 /* Find the highest supported frequency and enable it */
1227 if (select_table_rate(&virtual_ck_mpu
, ~0)) {
1228 printk(KERN_ERR
"System frequencies not set. Check your config.\n");
1229 /* Guess sane values (60MHz) */
1230 omap_writew(0x2290, DPLL_CTL
);
1231 omap_writew(0x1005, ARM_CKCTL
);
1232 ck_dpll1
.rate
= 60000000;
1233 propagate_rate(&ck_dpll1
);
1236 /* Cache rates for clocks connected to ck_ref (not dpll1) */
1237 propagate_rate(&ck_ref
);
1238 printk(KERN_INFO
"Clocking rate (xtal/DPLL1/MPU): "
1239 "%ld.%01ld/%ld.%01ld/%ld.%01ld MHz\n",
1240 ck_ref
.rate
/ 1000000, (ck_ref
.rate
/ 100000) % 10,
1241 ck_dpll1
.rate
/ 1000000, (ck_dpll1
.rate
/ 100000) % 10,
1242 arm_ck
.rate
/ 1000000, (arm_ck
.rate
/ 100000) % 10);
1244 #ifdef CONFIG_MACH_OMAP_PERSEUS2
1245 /* Select slicer output as OMAP input clock */
1246 omap_writew(omap_readw(OMAP730_PCC_UPLD_CTRL
) & ~0x1, OMAP730_PCC_UPLD_CTRL
);
1249 /* Turn off DSP and ARM_TIMXO. Make sure ARM_INTHCK is not divided */
1250 omap_writew(omap_readw(ARM_CKCTL
) & 0x0fff, ARM_CKCTL
);
1252 /* Put DSP/MPUI into reset until needed */
1253 omap_writew(0, ARM_RSTCT1
);
1254 omap_writew(1, ARM_RSTCT2
);
1255 omap_writew(0x400, ARM_IDLECT1
);
1258 * According to OMAP5910 Erratum SYS_DMA_1, bit DMACK_REQ (bit 8)
1259 * of the ARM_IDLECT2 register must be set to zero. The power-on
1260 * default value of this bit is one.
1262 omap_writew(0x0000, ARM_IDLECT2
); /* Turn LCD clock off also */
1265 * Only enable those clocks we will need, let the drivers
1266 * enable other clocks as necessary
1268 clk_use(&armper_ck
);
1269 clk_use(&armxor_ck
);
1270 clk_use(&armtim_ck
);
1272 if (cpu_is_omap1510())
1273 clk_enable(&arm_gpio_ck
);
1279 #ifdef CONFIG_OMAP_RESET_CLOCKS
1281 static int __init
omap_late_clk_reset(void)
1283 /* Turn off all unused clocks */
1287 /* USB_REQ_EN will be disabled later if necessary (usb_dc_ck) */
1288 regval32
= omap_readw(SOFT_REQ_REG
) & (1 << 4);
1289 omap_writew(regval32
, SOFT_REQ_REG
);
1290 omap_writew(0, SOFT_REQ_REG2
);
1292 list_for_each_entry(p
, &clocks
, node
) {
1293 if (p
->usecount
> 0 || (p
->flags
& ALWAYS_ENABLED
) ||
1297 /* Assume no DSP clocks have been activated by bootloader */
1298 if (p
->flags
& DSP_DOMAIN_CLOCK
)
1301 /* Is the clock already disabled? */
1302 if (p
->flags
& ENABLE_REG_32BIT
) {
1303 if (p
->flags
& VIRTUAL_IO_ADDRESS
)
1304 regval32
= __raw_readl(p
->enable_reg
);
1306 regval32
= omap_readl(p
->enable_reg
);
1308 if (p
->flags
& VIRTUAL_IO_ADDRESS
)
1309 regval32
= __raw_readw(p
->enable_reg
);
1311 regval32
= omap_readw(p
->enable_reg
);
1314 if ((regval32
& (1 << p
->enable_bit
)) == 0)
1317 /* FIXME: This clock seems to be necessary but no-one
1318 * has asked for its activation. */
1319 if (p
== &tc2_ck
// FIX: pm.c (SRAM), CCP, Camera
1320 || p
== &ck_dpll1out
// FIX: SoSSI, SSR
1321 || p
== &arm_gpio_ck
// FIX: GPIO code for 1510
1323 printk(KERN_INFO
"FIXME: Clock \"%s\" seems unused\n",
1328 printk(KERN_INFO
"Disabling unused clock \"%s\"... ", p
->name
);
1336 late_initcall(omap_late_clk_reset
);