2 * linux/arch/arm/mach-at91/clock.c
4 * Copyright (C) 2005 David Brownell
5 * Copyright (C) 2005 Ivan Kokshaysky
7 * This program is free software; you can redistribute it and/or modify
8 * it under the terms of the GNU General Public License as published by
9 * the Free Software Foundation; either version 2 of the License, or
10 * (at your option) any later version.
13 #include <linux/module.h>
14 #include <linux/kernel.h>
15 #include <linux/init.h>
17 #include <linux/debugfs.h>
18 #include <linux/seq_file.h>
19 #include <linux/list.h>
20 #include <linux/errno.h>
21 #include <linux/err.h>
22 #include <linux/spinlock.h>
23 #include <linux/delay.h>
24 #include <linux/clk.h>
27 #include <asm/mach-types.h>
29 #include <asm/hardware.h>
30 #include <asm/arch/at91_pmc.h>
31 #include <asm/arch/cpu.h>
37 * There's a lot more which can be done with clocks, including cpufreq
38 * integration, slow clock mode support (for system suspend), letting
39 * PLLB be used at other rates (on boards that don't need USB), etc.
42 #define clk_is_primary(x) ((x)->type & CLK_TYPE_PRIMARY)
43 #define clk_is_programmable(x) ((x)->type & CLK_TYPE_PROGRAMMABLE)
44 #define clk_is_peripheral(x) ((x)->type & CLK_TYPE_PERIPHERAL)
45 #define clk_is_sys(x) ((x)->type & CLK_TYPE_SYSTEM)
48 static LIST_HEAD(clocks
);
49 static DEFINE_SPINLOCK(clk_lock
);
51 static u32 at91_pllb_usb_init
;
54 * Four primary clock sources: two crystal oscillators (32K, main), and
55 * two PLLs. PLLA usually runs the master clock; and PLLB must run at
56 * 48 MHz (unless no USB function clocks are needed). The main clock and
57 * both PLLs are turned off to run in "slow clock mode" (system suspend).
59 static struct clk clk32k
= {
61 .rate_hz
= AT91_SLOW_CLOCK
,
62 .users
= 1, /* always on */
64 .type
= CLK_TYPE_PRIMARY
,
66 static struct clk main_clk
= {
68 .pmc_mask
= AT91_PMC_MOSCS
, /* in PMC_SR */
70 .type
= CLK_TYPE_PRIMARY
,
72 static struct clk plla
= {
75 .pmc_mask
= AT91_PMC_LOCKA
, /* in PMC_SR */
77 .type
= CLK_TYPE_PRIMARY
| CLK_TYPE_PLL
,
80 static void pllb_mode(struct clk
*clk
, int is_on
)
85 is_on
= AT91_PMC_LOCKB
;
86 value
= at91_pllb_usb_init
;
90 // REVISIT: Add work-around for AT91RM9200 Errata #26 ?
91 at91_sys_write(AT91_CKGR_PLLBR
, value
);
95 } while ((at91_sys_read(AT91_PMC_SR
) & AT91_PMC_LOCKB
) != is_on
);
98 static struct clk pllb
= {
101 .pmc_mask
= AT91_PMC_LOCKB
, /* in PMC_SR */
104 .type
= CLK_TYPE_PRIMARY
| CLK_TYPE_PLL
,
107 static void pmc_sys_mode(struct clk
*clk
, int is_on
)
110 at91_sys_write(AT91_PMC_SCER
, clk
->pmc_mask
);
112 at91_sys_write(AT91_PMC_SCDR
, clk
->pmc_mask
);
115 /* USB function clocks (PLLB must be 48 MHz) */
116 static struct clk udpck
= {
119 .mode
= pmc_sys_mode
,
121 static struct clk uhpck
= {
124 .mode
= pmc_sys_mode
,
129 * The master clock is divided from the CPU clock (by 1-4). It's used for
130 * memory, interfaces to on-chip peripherals, the AIC, and sometimes more
131 * (e.g baud rate generation). It's sourced from one of the primary clocks.
133 static struct clk mck
= {
135 .pmc_mask
= AT91_PMC_MCKRDY
, /* in PMC_SR */
138 static void pmc_periph_mode(struct clk
*clk
, int is_on
)
141 at91_sys_write(AT91_PMC_PCER
, clk
->pmc_mask
);
143 at91_sys_write(AT91_PMC_PCDR
, clk
->pmc_mask
);
146 static struct clk __init
*at91_css_to_clk(unsigned long css
)
149 case AT91_PMC_CSS_SLOW
:
151 case AT91_PMC_CSS_MAIN
:
153 case AT91_PMC_CSS_PLLA
:
155 case AT91_PMC_CSS_PLLB
:
163 * Associate a particular clock with a function (eg, "uart") and device.
164 * The drivers can then request the same 'function' with several different
165 * devices and not care about which clock name to use.
167 void __init
at91_clock_associate(const char *id
, struct device
*dev
, const char *func
)
169 struct clk
*clk
= clk_get(NULL
, id
);
171 if (!dev
|| !clk
|| !IS_ERR(clk_get(dev
, func
)))
174 clk
->function
= func
;
178 /* clocks cannot be de-registered no refcounting necessary */
179 struct clk
*clk_get(struct device
*dev
, const char *id
)
183 list_for_each_entry(clk
, &clocks
, node
) {
184 if (strcmp(id
, clk
->name
) == 0)
186 if (clk
->function
&& (dev
== clk
->dev
) && strcmp(id
, clk
->function
) == 0)
190 return ERR_PTR(-ENOENT
);
192 EXPORT_SYMBOL(clk_get
);
194 void clk_put(struct clk
*clk
)
197 EXPORT_SYMBOL(clk_put
);
199 static void __clk_enable(struct clk
*clk
)
202 __clk_enable(clk
->parent
);
203 if (clk
->users
++ == 0 && clk
->mode
)
207 int clk_enable(struct clk
*clk
)
211 spin_lock_irqsave(&clk_lock
, flags
);
213 spin_unlock_irqrestore(&clk_lock
, flags
);
216 EXPORT_SYMBOL(clk_enable
);
218 static void __clk_disable(struct clk
*clk
)
220 BUG_ON(clk
->users
== 0);
221 if (--clk
->users
== 0 && clk
->mode
)
224 __clk_disable(clk
->parent
);
227 void clk_disable(struct clk
*clk
)
231 spin_lock_irqsave(&clk_lock
, flags
);
233 spin_unlock_irqrestore(&clk_lock
, flags
);
235 EXPORT_SYMBOL(clk_disable
);
237 unsigned long clk_get_rate(struct clk
*clk
)
242 spin_lock_irqsave(&clk_lock
, flags
);
245 if (rate
|| !clk
->parent
)
249 spin_unlock_irqrestore(&clk_lock
, flags
);
252 EXPORT_SYMBOL(clk_get_rate
);
254 /*------------------------------------------------------------------------*/
256 #ifdef CONFIG_AT91_PROGRAMMABLE_CLOCKS
259 * For now, only the programmable clocks support reparenting (MCK could
260 * do this too, with care) or rate changing (the PLLs could do this too,
261 * ditto MCK but that's more for cpufreq). Drivers may reparent to get
262 * a better rate match; we don't.
265 long clk_round_rate(struct clk
*clk
, unsigned long rate
)
269 unsigned long actual
;
271 if (!clk_is_programmable(clk
))
273 spin_lock_irqsave(&clk_lock
, flags
);
275 actual
= clk
->parent
->rate_hz
;
276 for (prescale
= 0; prescale
< 7; prescale
++) {
277 if (actual
&& actual
<= rate
)
282 spin_unlock_irqrestore(&clk_lock
, flags
);
283 return (prescale
< 7) ? actual
: -ENOENT
;
285 EXPORT_SYMBOL(clk_round_rate
);
287 int clk_set_rate(struct clk
*clk
, unsigned long rate
)
291 unsigned long actual
;
293 if (!clk_is_programmable(clk
))
297 spin_lock_irqsave(&clk_lock
, flags
);
299 actual
= clk
->parent
->rate_hz
;
300 for (prescale
= 0; prescale
< 7; prescale
++) {
301 if (actual
&& actual
<= rate
) {
304 pckr
= at91_sys_read(AT91_PMC_PCKR(clk
->id
));
305 pckr
&= AT91_PMC_CSS_PLLB
; /* clock selection */
306 pckr
|= prescale
<< 2;
307 at91_sys_write(AT91_PMC_PCKR(clk
->id
), pckr
);
308 clk
->rate_hz
= actual
;
314 spin_unlock_irqrestore(&clk_lock
, flags
);
315 return (prescale
< 7) ? actual
: -ENOENT
;
317 EXPORT_SYMBOL(clk_set_rate
);
319 struct clk
*clk_get_parent(struct clk
*clk
)
323 EXPORT_SYMBOL(clk_get_parent
);
325 int clk_set_parent(struct clk
*clk
, struct clk
*parent
)
331 if (!clk_is_primary(parent
) || !clk_is_programmable(clk
))
333 spin_lock_irqsave(&clk_lock
, flags
);
335 clk
->rate_hz
= parent
->rate_hz
;
336 clk
->parent
= parent
;
337 at91_sys_write(AT91_PMC_PCKR(clk
->id
), parent
->id
);
339 spin_unlock_irqrestore(&clk_lock
, flags
);
342 EXPORT_SYMBOL(clk_set_parent
);
344 /* establish PCK0..PCK3 parentage and rate */
345 static void __init
init_programmable_clock(struct clk
*clk
)
350 pckr
= at91_sys_read(AT91_PMC_PCKR(clk
->id
));
351 parent
= at91_css_to_clk(pckr
& AT91_PMC_CSS
);
352 clk
->parent
= parent
;
353 clk
->rate_hz
= parent
->rate_hz
/ (1 << ((pckr
& AT91_PMC_PRES
) >> 2));
356 #endif /* CONFIG_AT91_PROGRAMMABLE_CLOCKS */
358 /*------------------------------------------------------------------------*/
360 #ifdef CONFIG_DEBUG_FS
362 static int at91_clk_show(struct seq_file
*s
, void *unused
)
367 seq_printf(s
, "SCSR = %8x\n", scsr
= at91_sys_read(AT91_PMC_SCSR
));
368 seq_printf(s
, "PCSR = %8x\n", pcsr
= at91_sys_read(AT91_PMC_PCSR
));
369 seq_printf(s
, "MOR = %8x\n", at91_sys_read(AT91_CKGR_MOR
));
370 seq_printf(s
, "MCFR = %8x\n", at91_sys_read(AT91_CKGR_MCFR
));
371 seq_printf(s
, "PLLA = %8x\n", at91_sys_read(AT91_CKGR_PLLAR
));
372 seq_printf(s
, "PLLB = %8x\n", at91_sys_read(AT91_CKGR_PLLBR
));
373 seq_printf(s
, "MCKR = %8x\n", at91_sys_read(AT91_PMC_MCKR
));
374 seq_printf(s
, "SR = %8x\n", sr
= at91_sys_read(AT91_PMC_SR
));
378 list_for_each_entry(clk
, &clocks
, node
) {
381 if (clk
->mode
== pmc_sys_mode
)
382 state
= (scsr
& clk
->pmc_mask
) ? "on" : "off";
383 else if (clk
->mode
== pmc_periph_mode
)
384 state
= (pcsr
& clk
->pmc_mask
) ? "on" : "off";
385 else if (clk
->pmc_mask
)
386 state
= (sr
& clk
->pmc_mask
) ? "on" : "off";
387 else if (clk
== &clk32k
|| clk
== &main_clk
)
392 seq_printf(s
, "%-10s users=%2d %-3s %9ld Hz %s\n",
393 clk
->name
, clk
->users
, state
, clk_get_rate(clk
),
394 clk
->parent
? clk
->parent
->name
: "");
399 static int at91_clk_open(struct inode
*inode
, struct file
*file
)
401 return single_open(file
, at91_clk_show
, NULL
);
404 static const struct file_operations at91_clk_operations
= {
405 .open
= at91_clk_open
,
408 .release
= single_release
,
411 static int __init
at91_clk_debugfs_init(void)
413 /* /sys/kernel/debug/at91_clk */
414 (void) debugfs_create_file("at91_clk", S_IFREG
| S_IRUGO
, NULL
, NULL
, &at91_clk_operations
);
418 postcore_initcall(at91_clk_debugfs_init
);
422 /*------------------------------------------------------------------------*/
424 /* Register a new clock */
425 int __init
clk_register(struct clk
*clk
)
427 if (clk_is_peripheral(clk
)) {
429 clk
->mode
= pmc_periph_mode
;
430 list_add_tail(&clk
->node
, &clocks
);
432 else if (clk_is_sys(clk
)) {
434 clk
->mode
= pmc_sys_mode
;
436 list_add_tail(&clk
->node
, &clocks
);
438 #ifdef CONFIG_AT91_PROGRAMMABLE_CLOCKS
439 else if (clk_is_programmable(clk
)) {
440 clk
->mode
= pmc_sys_mode
;
441 init_programmable_clock(clk
);
442 list_add_tail(&clk
->node
, &clocks
);
450 /*------------------------------------------------------------------------*/
452 static u32 __init
at91_pll_rate(struct clk
*pll
, u32 freq
, u32 reg
)
457 mul
= (reg
>> 16) & 0x7ff;
467 static u32 __init
at91_usb_rate(struct clk
*pll
, u32 freq
, u32 reg
)
469 if (pll
== &pllb
&& (reg
& AT91_PMC_USB96M
))
475 static unsigned __init
at91_pll_calc(unsigned main_freq
, unsigned out_freq
)
477 unsigned i
, div
= 0, mul
= 0, diff
= 1 << 30;
478 unsigned ret
= (out_freq
> 155000000) ? 0xbe00 : 0x3e00;
480 /* PLL output max 240 MHz (or 180 MHz per errata) */
481 if (out_freq
> 240000000)
484 for (i
= 1; i
< 256; i
++) {
486 unsigned input
, mul1
;
489 * PLL input between 1MHz and 32MHz per spec, but lower
490 * frequences seem necessary in some cases so allow 100K.
492 input
= main_freq
/ i
;
495 if (input
> 32000000)
498 mul1
= out_freq
/ input
;
504 diff1
= out_freq
- input
* mul1
;
515 if (i
== 256 && diff
> (out_freq
>> 5))
517 return ret
| ((mul
- 1) << 16) | div
;
522 static struct clk
*const standard_pmc_clocks
[] __initdata
= {
523 /* four primary clocks */
529 /* PLLB children (USB) */
537 int __init
at91_clock_init(unsigned long main_clock
)
539 unsigned tmp
, freq
, mckr
;
543 * When the bootloader initialized the main oscillator correctly,
544 * there's no problem using the cycle counter. But if it didn't,
545 * or when using oscillator bypass mode, we must be told the speed
550 tmp
= at91_sys_read(AT91_CKGR_MCFR
);
551 } while (!(tmp
& AT91_PMC_MAINRDY
));
552 main_clock
= (tmp
& AT91_PMC_MAINF
) * (AT91_SLOW_CLOCK
/ 16);
554 main_clk
.rate_hz
= main_clock
;
556 /* report if PLLA is more than mildly overclocked */
557 plla
.rate_hz
= at91_pll_rate(&plla
, main_clock
, at91_sys_read(AT91_CKGR_PLLAR
));
558 if (plla
.rate_hz
> 209000000)
559 pr_info("Clocks: PLLA overclocked, %ld MHz\n", plla
.rate_hz
/ 1000000);
562 * USB clock init: choose 48 MHz PLLB value,
563 * disable 48MHz clock during usb peripheral suspend.
565 * REVISIT: assumes MCK doesn't derive from PLLB!
567 at91_pllb_usb_init
= at91_pll_calc(main_clock
, 48000000 * 2) | AT91_PMC_USB96M
;
568 pllb
.rate_hz
= at91_pll_rate(&pllb
, main_clock
, at91_pllb_usb_init
);
569 if (cpu_is_at91rm9200()) {
570 uhpck
.pmc_mask
= AT91RM9200_PMC_UHP
;
571 udpck
.pmc_mask
= AT91RM9200_PMC_UDP
;
572 at91_sys_write(AT91_PMC_SCER
, AT91RM9200_PMC_MCKUDP
);
573 } else if (cpu_is_at91sam9260() || cpu_is_at91sam9261() || cpu_is_at91sam9263()) {
574 uhpck
.pmc_mask
= AT91SAM926x_PMC_UHP
;
575 udpck
.pmc_mask
= AT91SAM926x_PMC_UDP
;
576 } else if (cpu_is_at91cap9()) {
577 uhpck
.pmc_mask
= AT91CAP9_PMC_UHP
;
579 at91_sys_write(AT91_CKGR_PLLBR
, 0);
581 udpck
.rate_hz
= at91_usb_rate(&pllb
, pllb
.rate_hz
, at91_pllb_usb_init
);
582 uhpck
.rate_hz
= at91_usb_rate(&pllb
, pllb
.rate_hz
, at91_pllb_usb_init
);
585 * MCK and CPU derive from one of those primary clocks.
586 * For now, assume this parentage won't change.
588 mckr
= at91_sys_read(AT91_PMC_MCKR
);
589 mck
.parent
= at91_css_to_clk(mckr
& AT91_PMC_CSS
);
590 freq
= mck
.parent
->rate_hz
;
591 freq
/= (1 << ((mckr
& AT91_PMC_PRES
) >> 2)); /* prescale */
592 if (cpu_is_at91rm9200())
593 mck
.rate_hz
= freq
/ (1 + ((mckr
& AT91_PMC_MDIV
) >> 8)); /* mdiv */
595 mck
.rate_hz
= freq
/ (1 << ((mckr
& AT91_PMC_MDIV
) >> 8)); /* mdiv */
597 /* Register the PMC's standard clocks */
598 for (i
= 0; i
< ARRAY_SIZE(standard_pmc_clocks
); i
++)
599 list_add_tail(&standard_pmc_clocks
[i
]->node
, &clocks
);
601 /* MCK and CPU clock are "always on" */
604 printk("Clocks: CPU %u MHz, master %u MHz, main %u.%03u MHz\n",
605 freq
/ 1000000, (unsigned) mck
.rate_hz
/ 1000000,
606 (unsigned) main_clock
/ 1000000,
607 ((unsigned) main_clock
% 1000000) / 1000);
613 * Several unused clocks may be active. Turn them off.
615 static int __init
at91_clock_reset(void)
617 unsigned long pcdr
= 0;
618 unsigned long scdr
= 0;
621 list_for_each_entry(clk
, &clocks
, node
) {
625 if (clk
->mode
== pmc_periph_mode
)
626 pcdr
|= clk
->pmc_mask
;
628 if (clk
->mode
== pmc_sys_mode
)
629 scdr
|= clk
->pmc_mask
;
631 pr_debug("Clocks: disable unused %s\n", clk
->name
);
634 at91_sys_write(AT91_PMC_PCDR
, pcdr
);
635 at91_sys_write(AT91_PMC_SCDR
, scdr
);
639 late_initcall(at91_clock_reset
);