Merge master.kernel.org:/home/rmk/linux-2.6-arm
[linux-2.6] / arch / mips / emma2rh / common / irq.c
1 /*
2  *  arch/mips/emma2rh/common/irq.c
3  *      This file is common irq dispatcher.
4  *
5  *  Copyright (C) NEC Electronics Corporation 2005-2006
6  *
7  *  This file is based on the arch/mips/ddb5xxx/ddb5477/irq.c
8  *
9  *      Copyright 2001 MontaVista Software Inc.
10  *
11  *  This program is free software; you can redistribute it and/or modify
12  *  it under the terms of the GNU General Public License as published by
13  *  the Free Software Foundation; either version 2 of the License, or
14  *  (at your option) any later version.
15  *
16  *  This program is distributed in the hope that it will be useful,
17  *  but WITHOUT ANY WARRANTY; without even the implied warranty of
18  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
19  *  GNU General Public License for more details.
20  *
21  *  You should have received a copy of the GNU General Public License
22  *  along with this program; if not, write to the Free Software
23  *  Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
24  */
25 #include <linux/config.h>
26 #include <linux/init.h>
27 #include <linux/interrupt.h>
28 #include <linux/irq.h>
29 #include <linux/types.h>
30
31 #include <asm/i8259.h>
32 #include <asm/system.h>
33 #include <asm/mipsregs.h>
34 #include <asm/debug.h>
35 #include <asm/addrspace.h>
36 #include <asm/bootinfo.h>
37
38 #include <asm/emma2rh/emma2rh.h>
39
40 /*
41  * the first level int-handler will jump here if it is a emma2rh irq
42  */
43 asmlinkage void emma2rh_irq_dispatch(struct pt_regs *regs)
44 {
45         u32 intStatus;
46         u32 bitmask;
47         u32 i;
48
49         intStatus = emma2rh_in32(EMMA2RH_BHIF_INT_ST_0)
50             & emma2rh_in32(EMMA2RH_BHIF_INT_EN_0);
51
52 #ifdef EMMA2RH_SW_CASCADE
53         if (intStatus &
54             (1 << ((EMMA2RH_SW_CASCADE - EMMA2RH_IRQ_INT0) & (32 - 1)))) {
55                 u32 swIntStatus;
56                 swIntStatus = emma2rh_in32(EMMA2RH_BHIF_SW_INT)
57                     & emma2rh_in32(EMMA2RH_BHIF_SW_INT_EN);
58                 for (i = 0, bitmask = 1; i < 32; i++, bitmask <<= 1) {
59                         if (swIntStatus & bitmask) {
60                                 do_IRQ(EMMA2RH_SW_IRQ_BASE + i, regs);
61                                 return;
62                         }
63                 }
64         }
65 #endif
66
67         for (i = 0, bitmask = 1; i < 32; i++, bitmask <<= 1) {
68                 if (intStatus & bitmask) {
69                         do_IRQ(EMMA2RH_IRQ_BASE + i, regs);
70                         return;
71                 }
72         }
73
74         intStatus = emma2rh_in32(EMMA2RH_BHIF_INT_ST_1)
75             & emma2rh_in32(EMMA2RH_BHIF_INT_EN_1);
76
77 #ifdef EMMA2RH_GPIO_CASCADE
78         if (intStatus &
79             (1 << ((EMMA2RH_GPIO_CASCADE - EMMA2RH_IRQ_INT0) & (32 - 1)))) {
80                 u32 gpioIntStatus;
81                 gpioIntStatus = emma2rh_in32(EMMA2RH_GPIO_INT_ST)
82                     & emma2rh_in32(EMMA2RH_GPIO_INT_MASK);
83                 for (i = 0, bitmask = 1; i < 32; i++, bitmask <<= 1) {
84                         if (gpioIntStatus & bitmask) {
85                                 do_IRQ(EMMA2RH_GPIO_IRQ_BASE + i, regs);
86                                 return;
87                         }
88                 }
89         }
90 #endif
91
92         for (i = 32, bitmask = 1; i < 64; i++, bitmask <<= 1) {
93                 if (intStatus & bitmask) {
94                         do_IRQ(EMMA2RH_IRQ_BASE + i, regs);
95                         return;
96                 }
97         }
98
99         intStatus = emma2rh_in32(EMMA2RH_BHIF_INT_ST_2)
100             & emma2rh_in32(EMMA2RH_BHIF_INT_EN_2);
101
102         for (i = 64, bitmask = 1; i < 96; i++, bitmask <<= 1) {
103                 if (intStatus & bitmask) {
104                         do_IRQ(EMMA2RH_IRQ_BASE + i, regs);
105                         return;
106                 }
107         }
108 }