vmalloc: walk vmap_areas by sorted list instead of rb_next()
[linux/fpc-iii.git] / arch / arm / plat-mxc / epit.c
blob88726f4dbbfa60b774e942176056c39f0b31fc66
1 /*
2 * linux/arch/arm/plat-mxc/epit.c
4 * Copyright (C) 2010 Sascha Hauer <s.hauer@pengutronix.de>
6 * This program is free software; you can redistribute it and/or
7 * modify it under the terms of the GNU General Public License
8 * as published by the Free Software Foundation; either version 2
9 * of the License, or (at your option) any later version.
10 * This program is distributed in the hope that it will be useful,
11 * but WITHOUT ANY WARRANTY; without even the implied warranty of
12 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
13 * GNU General Public License for more details.
15 * You should have received a copy of the GNU General Public License
16 * along with this program; if not, write to the Free Software
17 * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston,
18 * MA 02110-1301, USA.
21 #define EPITCR 0x00
22 #define EPITSR 0x04
23 #define EPITLR 0x08
24 #define EPITCMPR 0x0c
25 #define EPITCNR 0x10
27 #define EPITCR_EN (1 << 0)
28 #define EPITCR_ENMOD (1 << 1)
29 #define EPITCR_OCIEN (1 << 2)
30 #define EPITCR_RLD (1 << 3)
31 #define EPITCR_PRESC(x) (((x) & 0xfff) << 4)
32 #define EPITCR_SWR (1 << 16)
33 #define EPITCR_IOVW (1 << 17)
34 #define EPITCR_DBGEN (1 << 18)
35 #define EPITCR_WAITEN (1 << 19)
36 #define EPITCR_RES (1 << 20)
37 #define EPITCR_STOPEN (1 << 21)
38 #define EPITCR_OM_DISCON (0 << 22)
39 #define EPITCR_OM_TOGGLE (1 << 22)
40 #define EPITCR_OM_CLEAR (2 << 22)
41 #define EPITCR_OM_SET (3 << 22)
42 #define EPITCR_CLKSRC_OFF (0 << 24)
43 #define EPITCR_CLKSRC_PERIPHERAL (1 << 24)
44 #define EPITCR_CLKSRC_REF_HIGH (1 << 24)
45 #define EPITCR_CLKSRC_REF_LOW (3 << 24)
47 #define EPITSR_OCIF (1 << 0)
49 #include <linux/interrupt.h>
50 #include <linux/irq.h>
51 #include <linux/clockchips.h>
52 #include <linux/clk.h>
53 #include <linux/err.h>
55 #include <mach/hardware.h>
56 #include <asm/mach/time.h>
57 #include <mach/common.h>
59 static struct clock_event_device clockevent_epit;
60 static enum clock_event_mode clockevent_mode = CLOCK_EVT_MODE_UNUSED;
62 static void __iomem *timer_base;
64 static inline void epit_irq_disable(void)
66 u32 val;
68 val = __raw_readl(timer_base + EPITCR);
69 val &= ~EPITCR_OCIEN;
70 __raw_writel(val, timer_base + EPITCR);
73 static inline void epit_irq_enable(void)
75 u32 val;
77 val = __raw_readl(timer_base + EPITCR);
78 val |= EPITCR_OCIEN;
79 __raw_writel(val, timer_base + EPITCR);
82 static void epit_irq_acknowledge(void)
84 __raw_writel(EPITSR_OCIF, timer_base + EPITSR);
87 static int __init epit_clocksource_init(struct clk *timer_clk)
89 unsigned int c = clk_get_rate(timer_clk);
91 return clocksource_mmio_init(timer_base + EPITCNR, "epit", c, 200, 32,
92 clocksource_mmio_readl_down);
95 /* clock event */
97 static int epit_set_next_event(unsigned long evt,
98 struct clock_event_device *unused)
100 unsigned long tcmp;
102 tcmp = __raw_readl(timer_base + EPITCNR);
104 __raw_writel(tcmp - evt, timer_base + EPITCMPR);
106 return 0;
109 static void epit_set_mode(enum clock_event_mode mode,
110 struct clock_event_device *evt)
112 unsigned long flags;
115 * The timer interrupt generation is disabled at least
116 * for enough time to call epit_set_next_event()
118 local_irq_save(flags);
120 /* Disable interrupt in GPT module */
121 epit_irq_disable();
123 if (mode != clockevent_mode) {
124 /* Set event time into far-far future */
126 /* Clear pending interrupt */
127 epit_irq_acknowledge();
130 /* Remember timer mode */
131 clockevent_mode = mode;
132 local_irq_restore(flags);
134 switch (mode) {
135 case CLOCK_EVT_MODE_PERIODIC:
136 printk(KERN_ERR "epit_set_mode: Periodic mode is not "
137 "supported for i.MX EPIT\n");
138 break;
139 case CLOCK_EVT_MODE_ONESHOT:
141 * Do not put overhead of interrupt enable/disable into
142 * epit_set_next_event(), the core has about 4 minutes
143 * to call epit_set_next_event() or shutdown clock after
144 * mode switching
146 local_irq_save(flags);
147 epit_irq_enable();
148 local_irq_restore(flags);
149 break;
150 case CLOCK_EVT_MODE_SHUTDOWN:
151 case CLOCK_EVT_MODE_UNUSED:
152 case CLOCK_EVT_MODE_RESUME:
153 /* Left event sources disabled, no more interrupts appear */
154 break;
159 * IRQ handler for the timer
161 static irqreturn_t epit_timer_interrupt(int irq, void *dev_id)
163 struct clock_event_device *evt = &clockevent_epit;
165 epit_irq_acknowledge();
167 evt->event_handler(evt);
169 return IRQ_HANDLED;
172 static struct irqaction epit_timer_irq = {
173 .name = "i.MX EPIT Timer Tick",
174 .flags = IRQF_DISABLED | IRQF_TIMER | IRQF_IRQPOLL,
175 .handler = epit_timer_interrupt,
178 static struct clock_event_device clockevent_epit = {
179 .name = "epit",
180 .features = CLOCK_EVT_FEAT_ONESHOT,
181 .shift = 32,
182 .set_mode = epit_set_mode,
183 .set_next_event = epit_set_next_event,
184 .rating = 200,
187 static int __init epit_clockevent_init(struct clk *timer_clk)
189 unsigned int c = clk_get_rate(timer_clk);
191 clockevent_epit.mult = div_sc(c, NSEC_PER_SEC,
192 clockevent_epit.shift);
193 clockevent_epit.max_delta_ns =
194 clockevent_delta2ns(0xfffffffe, &clockevent_epit);
195 clockevent_epit.min_delta_ns =
196 clockevent_delta2ns(0x800, &clockevent_epit);
198 clockevent_epit.cpumask = cpumask_of(0);
200 clockevents_register_device(&clockevent_epit);
202 return 0;
205 void __init epit_timer_init(void __iomem *base, int irq)
207 struct clk *timer_clk;
209 timer_clk = clk_get_sys("imx-epit.0", NULL);
210 if (IS_ERR(timer_clk)) {
211 pr_err("i.MX epit: unable to get clk\n");
212 return;
215 clk_prepare_enable(timer_clk);
217 timer_base = base;
220 * Initialise to a known state (all timers off, and timing reset)
222 __raw_writel(0x0, timer_base + EPITCR);
224 __raw_writel(0xffffffff, timer_base + EPITLR);
225 __raw_writel(EPITCR_EN | EPITCR_CLKSRC_REF_HIGH | EPITCR_WAITEN,
226 timer_base + EPITCR);
228 /* init and register the timer to the framework */
229 epit_clocksource_init(timer_clk);
230 epit_clockevent_init(timer_clk);
232 /* Make irqs happen */
233 setup_irq(irq, &epit_timer_irq);