vmalloc: walk vmap_areas by sorted list instead of rb_next()
[linux/fpc-iii.git] / arch / arm / plat-samsung / time.c
blob4dcb11c3d894013e93d9a5c799e95ec5cc0a9582
1 /* linux/arch/arm/plat-samsung/time.c
3 * Copyright (C) 2003-2005 Simtec Electronics
4 * Ben Dooks, <ben@simtec.co.uk>
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License as published by
8 * the Free Software Foundation; either version 2 of the License, or
9 * (at your option) any later version.
11 * This program is distributed in the hope that it will be useful,
12 * but WITHOUT ANY WARRANTY; without even the implied warranty of
13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
14 * GNU General Public License for more details.
16 * You should have received a copy of the GNU General Public License
17 * along with this program; if not, write to the Free Software
18 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
21 #include <linux/kernel.h>
22 #include <linux/sched.h>
23 #include <linux/init.h>
24 #include <linux/interrupt.h>
25 #include <linux/irq.h>
26 #include <linux/err.h>
27 #include <linux/clk.h>
28 #include <linux/io.h>
29 #include <linux/platform_device.h>
31 #include <asm/leds.h>
32 #include <asm/mach-types.h>
34 #include <asm/irq.h>
35 #include <mach/map.h>
36 #include <plat/regs-timer.h>
37 #include <mach/regs-irq.h>
38 #include <asm/mach/time.h>
39 #include <mach/tick.h>
41 #include <plat/clock.h>
42 #include <plat/cpu.h>
44 static unsigned long timer_startval;
45 static unsigned long timer_usec_ticks;
47 #ifndef TICK_MAX
48 #define TICK_MAX (0xffff)
49 #endif
51 #define TIMER_USEC_SHIFT 16
53 /* we use the shifted arithmetic to work out the ratio of timer ticks
54 * to usecs, as often the peripheral clock is not a nice even multiple
55 * of 1MHz.
57 * shift of 14 and 15 are too low for the 12MHz, 16 seems to be ok
58 * for the current HZ value of 200 without producing overflows.
60 * Original patch by Dimitry Andric, updated by Ben Dooks
64 /* timer_mask_usec_ticks
66 * given a clock and divisor, make the value to pass into timer_ticks_to_usec
67 * to scale the ticks into usecs
70 static inline unsigned long
71 timer_mask_usec_ticks(unsigned long scaler, unsigned long pclk)
73 unsigned long den = pclk / 1000;
75 return ((1000 << TIMER_USEC_SHIFT) * scaler + (den >> 1)) / den;
78 /* timer_ticks_to_usec
80 * convert timer ticks to usec.
83 static inline unsigned long timer_ticks_to_usec(unsigned long ticks)
85 unsigned long res;
87 res = ticks * timer_usec_ticks;
88 res += 1 << (TIMER_USEC_SHIFT - 4); /* round up slightly */
90 return res >> TIMER_USEC_SHIFT;
93 /***
94 * Returns microsecond since last clock interrupt. Note that interrupts
95 * will have been disabled by do_gettimeoffset()
96 * IRQs are disabled before entering here from do_gettimeofday()
99 static unsigned long s3c2410_gettimeoffset (void)
101 unsigned long tdone;
102 unsigned long tval;
104 /* work out how many ticks have gone since last timer interrupt */
106 tval = __raw_readl(S3C2410_TCNTO(4));
107 tdone = timer_startval - tval;
109 /* check to see if there is an interrupt pending */
111 if (s3c24xx_ostimer_pending()) {
112 /* re-read the timer, and try and fix up for the missed
113 * interrupt. Note, the interrupt may go off before the
114 * timer has re-loaded from wrapping.
117 tval = __raw_readl(S3C2410_TCNTO(4));
118 tdone = timer_startval - tval;
120 if (tval != 0)
121 tdone += timer_startval;
124 return timer_ticks_to_usec(tdone);
129 * IRQ handler for the timer
131 static irqreturn_t
132 s3c2410_timer_interrupt(int irq, void *dev_id)
134 timer_tick();
135 return IRQ_HANDLED;
138 static struct irqaction s3c2410_timer_irq = {
139 .name = "S3C2410 Timer Tick",
140 .flags = IRQF_DISABLED | IRQF_TIMER | IRQF_IRQPOLL,
141 .handler = s3c2410_timer_interrupt,
144 #define use_tclk1_12() ( \
145 machine_is_bast() || \
146 machine_is_vr1000() || \
147 machine_is_anubis() || \
148 machine_is_osiris())
150 static struct clk *tin;
151 static struct clk *tdiv;
152 static struct clk *timerclk;
155 * Set up timer interrupt, and return the current time in seconds.
157 * Currently we only use timer4, as it is the only timer which has no
158 * other function that can be exploited externally
160 static void s3c2410_timer_setup (void)
162 unsigned long tcon;
163 unsigned long tcnt;
164 unsigned long tcfg1;
165 unsigned long tcfg0;
167 tcnt = TICK_MAX; /* default value for tcnt */
169 /* configure the system for whichever machine is in use */
171 if (use_tclk1_12()) {
172 /* timer is at 12MHz, scaler is 1 */
173 timer_usec_ticks = timer_mask_usec_ticks(1, 12000000);
174 tcnt = 12000000 / HZ;
176 tcfg1 = __raw_readl(S3C2410_TCFG1);
177 tcfg1 &= ~S3C2410_TCFG1_MUX4_MASK;
178 tcfg1 |= S3C2410_TCFG1_MUX4_TCLK1;
179 __raw_writel(tcfg1, S3C2410_TCFG1);
180 } else {
181 unsigned long pclk;
182 struct clk *tscaler;
184 /* for the h1940 (and others), we use the pclk from the core
185 * to generate the timer values. since values around 50 to
186 * 70MHz are not values we can directly generate the timer
187 * value from, we need to pre-scale and divide before using it.
189 * for instance, using 50.7MHz and dividing by 6 gives 8.45MHz
190 * (8.45 ticks per usec)
193 pclk = clk_get_rate(timerclk);
195 /* configure clock tick */
197 timer_usec_ticks = timer_mask_usec_ticks(6, pclk);
199 tscaler = clk_get_parent(tdiv);
201 clk_set_rate(tscaler, pclk / 3);
202 clk_set_rate(tdiv, pclk / 6);
203 clk_set_parent(tin, tdiv);
205 tcnt = clk_get_rate(tin) / HZ;
208 tcon = __raw_readl(S3C2410_TCON);
209 tcfg0 = __raw_readl(S3C2410_TCFG0);
210 tcfg1 = __raw_readl(S3C2410_TCFG1);
212 /* timers reload after counting zero, so reduce the count by 1 */
214 tcnt--;
216 printk(KERN_DEBUG "timer tcon=%08lx, tcnt %04lx, tcfg %08lx,%08lx, usec %08lx\n",
217 tcon, tcnt, tcfg0, tcfg1, timer_usec_ticks);
219 /* check to see if timer is within 16bit range... */
220 if (tcnt > TICK_MAX) {
221 panic("setup_timer: HZ is too small, cannot configure timer!");
222 return;
225 __raw_writel(tcfg1, S3C2410_TCFG1);
226 __raw_writel(tcfg0, S3C2410_TCFG0);
228 timer_startval = tcnt;
229 __raw_writel(tcnt, S3C2410_TCNTB(4));
231 /* ensure timer is stopped... */
233 tcon &= ~(7<<20);
234 tcon |= S3C2410_TCON_T4RELOAD;
235 tcon |= S3C2410_TCON_T4MANUALUPD;
237 __raw_writel(tcon, S3C2410_TCON);
238 __raw_writel(tcnt, S3C2410_TCNTB(4));
239 __raw_writel(tcnt, S3C2410_TCMPB(4));
241 /* start the timer running */
242 tcon |= S3C2410_TCON_T4START;
243 tcon &= ~S3C2410_TCON_T4MANUALUPD;
244 __raw_writel(tcon, S3C2410_TCON);
247 static void __init s3c2410_timer_resources(void)
249 struct platform_device tmpdev;
251 tmpdev.dev.bus = &platform_bus_type;
252 tmpdev.id = 4;
254 timerclk = clk_get(NULL, "timers");
255 if (IS_ERR(timerclk))
256 panic("failed to get clock for system timer");
258 clk_enable(timerclk);
260 if (!use_tclk1_12()) {
261 tmpdev.id = 4;
262 tmpdev.dev.init_name = "s3c24xx-pwm.4";
263 tin = clk_get(&tmpdev.dev, "pwm-tin");
264 if (IS_ERR(tin))
265 panic("failed to get pwm-tin clock for system timer");
267 tdiv = clk_get(&tmpdev.dev, "pwm-tdiv");
268 if (IS_ERR(tdiv))
269 panic("failed to get pwm-tdiv clock for system timer");
272 clk_enable(tin);
275 static void __init s3c2410_timer_init(void)
277 s3c2410_timer_resources();
278 s3c2410_timer_setup();
279 setup_irq(IRQ_TIMER4, &s3c2410_timer_irq);
282 struct sys_timer s3c24xx_timer = {
283 .init = s3c2410_timer_init,
284 .offset = s3c2410_gettimeoffset,
285 .resume = s3c2410_timer_setup