2 * linux/arch/arm/plat-nomadik/timer.c
4 * Copyright (C) 2008 STMicroelectronics
5 * Copyright (C) 2010 Alessandro Rubini
6 * Copyright (C) 2010 Linus Walleij for ST-Ericsson
8 * This program is free software; you can redistribute it and/or modify
9 * it under the terms of the GNU General Public License version 2, as
10 * published by the Free Software Foundation.
12 #include <linux/init.h>
13 #include <linux/interrupt.h>
14 #include <linux/irq.h>
16 #include <linux/clockchips.h>
17 #include <linux/clk.h>
18 #include <linux/jiffies.h>
19 #include <linux/err.h>
20 #include <linux/cnt32_to_63.h>
21 #include <linux/timer.h>
22 #include <asm/mach/time.h>
26 void __iomem
*mtu_base
; /* Assigned by machine code */
29 * Kernel assumes that sched_clock can be called early
30 * but the MTU may not yet be initialized.
32 static cycle_t
nmdk_read_timer_dummy(struct clocksource
*cs
)
37 /* clocksource: MTU decrements, so we negate the value being read. */
38 static cycle_t
nmdk_read_timer(struct clocksource
*cs
)
40 return -readl(mtu_base
+ MTU_VAL(0));
43 static struct clocksource nmdk_clksrc
= {
46 .read
= nmdk_read_timer_dummy
,
47 .mask
= CLOCKSOURCE_MASK(32),
48 .flags
= CLOCK_SOURCE_IS_CONTINUOUS
,
52 * Override the global weak sched_clock symbol with this
53 * local implementation which uses the clocksource to get some
54 * better resolution when scheduling the kernel.
56 * Because the hardware timer period may be quite short
57 * (32.3 secs on the 133 MHz MTU timer selection on ux500)
58 * and because cnt32_to_63() needs to be called at least once per
59 * half period to work properly, a kernel keepwarm() timer is set up
60 * to ensure this requirement is always met.
62 * Also the sched_clock timer will wrap around at some point,
63 * here we set it to run continously for a year.
65 #define SCHED_CLOCK_MIN_WRAP 3600*24*365
66 static struct timer_list cnt32_to_63_keepwarm_timer
;
67 static u32 sched_mult
;
68 static u32 sched_shift
;
70 unsigned long long notrace
sched_clock(void)
74 if (unlikely(!mtu_base
))
77 cycles
= cnt32_to_63(-readl(mtu_base
+ MTU_VAL(0)));
79 * sched_mult is guaranteed to be even so will
82 return (cycles
* sched_mult
) >> sched_shift
;
85 /* Just kick sched_clock every so often */
86 static void cnt32_to_63_keepwarm(unsigned long data
)
88 mod_timer(&cnt32_to_63_keepwarm_timer
, round_jiffies(jiffies
+ data
));
93 * Set up a timer to keep sched_clock():s 32_to_63 algorithm warm
94 * once in half a 32bit timer wrap interval.
96 static void __init
nmdk_sched_clock_init(unsigned long rate
)
102 /* Find the apropriate mult and shift factors */
103 clocks_calc_mult_shift(&sched_mult
, &sched_shift
,
104 rate
, NSEC_PER_SEC
, SCHED_CLOCK_MIN_WRAP
);
105 /* We need to multiply by an even number to get rid of bit 63 */
109 /* Let's see what we get, take max counter and scale it */
110 days
= (0xFFFFFFFFFFFFFFFFLLU
* sched_mult
) >> sched_shift
;
111 do_div(days
, NSEC_PER_SEC
);
112 do_div(days
, (3600*24));
114 pr_info("sched_clock: using %d bits @ %lu Hz wrap in %lu days\n",
115 (64 - sched_shift
), rate
, (unsigned long) days
);
118 * Program a timer to kick us at half 32bit wraparound
119 * Formula: seconds per wrap = (2^32) / f
121 v
= 0xFFFFFFFFUL
/ rate
;
122 /* We want half of the wrap time to keep cnt32_to_63 warm */
124 pr_debug("sched_clock: prescaled timer rate: %lu Hz, "
125 "initialize keepwarm timer every %d seconds\n", rate
, v
);
126 /* Convert seconds to jiffies */
127 delta
= msecs_to_jiffies(v
*1000);
128 setup_timer(&cnt32_to_63_keepwarm_timer
, cnt32_to_63_keepwarm
, delta
);
129 mod_timer(&cnt32_to_63_keepwarm_timer
, round_jiffies(jiffies
+ delta
));
132 /* Clockevent device: use one-shot mode */
133 static void nmdk_clkevt_mode(enum clock_event_mode mode
,
134 struct clock_event_device
*dev
)
139 case CLOCK_EVT_MODE_PERIODIC
:
140 pr_err("%s: periodic mode not supported\n", __func__
);
142 case CLOCK_EVT_MODE_ONESHOT
:
143 /* Load highest value, enable device, enable interrupts */
144 cr
= readl(mtu_base
+ MTU_CR(1));
145 writel(0, mtu_base
+ MTU_LR(1));
146 writel(cr
| MTU_CRn_ENA
, mtu_base
+ MTU_CR(1));
147 writel(1 << 1, mtu_base
+ MTU_IMSC
);
149 case CLOCK_EVT_MODE_SHUTDOWN
:
150 case CLOCK_EVT_MODE_UNUSED
:
152 writel(0, mtu_base
+ MTU_IMSC
);
154 cr
= readl(mtu_base
+ MTU_CR(1));
156 writel(cr
, mtu_base
+ MTU_CR(1));
157 /* load some high default value */
158 writel(0xffffffff, mtu_base
+ MTU_LR(1));
160 case CLOCK_EVT_MODE_RESUME
:
165 static int nmdk_clkevt_next(unsigned long evt
, struct clock_event_device
*ev
)
167 /* writing the value has immediate effect */
168 writel(evt
, mtu_base
+ MTU_LR(1));
172 static struct clock_event_device nmdk_clkevt
= {
174 .features
= CLOCK_EVT_FEAT_ONESHOT
,
176 .set_mode
= nmdk_clkevt_mode
,
177 .set_next_event
= nmdk_clkevt_next
,
181 * IRQ Handler for timer 1 of the MTU block.
183 static irqreturn_t
nmdk_timer_interrupt(int irq
, void *dev_id
)
185 struct clock_event_device
*evdev
= dev_id
;
187 writel(1 << 1, mtu_base
+ MTU_ICR
); /* Interrupt clear reg */
188 evdev
->event_handler(evdev
);
192 static struct irqaction nmdk_timer_irq
= {
193 .name
= "Nomadik Timer Tick",
194 .flags
= IRQF_DISABLED
| IRQF_TIMER
,
195 .handler
= nmdk_timer_interrupt
,
196 .dev_id
= &nmdk_clkevt
,
199 void __init
nmdk_timer_init(void)
203 u32 cr
= MTU_CRn_32BITS
;
205 clk0
= clk_get_sys("mtu0", NULL
);
206 BUG_ON(IS_ERR(clk0
));
211 * Tick rate is 2.4MHz for Nomadik and 2.4Mhz, 100MHz or 133 MHz
213 * Use a divide-by-16 counter if the tick rate is more than 32MHz.
214 * At 32 MHz, the timer (with 32 bit counter) can be programmed
215 * to wake-up at a max 127s a head in time. Dividing a 2.4 MHz timer
216 * with 16 gives too low timer resolution.
218 rate
= clk_get_rate(clk0
);
219 if (rate
> 32000000) {
221 cr
|= MTU_CRn_PRESCALE_16
;
223 cr
|= MTU_CRn_PRESCALE_1
;
225 clocksource_calc_mult_shift(&nmdk_clksrc
, rate
, MTU_MIN_RANGE
);
227 /* Timer 0 is the free running clocksource */
228 writel(cr
, mtu_base
+ MTU_CR(0));
229 writel(0, mtu_base
+ MTU_LR(0));
230 writel(0, mtu_base
+ MTU_BGLR(0));
231 writel(cr
| MTU_CRn_ENA
, mtu_base
+ MTU_CR(0));
233 /* Now the clock source is ready */
234 nmdk_clksrc
.read
= nmdk_read_timer
;
236 if (clocksource_register(&nmdk_clksrc
))
237 pr_err("timer: failed to initialize clock source %s\n",
240 nmdk_sched_clock_init(rate
);
242 /* Timer 1 is used for events */
244 clockevents_calc_mult_shift(&nmdk_clkevt
, rate
, MTU_MIN_RANGE
);
246 writel(cr
| MTU_CRn_ONESHOT
, mtu_base
+ MTU_CR(1)); /* off, currently */
248 nmdk_clkevt
.max_delta_ns
=
249 clockevent_delta2ns(0xffffffff, &nmdk_clkevt
);
250 nmdk_clkevt
.min_delta_ns
=
251 clockevent_delta2ns(0x00000002, &nmdk_clkevt
);
252 nmdk_clkevt
.cpumask
= cpumask_of(0);
254 /* Register irq and clockevents */
255 setup_irq(IRQ_MTU0
, &nmdk_timer_irq
);
256 clockevents_register_device(&nmdk_clkevt
);