blob: c00f308fd505556ac83c13aec536af8353e6e4e9 [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -07001/*
2 * BRIEF MODULE DESCRIPTION
3 * Au1000 interrupt routines.
4 *
5 * Copyright 2001 MontaVista Software Inc.
6 * Author: MontaVista Software, Inc.
7 * ppopov@mvista.com or source@mvista.com
8 *
9 * This program is free software; you can redistribute it and/or modify it
10 * under the terms of the GNU General Public License as published by the
11 * Free Software Foundation; either version 2 of the License, or (at your
12 * option) any later version.
13 *
14 * THIS SOFTWARE IS PROVIDED ``AS IS'' AND ANY EXPRESS OR IMPLIED
15 * WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
16 * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN
17 * NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
18 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
19 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF
20 * USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON
21 * ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
22 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
23 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
24 *
25 * You should have received a copy of the GNU General Public License along
26 * with this program; if not, write to the Free Software Foundation, Inc.,
27 * 675 Mass Ave, Cambridge, MA 02139, USA.
28 */
Linus Torvalds1da177e2005-04-16 15:20:36 -070029#include <linux/bitops.h>
Ralf Baechle41bd61a2007-10-15 00:51:34 +010030#include <linux/init.h>
31#include <linux/io.h>
32#include <linux/interrupt.h>
33#include <linux/irq.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070034
Linus Torvalds1da177e2005-04-16 15:20:36 -070035#include <asm/mipsregs.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070036#include <asm/mach-au1x00/au1000.h>
37#ifdef CONFIG_MIPS_PB1000
38#include <asm/mach-pb1x00/pb1000.h>
39#endif
40
Linus Torvalds1da177e2005-04-16 15:20:36 -070041#define EXT_INTC0_REQ0 2 /* IP 2 */
42#define EXT_INTC0_REQ1 3 /* IP 3 */
43#define EXT_INTC1_REQ0 4 /* IP 4 */
44#define EXT_INTC1_REQ1 5 /* IP 5 */
45#define MIPS_TIMER_IP 7 /* IP 7 */
46
Linus Torvalds1da177e2005-04-16 15:20:36 -070047void (*board_init_irq)(void);
48
Linus Torvalds1da177e2005-04-16 15:20:36 -070049static DEFINE_SPINLOCK(irq_lock);
50
Linus Torvalds1da177e2005-04-16 15:20:36 -070051#ifdef CONFIG_PM
52
Ralf Baechle41bd61a2007-10-15 00:51:34 +010053/*
54 * Save/restore the interrupt controller state.
Linus Torvalds1da177e2005-04-16 15:20:36 -070055 * Called from the save/restore core registers as part of the
56 * au_sleep function in power.c.....maybe I should just pm_register()
57 * them instead?
58 */
Ralf Baechlefc103342006-06-28 11:24:12 +010059static unsigned int sleep_intctl_config0[2];
60static unsigned int sleep_intctl_config1[2];
61static unsigned int sleep_intctl_config2[2];
62static unsigned int sleep_intctl_src[2];
63static unsigned int sleep_intctl_assign[2];
64static unsigned int sleep_intctl_wake[2];
65static unsigned int sleep_intctl_mask[2];
Linus Torvalds1da177e2005-04-16 15:20:36 -070066
Ralf Baechle41bd61a2007-10-15 00:51:34 +010067void save_au1xxx_intctl(void)
Linus Torvalds1da177e2005-04-16 15:20:36 -070068{
69 sleep_intctl_config0[0] = au_readl(IC0_CFG0RD);
70 sleep_intctl_config1[0] = au_readl(IC0_CFG1RD);
71 sleep_intctl_config2[0] = au_readl(IC0_CFG2RD);
72 sleep_intctl_src[0] = au_readl(IC0_SRCRD);
73 sleep_intctl_assign[0] = au_readl(IC0_ASSIGNRD);
74 sleep_intctl_wake[0] = au_readl(IC0_WAKERD);
75 sleep_intctl_mask[0] = au_readl(IC0_MASKRD);
76
77 sleep_intctl_config0[1] = au_readl(IC1_CFG0RD);
78 sleep_intctl_config1[1] = au_readl(IC1_CFG1RD);
79 sleep_intctl_config2[1] = au_readl(IC1_CFG2RD);
80 sleep_intctl_src[1] = au_readl(IC1_SRCRD);
81 sleep_intctl_assign[1] = au_readl(IC1_ASSIGNRD);
82 sleep_intctl_wake[1] = au_readl(IC1_WAKERD);
83 sleep_intctl_mask[1] = au_readl(IC1_MASKRD);
84}
85
Ralf Baechle41bd61a2007-10-15 00:51:34 +010086/*
87 * For most restore operations, we clear the entire register and
Linus Torvalds1da177e2005-04-16 15:20:36 -070088 * then set the bits we found during the save.
89 */
Ralf Baechle41bd61a2007-10-15 00:51:34 +010090void restore_au1xxx_intctl(void)
Linus Torvalds1da177e2005-04-16 15:20:36 -070091{
92 au_writel(0xffffffff, IC0_MASKCLR); au_sync();
93
94 au_writel(0xffffffff, IC0_CFG0CLR); au_sync();
95 au_writel(sleep_intctl_config0[0], IC0_CFG0SET); au_sync();
96 au_writel(0xffffffff, IC0_CFG1CLR); au_sync();
97 au_writel(sleep_intctl_config1[0], IC0_CFG1SET); au_sync();
98 au_writel(0xffffffff, IC0_CFG2CLR); au_sync();
99 au_writel(sleep_intctl_config2[0], IC0_CFG2SET); au_sync();
100 au_writel(0xffffffff, IC0_SRCCLR); au_sync();
101 au_writel(sleep_intctl_src[0], IC0_SRCSET); au_sync();
102 au_writel(0xffffffff, IC0_ASSIGNCLR); au_sync();
103 au_writel(sleep_intctl_assign[0], IC0_ASSIGNSET); au_sync();
104 au_writel(0xffffffff, IC0_WAKECLR); au_sync();
105 au_writel(sleep_intctl_wake[0], IC0_WAKESET); au_sync();
106 au_writel(0xffffffff, IC0_RISINGCLR); au_sync();
107 au_writel(0xffffffff, IC0_FALLINGCLR); au_sync();
108 au_writel(0x00000000, IC0_TESTBIT); au_sync();
109
110 au_writel(0xffffffff, IC1_MASKCLR); au_sync();
111
112 au_writel(0xffffffff, IC1_CFG0CLR); au_sync();
113 au_writel(sleep_intctl_config0[1], IC1_CFG0SET); au_sync();
114 au_writel(0xffffffff, IC1_CFG1CLR); au_sync();
115 au_writel(sleep_intctl_config1[1], IC1_CFG1SET); au_sync();
116 au_writel(0xffffffff, IC1_CFG2CLR); au_sync();
117 au_writel(sleep_intctl_config2[1], IC1_CFG2SET); au_sync();
118 au_writel(0xffffffff, IC1_SRCCLR); au_sync();
119 au_writel(sleep_intctl_src[1], IC1_SRCSET); au_sync();
120 au_writel(0xffffffff, IC1_ASSIGNCLR); au_sync();
121 au_writel(sleep_intctl_assign[1], IC1_ASSIGNSET); au_sync();
122 au_writel(0xffffffff, IC1_WAKECLR); au_sync();
123 au_writel(sleep_intctl_wake[1], IC1_WAKESET); au_sync();
124 au_writel(0xffffffff, IC1_RISINGCLR); au_sync();
125 au_writel(0xffffffff, IC1_FALLINGCLR); au_sync();
126 au_writel(0x00000000, IC1_TESTBIT); au_sync();
127
128 au_writel(sleep_intctl_mask[1], IC1_MASKSET); au_sync();
129
130 au_writel(sleep_intctl_mask[0], IC0_MASKSET); au_sync();
131}
132#endif /* CONFIG_PM */
Ralf Baechlee4ac58a2006-04-03 17:56:36 +0100133
Ralf Baechle41bd61a2007-10-15 00:51:34 +0100134
135inline void local_enable_irq(unsigned int irq_nr)
136{
137 if (irq_nr > AU1000_LAST_INTC0_INT) {
138 au_writel(1 << (irq_nr - 32), IC1_MASKSET);
139 au_writel(1 << (irq_nr - 32), IC1_WAKESET);
140 } else {
141 au_writel(1 << irq_nr, IC0_MASKSET);
142 au_writel(1 << irq_nr, IC0_WAKESET);
143 }
144 au_sync();
145}
146
147
148inline void local_disable_irq(unsigned int irq_nr)
149{
150 if (irq_nr > AU1000_LAST_INTC0_INT) {
151 au_writel(1 << (irq_nr - 32), IC1_MASKCLR);
152 au_writel(1 << (irq_nr - 32), IC1_WAKECLR);
153 } else {
154 au_writel(1 << irq_nr, IC0_MASKCLR);
155 au_writel(1 << irq_nr, IC0_WAKECLR);
156 }
157 au_sync();
158}
159
160
161static inline void mask_and_ack_rise_edge_irq(unsigned int irq_nr)
162{
163 if (irq_nr > AU1000_LAST_INTC0_INT) {
164 au_writel(1 << (irq_nr - 32), IC1_RISINGCLR);
165 au_writel(1 << (irq_nr - 32), IC1_MASKCLR);
166 } else {
167 au_writel(1 << irq_nr, IC0_RISINGCLR);
168 au_writel(1 << irq_nr, IC0_MASKCLR);
169 }
170 au_sync();
171}
172
173
174static inline void mask_and_ack_fall_edge_irq(unsigned int irq_nr)
175{
176 if (irq_nr > AU1000_LAST_INTC0_INT) {
177 au_writel(1 << (irq_nr - 32), IC1_FALLINGCLR);
178 au_writel(1 << (irq_nr - 32), IC1_MASKCLR);
179 } else {
180 au_writel(1 << irq_nr, IC0_FALLINGCLR);
181 au_writel(1 << irq_nr, IC0_MASKCLR);
182 }
183 au_sync();
184}
185
186
187static inline void mask_and_ack_either_edge_irq(unsigned int irq_nr)
188{
189 /* This may assume that we don't get interrupts from
190 * both edges at once, or if we do, that we don't care.
191 */
192 if (irq_nr > AU1000_LAST_INTC0_INT) {
193 au_writel(1 << (irq_nr - 32), IC1_FALLINGCLR);
194 au_writel(1 << (irq_nr - 32), IC1_RISINGCLR);
195 au_writel(1 << (irq_nr - 32), IC1_MASKCLR);
196 } else {
197 au_writel(1 << irq_nr, IC0_FALLINGCLR);
198 au_writel(1 << irq_nr, IC0_RISINGCLR);
199 au_writel(1 << irq_nr, IC0_MASKCLR);
200 }
201 au_sync();
202}
203
204
205static inline void mask_and_ack_level_irq(unsigned int irq_nr)
206{
207
208 local_disable_irq(irq_nr);
209 au_sync();
210#if defined(CONFIG_MIPS_PB1000)
211 if (irq_nr == AU1000_GPIO_15) {
212 au_writel(0x8000, PB1000_MDR); /* ack int */
213 au_sync();
214 }
215#endif
216 return;
217}
218
219
220static void end_irq(unsigned int irq_nr)
221{
222 if (!(irq_desc[irq_nr].status & (IRQ_DISABLED | IRQ_INPROGRESS)))
223 local_enable_irq(irq_nr);
224
225#if defined(CONFIG_MIPS_PB1000)
226 if (irq_nr == AU1000_GPIO_15) {
227 au_writel(0x4000, PB1000_MDR); /* enable int */
228 au_sync();
229 }
230#endif
231}
232
233unsigned long save_local_and_disable(int controller)
234{
235 int i;
236 unsigned long flags, mask;
237
238 spin_lock_irqsave(&irq_lock, flags);
239 if (controller) {
240 mask = au_readl(IC1_MASKSET);
241 for (i = 32; i < 64; i++)
242 local_disable_irq(i);
243 } else {
244 mask = au_readl(IC0_MASKSET);
245 for (i = 0; i < 32; i++)
246 local_disable_irq(i);
247 }
248 spin_unlock_irqrestore(&irq_lock, flags);
249
250 return mask;
251}
252
253void restore_local_and_enable(int controller, unsigned long mask)
254{
255 int i;
256 unsigned long flags, new_mask;
257
258 spin_lock_irqsave(&irq_lock, flags);
259 for (i = 0; i < 32; i++) {
260 if (mask & (1 << i)) {
261 if (controller)
262 local_enable_irq(i + 32);
263 else
264 local_enable_irq(i);
265 }
266 }
267 if (controller)
268 new_mask = au_readl(IC1_MASKSET);
269 else
270 new_mask = au_readl(IC0_MASKSET);
271
272 spin_unlock_irqrestore(&irq_lock, flags);
273}
274
275
276static struct irq_chip rise_edge_irq_type = {
277 .name = "Au1000 Rise Edge",
278 .ack = mask_and_ack_rise_edge_irq,
279 .mask = local_disable_irq,
280 .mask_ack = mask_and_ack_rise_edge_irq,
281 .unmask = local_enable_irq,
282 .end = end_irq,
283};
284
285static struct irq_chip fall_edge_irq_type = {
286 .name = "Au1000 Fall Edge",
287 .ack = mask_and_ack_fall_edge_irq,
288 .mask = local_disable_irq,
289 .mask_ack = mask_and_ack_fall_edge_irq,
290 .unmask = local_enable_irq,
291 .end = end_irq,
292};
293
294static struct irq_chip either_edge_irq_type = {
295 .name = "Au1000 Rise or Fall Edge",
296 .ack = mask_and_ack_either_edge_irq,
297 .mask = local_disable_irq,
298 .mask_ack = mask_and_ack_either_edge_irq,
299 .unmask = local_enable_irq,
300 .end = end_irq,
301};
302
303static struct irq_chip level_irq_type = {
304 .name = "Au1000 Level",
305 .ack = mask_and_ack_level_irq,
306 .mask = local_disable_irq,
307 .mask_ack = mask_and_ack_level_irq,
308 .unmask = local_enable_irq,
309 .end = end_irq,
310};
311
312#ifdef CONFIG_PM
313void startup_match20_interrupt(irq_handler_t handler)
314{
315 struct irq_desc *desc = &irq_desc[AU1000_TOY_MATCH2_INT];
316
317 static struct irqaction action;
318 memset(&action, 0, sizeof(struct irqaction));
319
320 /*
321 * This is a big problem.... since we didn't use request_irq
322 * when kernel/irq.c calls probe_irq_xxx this interrupt will
323 * be probed for usage. This will end up disabling the device :(
324 * Give it a bogus "action" pointer -- this will keep it from
325 * getting auto-probed!
326 *
327 * By setting the status to match that of request_irq() we
328 * can avoid it. --cgray
329 */
330 action.dev_id = handler;
331 action.flags = IRQF_DISABLED;
332 cpus_clear(action.mask);
333 action.name = "Au1xxx TOY";
334 action.handler = handler;
335 action.next = NULL;
336
337 desc->action = &action;
338 desc->status &= ~(IRQ_DISABLED | IRQ_AUTODETECT | IRQ_WAITING | IRQ_INPROGRESS);
339
340 local_enable_irq(AU1000_TOY_MATCH2_INT);
341}
342#endif
343
344static void setup_local_irq(unsigned int irq_nr, int type, int int_req)
345{
346 if (irq_nr > AU1000_MAX_INTR) return;
347 /* Config2[n], Config1[n], Config0[n] */
348 if (irq_nr > AU1000_LAST_INTC0_INT) {
349 switch (type) {
350 case INTC_INT_RISE_EDGE: /* 0:0:1 */
351 au_writel(1 << (irq_nr - 32), IC1_CFG2CLR);
352 au_writel(1 << (irq_nr - 32), IC1_CFG1CLR);
353 au_writel(1 << (irq_nr - 32), IC1_CFG0SET);
354 set_irq_chip(irq_nr, &rise_edge_irq_type);
355 break;
356 case INTC_INT_FALL_EDGE: /* 0:1:0 */
357 au_writel(1 << (irq_nr - 32), IC1_CFG2CLR);
358 au_writel(1 << (irq_nr - 32), IC1_CFG1SET);
359 au_writel(1 << (irq_nr - 32), IC1_CFG0CLR);
360 set_irq_chip(irq_nr, &fall_edge_irq_type);
361 break;
362 case INTC_INT_RISE_AND_FALL_EDGE: /* 0:1:1 */
363 au_writel(1 << (irq_nr - 32), IC1_CFG2CLR);
364 au_writel(1 << (irq_nr - 32), IC1_CFG1SET);
365 au_writel(1 << (irq_nr - 32), IC1_CFG0SET);
366 set_irq_chip(irq_nr, &either_edge_irq_type);
367 break;
368 case INTC_INT_HIGH_LEVEL: /* 1:0:1 */
369 au_writel(1 << (irq_nr - 32), IC1_CFG2SET);
370 au_writel(1 << (irq_nr - 32), IC1_CFG1CLR);
371 au_writel(1 << (irq_nr - 32), IC1_CFG0SET);
372 set_irq_chip(irq_nr, &level_irq_type);
373 break;
374 case INTC_INT_LOW_LEVEL: /* 1:1:0 */
375 au_writel(1 << (irq_nr - 32), IC1_CFG2SET);
376 au_writel(1 << (irq_nr - 32), IC1_CFG1SET);
377 au_writel(1 << (irq_nr - 32), IC1_CFG0CLR);
378 set_irq_chip(irq_nr, &level_irq_type);
379 break;
380 case INTC_INT_DISABLED: /* 0:0:0 */
381 au_writel(1 << (irq_nr - 32), IC1_CFG0CLR);
382 au_writel(1 << (irq_nr - 32), IC1_CFG1CLR);
383 au_writel(1 << (irq_nr - 32), IC1_CFG2CLR);
384 break;
385 default: /* disable the interrupt */
386 printk(KERN_WARNING "unexpected int type %d (irq %d)\n",
387 type, irq_nr);
388 au_writel(1 << (irq_nr - 32), IC1_CFG0CLR);
389 au_writel(1 << (irq_nr - 32), IC1_CFG1CLR);
390 au_writel(1 << (irq_nr - 32), IC1_CFG2CLR);
391 return;
392 }
393 if (int_req) /* assign to interrupt request 1 */
394 au_writel(1 << (irq_nr - 32), IC1_ASSIGNCLR);
395 else /* assign to interrupt request 0 */
396 au_writel(1 << (irq_nr - 32), IC1_ASSIGNSET);
397 au_writel(1 << (irq_nr - 32), IC1_SRCSET);
398 au_writel(1 << (irq_nr - 32), IC1_MASKCLR);
399 au_writel(1 << (irq_nr - 32), IC1_WAKECLR);
400 } else {
401 switch (type) {
402 case INTC_INT_RISE_EDGE: /* 0:0:1 */
403 au_writel(1 << irq_nr, IC0_CFG2CLR);
404 au_writel(1 << irq_nr, IC0_CFG1CLR);
405 au_writel(1 << irq_nr, IC0_CFG0SET);
406 set_irq_chip(irq_nr, &rise_edge_irq_type);
407 break;
408 case INTC_INT_FALL_EDGE: /* 0:1:0 */
409 au_writel(1 << irq_nr, IC0_CFG2CLR);
410 au_writel(1 << irq_nr, IC0_CFG1SET);
411 au_writel(1 << irq_nr, IC0_CFG0CLR);
412 set_irq_chip(irq_nr, &fall_edge_irq_type);
413 break;
414 case INTC_INT_RISE_AND_FALL_EDGE: /* 0:1:1 */
415 au_writel(1 << irq_nr, IC0_CFG2CLR);
416 au_writel(1 << irq_nr, IC0_CFG1SET);
417 au_writel(1 << irq_nr, IC0_CFG0SET);
418 set_irq_chip(irq_nr, &either_edge_irq_type);
419 break;
420 case INTC_INT_HIGH_LEVEL: /* 1:0:1 */
421 au_writel(1 << irq_nr, IC0_CFG2SET);
422 au_writel(1 << irq_nr, IC0_CFG1CLR);
423 au_writel(1 << irq_nr, IC0_CFG0SET);
424 set_irq_chip(irq_nr, &level_irq_type);
425 break;
426 case INTC_INT_LOW_LEVEL: /* 1:1:0 */
427 au_writel(1 << irq_nr, IC0_CFG2SET);
428 au_writel(1 << irq_nr, IC0_CFG1SET);
429 au_writel(1 << irq_nr, IC0_CFG0CLR);
430 set_irq_chip(irq_nr, &level_irq_type);
431 break;
432 case INTC_INT_DISABLED: /* 0:0:0 */
433 au_writel(1 << irq_nr, IC0_CFG0CLR);
434 au_writel(1 << irq_nr, IC0_CFG1CLR);
435 au_writel(1 << irq_nr, IC0_CFG2CLR);
436 break;
437 default: /* disable the interrupt */
438 printk(KERN_WARNING "unexpected int type %d (irq %d)\n",
439 type, irq_nr);
440 au_writel(1 << irq_nr, IC0_CFG0CLR);
441 au_writel(1 << irq_nr, IC0_CFG1CLR);
442 au_writel(1 << irq_nr, IC0_CFG2CLR);
443 return;
444 }
445 if (int_req) /* assign to interrupt request 1 */
446 au_writel(1 << irq_nr, IC0_ASSIGNCLR);
447 else /* assign to interrupt request 0 */
448 au_writel(1 << irq_nr, IC0_ASSIGNSET);
449 au_writel(1 << irq_nr, IC0_SRCSET);
450 au_writel(1 << irq_nr, IC0_MASKCLR);
451 au_writel(1 << irq_nr, IC0_WAKECLR);
452 }
453 au_sync();
454}
455
456/*
457 * Interrupts are nested. Even if an interrupt handler is registered
458 * as "fast", we might get another interrupt before we return from
459 * intcX_reqX_irqdispatch().
460 */
461
462static void intc0_req0_irqdispatch(void)
463{
464 int irq = 0;
465 static unsigned long intc0_req0;
466
467 intc0_req0 |= au_readl(IC0_REQ0INT);
468
469 if (!intc0_req0)
470 return;
471
472#ifdef AU1000_USB_DEV_REQ_INT
473 /*
474 * Because of the tight timing of SETUP token to reply
475 * transactions, the USB devices-side packet complete
476 * interrupt needs the highest priority.
477 */
478 if ((intc0_req0 & (1 << AU1000_USB_DEV_REQ_INT))) {
479 intc0_req0 &= ~(1 << AU1000_USB_DEV_REQ_INT);
480 do_IRQ(AU1000_USB_DEV_REQ_INT);
481 return;
482 }
483#endif
Ralf Baechle56f621c2007-10-15 01:00:06 +0100484 irq = ffs(intc0_req0);
Ralf Baechle41bd61a2007-10-15 00:51:34 +0100485 intc0_req0 &= ~(1 << irq);
486 do_IRQ(irq);
487}
488
489
490static void intc0_req1_irqdispatch(void)
491{
492 int irq = 0;
493 static unsigned long intc0_req1;
494
495 intc0_req1 |= au_readl(IC0_REQ1INT);
496
497 if (!intc0_req1)
498 return;
499
Ralf Baechle56f621c2007-10-15 01:00:06 +0100500 irq = ffs(intc0_req1);
Ralf Baechle41bd61a2007-10-15 00:51:34 +0100501 intc0_req1 &= ~(1 << irq);
502 do_IRQ(irq);
503}
504
505
506/*
507 * Interrupt Controller 1:
508 * interrupts 32 - 63
509 */
510static void intc1_req0_irqdispatch(void)
511{
512 int irq = 0;
513 static unsigned long intc1_req0;
514
515 intc1_req0 |= au_readl(IC1_REQ0INT);
516
517 if (!intc1_req0)
518 return;
519
Ralf Baechle56f621c2007-10-15 01:00:06 +0100520 irq = ffs(intc1_req0);
Ralf Baechle41bd61a2007-10-15 00:51:34 +0100521 intc1_req0 &= ~(1 << irq);
522 irq += 32;
523 do_IRQ(irq);
524}
525
526
527static void intc1_req1_irqdispatch(void)
528{
529 int irq = 0;
530 static unsigned long intc1_req1;
531
532 intc1_req1 |= au_readl(IC1_REQ1INT);
533
534 if (!intc1_req1)
535 return;
536
Ralf Baechle56f621c2007-10-15 01:00:06 +0100537 irq = ffs(intc1_req1);
Ralf Baechle41bd61a2007-10-15 00:51:34 +0100538 intc1_req1 &= ~(1 << irq);
539 irq += 32;
540 do_IRQ(irq);
541}
542
Ralf Baechle937a8012006-10-07 19:44:33 +0100543asmlinkage void plat_irq_dispatch(void)
Ralf Baechlee4ac58a2006-04-03 17:56:36 +0100544{
545 unsigned int pending = read_c0_status() & read_c0_cause() & ST0_IM;
546
547 if (pending & CAUSEF_IP7)
Ralf Baechle7bcf7712007-10-11 23:46:09 +0100548 do_IRQ(63);
Ralf Baechlee4ac58a2006-04-03 17:56:36 +0100549 else if (pending & CAUSEF_IP2)
Ralf Baechle937a8012006-10-07 19:44:33 +0100550 intc0_req0_irqdispatch();
Ralf Baechlee4ac58a2006-04-03 17:56:36 +0100551 else if (pending & CAUSEF_IP3)
Ralf Baechle937a8012006-10-07 19:44:33 +0100552 intc0_req1_irqdispatch();
Ralf Baechlee4ac58a2006-04-03 17:56:36 +0100553 else if (pending & CAUSEF_IP4)
Ralf Baechle937a8012006-10-07 19:44:33 +0100554 intc1_req0_irqdispatch();
Ralf Baechlee4ac58a2006-04-03 17:56:36 +0100555 else if (pending & CAUSEF_IP5)
Ralf Baechle937a8012006-10-07 19:44:33 +0100556 intc1_req1_irqdispatch();
Ralf Baechlee4ac58a2006-04-03 17:56:36 +0100557 else
Ralf Baechle937a8012006-10-07 19:44:33 +0100558 spurious_interrupt();
Ralf Baechlee4ac58a2006-04-03 17:56:36 +0100559}
Ralf Baechle41bd61a2007-10-15 00:51:34 +0100560
561void __init arch_init_irq(void)
562{
563 int i;
564 unsigned long cp0_status;
Ralf Baechle0e6799e2007-10-15 01:07:39 +0100565 struct au1xxx_irqmap *imp;
566 extern struct au1xxx_irqmap au1xxx_irq_map[];
567 extern struct au1xxx_irqmap au1xxx_ic0_map[];
Ralf Baechle41bd61a2007-10-15 00:51:34 +0100568 extern int au1xxx_nr_irqs;
569 extern int au1xxx_ic0_nr_irqs;
570
571 cp0_status = read_c0_status();
572
573 /* Initialize interrupt controllers to a safe state.
574 */
575 au_writel(0xffffffff, IC0_CFG0CLR);
576 au_writel(0xffffffff, IC0_CFG1CLR);
577 au_writel(0xffffffff, IC0_CFG2CLR);
578 au_writel(0xffffffff, IC0_MASKCLR);
579 au_writel(0xffffffff, IC0_ASSIGNSET);
580 au_writel(0xffffffff, IC0_WAKECLR);
581 au_writel(0xffffffff, IC0_SRCSET);
582 au_writel(0xffffffff, IC0_FALLINGCLR);
583 au_writel(0xffffffff, IC0_RISINGCLR);
584 au_writel(0x00000000, IC0_TESTBIT);
585
586 au_writel(0xffffffff, IC1_CFG0CLR);
587 au_writel(0xffffffff, IC1_CFG1CLR);
588 au_writel(0xffffffff, IC1_CFG2CLR);
589 au_writel(0xffffffff, IC1_MASKCLR);
590 au_writel(0xffffffff, IC1_ASSIGNSET);
591 au_writel(0xffffffff, IC1_WAKECLR);
592 au_writel(0xffffffff, IC1_SRCSET);
593 au_writel(0xffffffff, IC1_FALLINGCLR);
594 au_writel(0xffffffff, IC1_RISINGCLR);
595 au_writel(0x00000000, IC1_TESTBIT);
596
597 /* Initialize IC0, which is fixed per processor.
598 */
599 imp = au1xxx_ic0_map;
600 for (i = 0; i < au1xxx_ic0_nr_irqs; i++) {
601 setup_local_irq(imp->im_irq, imp->im_type, imp->im_request);
602 imp++;
603 }
604
605 /* Now set up the irq mapping for the board.
606 */
607 imp = au1xxx_irq_map;
608 for (i = 0; i < au1xxx_nr_irqs; i++) {
609 setup_local_irq(imp->im_irq, imp->im_type, imp->im_request);
610 imp++;
611 }
612
613 set_c0_status(ALLINTS);
614
615 /* Board specific IRQ initialization.
616 */
617 if (board_init_irq)
618 (*board_init_irq)();
619}