1
2
3
4
5
6
7
8
9
10
11
12#include <linux/kernel_stat.h>
13#include <linux/module.h>
14#include <linux/signal.h>
15#include <linux/ioport.h>
16#include <linux/interrupt.h>
17#include <linux/irq.h>
18#include <linux/random.h>
19#include <linux/smp.h>
20#include <linux/init.h>
21#include <linux/seq_file.h>
22#include <linux/errno.h>
23#include <linux/list.h>
24#include <linux/kallsyms.h>
25#include <linux/proc_fs.h>
26#include <linux/syscore_ops.h>
27#include <linux/gpio.h>
28
29#include <mach/hardware.h>
30
31#include "setup.h"
32
33
34
35
36
37
38static int GPIO_IRQ_rising_edge;
39static int GPIO_IRQ_falling_edge;
40static int GPIO_IRQ_mask = 0;
41
42#define GPIO_MASK(irq) (1 << (irq - IRQ_GPIO0))
43
44static int puv3_gpio_type(struct irq_data *d, unsigned int type)
45{
46 unsigned int mask;
47
48 if (d->irq < IRQ_GPIOHIGH)
49 mask = 1 << d->irq;
50 else
51 mask = GPIO_MASK(d->irq);
52
53 if (type == IRQ_TYPE_PROBE) {
54 if ((GPIO_IRQ_rising_edge | GPIO_IRQ_falling_edge) & mask)
55 return 0;
56 type = IRQ_TYPE_EDGE_RISING | IRQ_TYPE_EDGE_FALLING;
57 }
58
59 if (type & IRQ_TYPE_EDGE_RISING)
60 GPIO_IRQ_rising_edge |= mask;
61 else
62 GPIO_IRQ_rising_edge &= ~mask;
63 if (type & IRQ_TYPE_EDGE_FALLING)
64 GPIO_IRQ_falling_edge |= mask;
65 else
66 GPIO_IRQ_falling_edge &= ~mask;
67
68 writel(GPIO_IRQ_rising_edge & GPIO_IRQ_mask, GPIO_GRER);
69 writel(GPIO_IRQ_falling_edge & GPIO_IRQ_mask, GPIO_GFER);
70
71 return 0;
72}
73
74
75
76
77static void puv3_low_gpio_ack(struct irq_data *d)
78{
79 writel((1 << d->irq), GPIO_GEDR);
80}
81
82static void puv3_low_gpio_mask(struct irq_data *d)
83{
84 writel(readl(INTC_ICMR) & ~(1 << d->irq), INTC_ICMR);
85}
86
87static void puv3_low_gpio_unmask(struct irq_data *d)
88{
89 writel(readl(INTC_ICMR) | (1 << d->irq), INTC_ICMR);
90}
91
92static int puv3_low_gpio_wake(struct irq_data *d, unsigned int on)
93{
94 if (on)
95 writel(readl(PM_PWER) | (1 << d->irq), PM_PWER);
96 else
97 writel(readl(PM_PWER) & ~(1 << d->irq), PM_PWER);
98 return 0;
99}
100
101static struct irq_chip puv3_low_gpio_chip = {
102 .name = "GPIO-low",
103 .irq_ack = puv3_low_gpio_ack,
104 .irq_mask = puv3_low_gpio_mask,
105 .irq_unmask = puv3_low_gpio_unmask,
106 .irq_set_type = puv3_gpio_type,
107 .irq_set_wake = puv3_low_gpio_wake,
108};
109
110
111
112
113
114
115static void puv3_gpio_handler(struct irq_desc *desc)
116{
117 unsigned int mask, irq;
118
119 mask = readl(GPIO_GEDR);
120 do {
121
122
123
124
125 writel(mask, GPIO_GEDR);
126
127 irq = IRQ_GPIO0;
128 do {
129 if (mask & 1)
130 generic_handle_irq(irq);
131 mask >>= 1;
132 irq++;
133 } while (mask);
134 mask = readl(GPIO_GEDR);
135 } while (mask);
136}
137
138
139
140
141
142
143static void puv3_high_gpio_ack(struct irq_data *d)
144{
145 unsigned int mask = GPIO_MASK(d->irq);
146
147 writel(mask, GPIO_GEDR);
148}
149
150static void puv3_high_gpio_mask(struct irq_data *d)
151{
152 unsigned int mask = GPIO_MASK(d->irq);
153
154 GPIO_IRQ_mask &= ~mask;
155
156 writel(readl(GPIO_GRER) & ~mask, GPIO_GRER);
157 writel(readl(GPIO_GFER) & ~mask, GPIO_GFER);
158}
159
160static void puv3_high_gpio_unmask(struct irq_data *d)
161{
162 unsigned int mask = GPIO_MASK(d->irq);
163
164 GPIO_IRQ_mask |= mask;
165
166 writel(GPIO_IRQ_rising_edge & GPIO_IRQ_mask, GPIO_GRER);
167 writel(GPIO_IRQ_falling_edge & GPIO_IRQ_mask, GPIO_GFER);
168}
169
170static int puv3_high_gpio_wake(struct irq_data *d, unsigned int on)
171{
172 if (on)
173 writel(readl(PM_PWER) | PM_PWER_GPIOHIGH, PM_PWER);
174 else
175 writel(readl(PM_PWER) & ~PM_PWER_GPIOHIGH, PM_PWER);
176 return 0;
177}
178
179static struct irq_chip puv3_high_gpio_chip = {
180 .name = "GPIO-high",
181 .irq_ack = puv3_high_gpio_ack,
182 .irq_mask = puv3_high_gpio_mask,
183 .irq_unmask = puv3_high_gpio_unmask,
184 .irq_set_type = puv3_gpio_type,
185 .irq_set_wake = puv3_high_gpio_wake,
186};
187
188
189
190
191
192static void puv3_mask_irq(struct irq_data *d)
193{
194 writel(readl(INTC_ICMR) & ~(1 << d->irq), INTC_ICMR);
195}
196
197static void puv3_unmask_irq(struct irq_data *d)
198{
199 writel(readl(INTC_ICMR) | (1 << d->irq), INTC_ICMR);
200}
201
202
203
204
205static int puv3_set_wake(struct irq_data *d, unsigned int on)
206{
207 if (d->irq == IRQ_RTCAlarm) {
208 if (on)
209 writel(readl(PM_PWER) | PM_PWER_RTC, PM_PWER);
210 else
211 writel(readl(PM_PWER) & ~PM_PWER_RTC, PM_PWER);
212 return 0;
213 }
214 return -EINVAL;
215}
216
217static struct irq_chip puv3_normal_chip = {
218 .name = "PKUnity-v3",
219 .irq_ack = puv3_mask_irq,
220 .irq_mask = puv3_mask_irq,
221 .irq_unmask = puv3_unmask_irq,
222 .irq_set_wake = puv3_set_wake,
223};
224
225static struct resource irq_resource = {
226 .name = "irqs",
227 .start = io_v2p(PKUNITY_INTC_BASE),
228 .end = io_v2p(PKUNITY_INTC_BASE) + 0xFFFFF,
229};
230
231static struct puv3_irq_state {
232 unsigned int saved;
233 unsigned int icmr;
234 unsigned int iclr;
235 unsigned int iccr;
236} puv3_irq_state;
237
238static int puv3_irq_suspend(void)
239{
240 struct puv3_irq_state *st = &puv3_irq_state;
241
242 st->saved = 1;
243 st->icmr = readl(INTC_ICMR);
244 st->iclr = readl(INTC_ICLR);
245 st->iccr = readl(INTC_ICCR);
246
247
248
249
250 writel(readl(INTC_ICMR) & ~(0x1ff), INTC_ICMR);
251
252
253
254
255 writel(readl(PM_PWER) & GPIO_IRQ_rising_edge, GPIO_GRER);
256 writel(readl(PM_PWER) & GPIO_IRQ_falling_edge, GPIO_GFER);
257
258
259
260
261 writel(readl(GPIO_GEDR), GPIO_GEDR);
262
263 return 0;
264}
265
266static void puv3_irq_resume(void)
267{
268 struct puv3_irq_state *st = &puv3_irq_state;
269
270 if (st->saved) {
271 writel(st->iccr, INTC_ICCR);
272 writel(st->iclr, INTC_ICLR);
273
274 writel(GPIO_IRQ_rising_edge & GPIO_IRQ_mask, GPIO_GRER);
275 writel(GPIO_IRQ_falling_edge & GPIO_IRQ_mask, GPIO_GFER);
276
277 writel(st->icmr, INTC_ICMR);
278 }
279}
280
281static struct syscore_ops puv3_irq_syscore_ops = {
282 .suspend = puv3_irq_suspend,
283 .resume = puv3_irq_resume,
284};
285
286static int __init puv3_irq_init_syscore(void)
287{
288 register_syscore_ops(&puv3_irq_syscore_ops);
289 return 0;
290}
291
292device_initcall(puv3_irq_init_syscore);
293
294void __init init_IRQ(void)
295{
296 unsigned int irq;
297
298 request_resource(&iomem_resource, &irq_resource);
299
300
301 writel(0, INTC_ICMR);
302
303
304 writel(0, INTC_ICLR);
305
306
307 writel(FMASK(8, 0) & ~FIELD(1, 1, GPI_SOFF_REQ), GPIO_GPIR);
308 writel(0, GPIO_GFER);
309 writel(0, GPIO_GRER);
310 writel(0x0FFFFFFF, GPIO_GEDR);
311
312 writel(1, INTC_ICCR);
313
314 for (irq = 0; irq < IRQ_GPIOHIGH; irq++) {
315 irq_set_chip(irq, &puv3_low_gpio_chip);
316 irq_set_handler(irq, handle_edge_irq);
317 irq_modify_status(irq,
318 IRQ_NOREQUEST | IRQ_NOPROBE | IRQ_NOAUTOEN,
319 0);
320 }
321
322 for (irq = IRQ_GPIOHIGH + 1; irq < IRQ_GPIO0; irq++) {
323 irq_set_chip(irq, &puv3_normal_chip);
324 irq_set_handler(irq, handle_level_irq);
325 irq_modify_status(irq,
326 IRQ_NOREQUEST | IRQ_NOAUTOEN,
327 IRQ_NOPROBE);
328 }
329
330 for (irq = IRQ_GPIO0; irq <= IRQ_GPIO27; irq++) {
331 irq_set_chip(irq, &puv3_high_gpio_chip);
332 irq_set_handler(irq, handle_edge_irq);
333 irq_modify_status(irq,
334 IRQ_NOREQUEST | IRQ_NOPROBE | IRQ_NOAUTOEN,
335 0);
336 }
337
338
339
340
341 irq_set_chip(IRQ_GPIOHIGH, &puv3_normal_chip);
342 irq_set_chained_handler(IRQ_GPIOHIGH, puv3_gpio_handler);
343
344#ifdef CONFIG_PUV3_GPIO
345 puv3_init_gpio();
346#endif
347}
348
349
350
351
352
353
354asmlinkage void asm_do_IRQ(unsigned int irq, struct pt_regs *regs)
355{
356 struct pt_regs *old_regs = set_irq_regs(regs);
357
358 irq_enter();
359
360
361
362
363
364 if (unlikely(irq >= nr_irqs)) {
365 if (printk_ratelimit())
366 printk(KERN_WARNING "Bad IRQ%u\n", irq);
367 ack_bad_irq(irq);
368 } else {
369 generic_handle_irq(irq);
370 }
371
372 irq_exit();
373 set_irq_regs(old_regs);
374}
375
376