Commit | Line | Data |
---|---|---|
5f53a56a MD |
1 | /* |
2 | * sh73a0 processor support - INTC hardware block | |
3 | * | |
4 | * Copyright (C) 2010 Magnus Damm | |
5 | * | |
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; version 2 of the License. | |
9 | * | |
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. | |
14 | * | |
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 St, Fifth Floor, Boston, MA 02110-1301 USA | |
18 | */ | |
19 | #include <linux/kernel.h> | |
20 | #include <linux/init.h> | |
21 | #include <linux/interrupt.h> | |
e2c31b3f | 22 | #include <linux/module.h> |
5f53a56a MD |
23 | #include <linux/irq.h> |
24 | #include <linux/io.h> | |
a3f22db5 | 25 | #include <linux/irqchip.h> |
520f7bd7 | 26 | #include <linux/irqchip/arm-gic.h> |
ded59d6d | 27 | |
5f53a56a MD |
28 | #include <asm/mach-types.h> |
29 | #include <asm/mach/arch.h> | |
ded59d6d | 30 | |
6200e2c1 | 31 | #include "intc.h" |
b6bab126 | 32 | #include "irqs.h" |
ded59d6d | 33 | #include "sh73a0.h" |
5f53a56a MD |
34 | |
35 | enum { | |
36 | UNUSED = 0, | |
37 | ||
38 | /* interrupt sources INTCS */ | |
39 | PINTCS_PINT1, PINTCS_PINT2, | |
40 | RTDMAC_0_DEI0, RTDMAC_0_DEI1, RTDMAC_0_DEI2, RTDMAC_0_DEI3, | |
41 | CEU, MFI, BBIF2, VPU, TSIF1, _3DG_SGX543, _2DDMAC_2DDM0, | |
42 | RTDMAC_1_DEI4, RTDMAC_1_DEI5, RTDMAC_1_DADERR, | |
43 | KEYSC_KEY, VINT, MSIOF, | |
44 | TMU0_TUNI00, TMU0_TUNI01, TMU0_TUNI02, | |
45 | CMT0, TSIF0, CMT2, LMB, MSUG, MSU_MSU, MSU_MSU2, | |
46 | CTI, RWDT0, ICB, PEP, ASA, JPU_JPEG, LCDC, LCRC, | |
47 | RTDMAC_2_DEI6, RTDMAC_2_DEI7, RTDMAC_2_DEI8, RTDMAC_2_DEI9, | |
48 | RTDMAC_3_DEI10, RTDMAC_3_DEI11, | |
49 | FRC, GCU, LCDC1, CSIRX, | |
50 | DSITX0_DSITX00, DSITX0_DSITX01, | |
51 | SPU2_SPU0, SPU2_SPU1, FSI, | |
52 | TMU1_TUNI10, TMU1_TUNI11, TMU1_TUNI12, | |
53 | TSIF2, CMT4, MFIS2, CPORTS2R, TSG, DMASCH1, SCUW, | |
54 | VIO60, VIO61, CEU21, CSI21, DSITX1_DSITX10, DSITX1_DSITX11, | |
55 | DISP, DSRV, EMUX2_EMUX20I, EMUX2_EMUX21I, | |
56 | MSTIF0_MST00I, MSTIF0_MST01I, MSTIF1_MST10I, MSTIF1_MST11I, | |
57 | SPUV, | |
58 | ||
59 | /* interrupt groups INTCS */ | |
60 | RTDMAC_0, RTDMAC_1, RTDMAC_2, RTDMAC_3, | |
61 | DSITX0, SPU2, TMU1, MSU, | |
62 | }; | |
63 | ||
64 | static struct intc_vect intcs_vectors[] = { | |
65 | INTCS_VECT(PINTCS_PINT1, 0x0600), INTCS_VECT(PINTCS_PINT2, 0x0620), | |
66 | INTCS_VECT(RTDMAC_0_DEI0, 0x0800), INTCS_VECT(RTDMAC_0_DEI1, 0x0820), | |
67 | INTCS_VECT(RTDMAC_0_DEI2, 0x0840), INTCS_VECT(RTDMAC_0_DEI3, 0x0860), | |
68 | INTCS_VECT(CEU, 0x0880), INTCS_VECT(MFI, 0x0900), | |
69 | INTCS_VECT(BBIF2, 0x0960), INTCS_VECT(VPU, 0x0980), | |
70 | INTCS_VECT(TSIF1, 0x09a0), INTCS_VECT(_3DG_SGX543, 0x09e0), | |
71 | INTCS_VECT(_2DDMAC_2DDM0, 0x0a00), | |
72 | INTCS_VECT(RTDMAC_1_DEI4, 0x0b80), INTCS_VECT(RTDMAC_1_DEI5, 0x0ba0), | |
73 | INTCS_VECT(RTDMAC_1_DADERR, 0x0bc0), | |
74 | INTCS_VECT(KEYSC_KEY, 0x0be0), INTCS_VECT(VINT, 0x0c80), | |
75 | INTCS_VECT(MSIOF, 0x0d20), | |
76 | INTCS_VECT(TMU0_TUNI00, 0x0e80), INTCS_VECT(TMU0_TUNI01, 0x0ea0), | |
77 | INTCS_VECT(TMU0_TUNI02, 0x0ec0), | |
78 | INTCS_VECT(CMT0, 0x0f00), INTCS_VECT(TSIF0, 0x0f20), | |
79 | INTCS_VECT(CMT2, 0x0f40), INTCS_VECT(LMB, 0x0f60), | |
80 | INTCS_VECT(MSUG, 0x0f80), | |
81 | INTCS_VECT(MSU_MSU, 0x0fa0), INTCS_VECT(MSU_MSU2, 0x0fc0), | |
82 | INTCS_VECT(CTI, 0x0400), INTCS_VECT(RWDT0, 0x0440), | |
83 | INTCS_VECT(ICB, 0x0480), INTCS_VECT(PEP, 0x04a0), | |
84 | INTCS_VECT(ASA, 0x04c0), INTCS_VECT(JPU_JPEG, 0x0560), | |
85 | INTCS_VECT(LCDC, 0x0580), INTCS_VECT(LCRC, 0x05a0), | |
86 | INTCS_VECT(RTDMAC_2_DEI6, 0x1300), INTCS_VECT(RTDMAC_2_DEI7, 0x1320), | |
87 | INTCS_VECT(RTDMAC_2_DEI8, 0x1340), INTCS_VECT(RTDMAC_2_DEI9, 0x1360), | |
88 | INTCS_VECT(RTDMAC_3_DEI10, 0x1380), INTCS_VECT(RTDMAC_3_DEI11, 0x13a0), | |
89 | INTCS_VECT(FRC, 0x1700), INTCS_VECT(GCU, 0x1760), | |
90 | INTCS_VECT(LCDC1, 0x1780), INTCS_VECT(CSIRX, 0x17a0), | |
91 | INTCS_VECT(DSITX0_DSITX00, 0x17c0), INTCS_VECT(DSITX0_DSITX01, 0x17e0), | |
92 | INTCS_VECT(SPU2_SPU0, 0x1800), INTCS_VECT(SPU2_SPU1, 0x1820), | |
93 | INTCS_VECT(FSI, 0x1840), | |
94 | INTCS_VECT(TMU1_TUNI10, 0x1900), INTCS_VECT(TMU1_TUNI11, 0x1920), | |
95 | INTCS_VECT(TMU1_TUNI12, 0x1940), | |
96 | INTCS_VECT(TSIF2, 0x1960), INTCS_VECT(CMT4, 0x1980), | |
97 | INTCS_VECT(MFIS2, 0x1a00), INTCS_VECT(CPORTS2R, 0x1a20), | |
98 | INTCS_VECT(TSG, 0x1ae0), INTCS_VECT(DMASCH1, 0x1b00), | |
99 | INTCS_VECT(SCUW, 0x1b40), | |
100 | INTCS_VECT(VIO60, 0x1b60), INTCS_VECT(VIO61, 0x1b80), | |
101 | INTCS_VECT(CEU21, 0x1ba0), INTCS_VECT(CSI21, 0x1be0), | |
102 | INTCS_VECT(DSITX1_DSITX10, 0x1c00), INTCS_VECT(DSITX1_DSITX11, 0x1c20), | |
103 | INTCS_VECT(DISP, 0x1c40), INTCS_VECT(DSRV, 0x1c60), | |
104 | INTCS_VECT(EMUX2_EMUX20I, 0x1c80), INTCS_VECT(EMUX2_EMUX21I, 0x1ca0), | |
105 | INTCS_VECT(MSTIF0_MST00I, 0x1cc0), INTCS_VECT(MSTIF0_MST01I, 0x1ce0), | |
106 | INTCS_VECT(MSTIF1_MST10I, 0x1d00), INTCS_VECT(MSTIF1_MST11I, 0x1d20), | |
107 | INTCS_VECT(SPUV, 0x2300), | |
108 | }; | |
109 | ||
110 | static struct intc_group intcs_groups[] __initdata = { | |
111 | INTC_GROUP(RTDMAC_0, RTDMAC_0_DEI0, RTDMAC_0_DEI1, | |
112 | RTDMAC_0_DEI2, RTDMAC_0_DEI3), | |
113 | INTC_GROUP(RTDMAC_1, RTDMAC_1_DEI4, RTDMAC_1_DEI5, RTDMAC_1_DADERR), | |
114 | INTC_GROUP(RTDMAC_2, RTDMAC_2_DEI6, RTDMAC_2_DEI7, | |
115 | RTDMAC_2_DEI8, RTDMAC_2_DEI9), | |
116 | INTC_GROUP(RTDMAC_3, RTDMAC_3_DEI10, RTDMAC_3_DEI11), | |
117 | INTC_GROUP(TMU1, TMU1_TUNI12, TMU1_TUNI11, TMU1_TUNI10), | |
118 | INTC_GROUP(DSITX0, DSITX0_DSITX00, DSITX0_DSITX01), | |
119 | INTC_GROUP(SPU2, SPU2_SPU0, SPU2_SPU1), | |
120 | INTC_GROUP(MSU, MSU_MSU, MSU_MSU2), | |
121 | }; | |
122 | ||
123 | static struct intc_mask_reg intcs_mask_registers[] = { | |
124 | { 0xffd20184, 0xffd201c4, 8, /* IMR1SA / IMCR1SA */ | |
125 | { 0, 0, 0, CEU, | |
126 | 0, 0, 0, 0 } }, | |
127 | { 0xffd20188, 0xffd201c8, 8, /* IMR2SA / IMCR2SA */ | |
128 | { 0, 0, 0, VPU, | |
129 | BBIF2, 0, 0, MFI } }, | |
130 | { 0xffd2018c, 0xffd201cc, 8, /* IMR3SA / IMCR3SA */ | |
131 | { 0, 0, 0, _2DDMAC_2DDM0, | |
132 | 0, ASA, PEP, ICB } }, | |
133 | { 0xffd20190, 0xffd201d0, 8, /* IMR4SA / IMCR4SA */ | |
134 | { 0, 0, 0, CTI, | |
135 | JPU_JPEG, 0, LCRC, LCDC } }, | |
136 | { 0xffd20194, 0xffd201d4, 8, /* IMR5SA / IMCR5SA */ | |
137 | { KEYSC_KEY, RTDMAC_1_DADERR, RTDMAC_1_DEI5, RTDMAC_1_DEI4, | |
138 | RTDMAC_0_DEI3, RTDMAC_0_DEI2, RTDMAC_0_DEI1, RTDMAC_0_DEI0 } }, | |
139 | { 0xffd20198, 0xffd201d8, 8, /* IMR6SA / IMCR6SA */ | |
140 | { 0, 0, MSIOF, 0, | |
141 | _3DG_SGX543, 0, 0, 0 } }, | |
142 | { 0xffd2019c, 0xffd201dc, 8, /* IMR7SA / IMCR7SA */ | |
143 | { 0, TMU0_TUNI02, TMU0_TUNI01, TMU0_TUNI00, | |
144 | 0, 0, 0, 0 } }, | |
145 | { 0xffd201a0, 0xffd201e0, 8, /* IMR8SA / IMCR8SA */ | |
146 | { 0, 0, 0, 0, | |
147 | 0, MSU_MSU, MSU_MSU2, MSUG } }, | |
148 | { 0xffd201a4, 0xffd201e4, 8, /* IMR9SA / IMCR9SA */ | |
149 | { 0, RWDT0, CMT2, CMT0, | |
150 | 0, 0, 0, 0 } }, | |
151 | { 0xffd201ac, 0xffd201ec, 8, /* IMR11SA / IMCR11SA */ | |
152 | { 0, 0, 0, 0, | |
153 | 0, TSIF1, LMB, TSIF0 } }, | |
154 | { 0xffd201b0, 0xffd201f0, 8, /* IMR12SA / IMCR12SA */ | |
155 | { 0, 0, 0, 0, | |
156 | 0, 0, PINTCS_PINT2, PINTCS_PINT1 } }, | |
157 | { 0xffd50180, 0xffd501c0, 8, /* IMR0SA3 / IMCR0SA3 */ | |
158 | { RTDMAC_2_DEI6, RTDMAC_2_DEI7, RTDMAC_2_DEI8, RTDMAC_2_DEI9, | |
159 | RTDMAC_3_DEI10, RTDMAC_3_DEI11, 0, 0 } }, | |
160 | { 0xffd50190, 0xffd501d0, 8, /* IMR4SA3 / IMCR4SA3 */ | |
161 | { FRC, 0, 0, GCU, | |
162 | LCDC1, CSIRX, DSITX0_DSITX00, DSITX0_DSITX01 } }, | |
163 | { 0xffd50194, 0xffd501d4, 8, /* IMR5SA3 / IMCR5SA3 */ | |
164 | { SPU2_SPU0, SPU2_SPU1, FSI, 0, | |
165 | 0, 0, 0, 0 } }, | |
166 | { 0xffd50198, 0xffd501d8, 8, /* IMR6SA3 / IMCR6SA3 */ | |
167 | { TMU1_TUNI10, TMU1_TUNI11, TMU1_TUNI12, 0, | |
168 | TSIF2, CMT4, 0, 0 } }, | |
169 | { 0xffd5019c, 0xffd501dc, 8, /* IMR7SA3 / IMCR7SA3 */ | |
170 | { MFIS2, CPORTS2R, 0, 0, | |
171 | 0, 0, 0, TSG } }, | |
172 | { 0xffd501a0, 0xffd501e0, 8, /* IMR8SA3 / IMCR8SA3 */ | |
173 | { DMASCH1, 0, SCUW, VIO60, | |
174 | VIO61, CEU21, 0, CSI21 } }, | |
175 | { 0xffd501a4, 0xffd501e4, 8, /* IMR9SA3 / IMCR9SA3 */ | |
176 | { DSITX1_DSITX10, DSITX1_DSITX11, DISP, DSRV, | |
177 | EMUX2_EMUX20I, EMUX2_EMUX21I, MSTIF0_MST00I, MSTIF0_MST01I } }, | |
178 | { 0xffd501a8, 0xffd501e8, 8, /* IMR10SA3 / IMCR10SA3 */ | |
179 | { MSTIF0_MST00I, MSTIF0_MST01I, 0, 0, | |
180 | 0, 0, 0, 0 } }, | |
181 | { 0xffd60180, 0xffd601c0, 8, /* IMR0SA4 / IMCR0SA4 */ | |
182 | { SPUV, 0, 0, 0, | |
183 | 0, 0, 0, 0 } }, | |
184 | }; | |
185 | ||
186 | /* Priority is needed for INTCA to receive the INTCS interrupt */ | |
187 | static struct intc_prio_reg intcs_prio_registers[] = { | |
188 | { 0xffd20000, 0, 16, 4, /* IPRAS */ { CTI, 0, _2DDMAC_2DDM0, ICB } }, | |
189 | { 0xffd20004, 0, 16, 4, /* IPRBS */ { JPU_JPEG, LCDC, 0, LCRC } }, | |
190 | { 0xffd20008, 0, 16, 4, /* IPRCS */ { BBIF2, 0, 0, 0 } }, | |
191 | { 0xffd2000c, 0, 16, 4, /* IPRDS */ { PINTCS_PINT1, PINTCS_PINT2, | |
192 | 0, 0 } }, | |
193 | { 0xffd20010, 0, 16, 4, /* IPRES */ { RTDMAC_0, CEU, MFI, VPU } }, | |
194 | { 0xffd20014, 0, 16, 4, /* IPRFS */ { KEYSC_KEY, RTDMAC_1, | |
195 | CMT2, CMT0 } }, | |
196 | { 0xffd20018, 0, 16, 4, /* IPRGS */ { TMU0_TUNI00, TMU0_TUNI01, | |
197 | TMU0_TUNI02, TSIF1 } }, | |
198 | { 0xffd2001c, 0, 16, 4, /* IPRHS */ { VINT, 0, 0, 0 } }, | |
199 | { 0xffd20020, 0, 16, 4, /* IPRIS */ { 0, MSIOF, TSIF0, 0 } }, | |
200 | { 0xffd20024, 0, 16, 4, /* IPRJS */ { 0, _3DG_SGX543, MSUG, MSU } }, | |
201 | { 0xffd20028, 0, 16, 4, /* IPRKS */ { 0, ASA, LMB, PEP } }, | |
202 | { 0xffd20030, 0, 16, 4, /* IPRMS */ { 0, 0, 0, RWDT0 } }, | |
203 | { 0xffd50000, 0, 16, 4, /* IPRAS3 */ { RTDMAC_2, 0, 0, 0 } }, | |
204 | { 0xffd50004, 0, 16, 4, /* IPRBS3 */ { RTDMAC_3, 0, 0, 0 } }, | |
205 | { 0xffd50020, 0, 16, 4, /* IPRIS3 */ { FRC, 0, 0, 0 } }, | |
206 | { 0xffd50024, 0, 16, 4, /* IPRJS3 */ { LCDC1, CSIRX, DSITX0, 0 } }, | |
207 | { 0xffd50028, 0, 16, 4, /* IPRKS3 */ { SPU2, 0, FSI, 0 } }, | |
208 | { 0xffd50030, 0, 16, 4, /* IPRMS3 */ { TMU1, 0, 0, TSIF2 } }, | |
209 | { 0xffd50034, 0, 16, 4, /* IPRNS3 */ { CMT4, 0, 0, 0 } }, | |
210 | { 0xffd50038, 0, 16, 4, /* IPROS3 */ { MFIS2, CPORTS2R, 0, 0 } }, | |
211 | { 0xffd50040, 0, 16, 4, /* IPRQS3 */ { DMASCH1, 0, SCUW, VIO60 } }, | |
212 | { 0xffd50044, 0, 16, 4, /* IPRRS3 */ { VIO61, CEU21, 0, CSI21 } }, | |
213 | { 0xffd50048, 0, 16, 4, /* IPRSS3 */ { DSITX1_DSITX10, DSITX1_DSITX11, | |
214 | DISP, DSRV } }, | |
215 | { 0xffd5004c, 0, 16, 4, /* IPRTS3 */ { EMUX2_EMUX20I, EMUX2_EMUX21I, | |
216 | MSTIF0_MST00I, MSTIF0_MST01I } }, | |
217 | { 0xffd50050, 0, 16, 4, /* IPRUS3 */ { MSTIF1_MST10I, MSTIF1_MST11I, | |
218 | 0, 0 } }, | |
219 | { 0xffd60000, 0, 16, 4, /* IPRAS4 */ { SPUV, 0, 0, 0 } }, | |
220 | }; | |
221 | ||
222 | static struct resource intcs_resources[] __initdata = { | |
223 | [0] = { | |
224 | .start = 0xffd20000, | |
225 | .end = 0xffd201ff, | |
226 | .flags = IORESOURCE_MEM, | |
227 | }, | |
228 | [1] = { | |
229 | .start = 0xffd50000, | |
230 | .end = 0xffd501ff, | |
231 | .flags = IORESOURCE_MEM, | |
232 | }, | |
233 | [2] = { | |
234 | .start = 0xffd60000, | |
235 | .end = 0xffd601ff, | |
236 | .flags = IORESOURCE_MEM, | |
237 | } | |
238 | }; | |
239 | ||
240 | static struct intc_desc intcs_desc __initdata = { | |
241 | .name = "sh73a0-intcs", | |
242 | .resource = intcs_resources, | |
243 | .num_resources = ARRAY_SIZE(intcs_resources), | |
244 | .hw = INTC_HW_DESC(intcs_vectors, intcs_groups, intcs_mask_registers, | |
245 | intcs_prio_registers, NULL, NULL), | |
246 | }; | |
247 | ||
248 | static struct irqaction sh73a0_intcs_cascade; | |
249 | ||
250 | static irqreturn_t sh73a0_intcs_demux(int irq, void *dev_id) | |
251 | { | |
252 | unsigned int evtcodeas = ioread32((void __iomem *)dev_id); | |
253 | ||
254 | generic_handle_irq(intcs_evt2irq(evtcodeas)); | |
255 | ||
256 | return IRQ_HANDLED; | |
257 | } | |
258 | ||
485b2ab5 MD |
259 | static int sh73a0_set_wake(struct irq_data *data, unsigned int on) |
260 | { | |
261 | return 0; /* always allow wakeup */ | |
262 | } | |
263 | ||
0a4b04dc AB |
264 | #define PINTER0_PHYS 0xe69000a0 |
265 | #define PINTER1_PHYS 0xe69000a4 | |
266 | #define PINTER0_VIRT IOMEM(0xe69000a0) | |
267 | #define PINTER1_VIRT IOMEM(0xe69000a4) | |
268 | #define PINTRR0 IOMEM(0xe69000d0) | |
269 | #define PINTRR1 IOMEM(0xe69000d4) | |
566aad39 MD |
270 | |
271 | #define PINT0A_IRQ(n, irq) INTC_IRQ((n), SH73A0_PINT0_IRQ(irq)) | |
272 | #define PINT0B_IRQ(n, irq) INTC_IRQ((n), SH73A0_PINT0_IRQ(irq + 8)) | |
273 | #define PINT0C_IRQ(n, irq) INTC_IRQ((n), SH73A0_PINT0_IRQ(irq + 16)) | |
274 | #define PINT0D_IRQ(n, irq) INTC_IRQ((n), SH73A0_PINT0_IRQ(irq + 24)) | |
275 | #define PINT1E_IRQ(n, irq) INTC_IRQ((n), SH73A0_PINT1_IRQ(irq)) | |
276 | ||
0a4b04dc | 277 | INTC_PINT(intc_pint0, PINTER0_PHYS, 0xe69000b0, "sh73a0-pint0", \ |
566aad39 MD |
278 | INTC_PINT_E(A), INTC_PINT_E(B), INTC_PINT_E(C), INTC_PINT_E(D), \ |
279 | INTC_PINT_V(A, PINT0A_IRQ), INTC_PINT_V(B, PINT0B_IRQ), \ | |
280 | INTC_PINT_V(C, PINT0C_IRQ), INTC_PINT_V(D, PINT0D_IRQ), \ | |
281 | INTC_PINT_E(A), INTC_PINT_E(B), INTC_PINT_E(C), INTC_PINT_E(D), \ | |
282 | INTC_PINT_E(A), INTC_PINT_E(B), INTC_PINT_E(C), INTC_PINT_E(D)); | |
283 | ||
0a4b04dc | 284 | INTC_PINT(intc_pint1, PINTER1_PHYS, 0xe69000c0, "sh73a0-pint1", \ |
566aad39 MD |
285 | INTC_PINT_E(E), INTC_PINT_E_EMPTY, INTC_PINT_E_EMPTY, INTC_PINT_E_EMPTY, \ |
286 | INTC_PINT_V(E, PINT1E_IRQ), INTC_PINT_V_NONE, \ | |
287 | INTC_PINT_V_NONE, INTC_PINT_V_NONE, \ | |
288 | INTC_PINT_E_NONE, INTC_PINT_E_NONE, INTC_PINT_E_NONE, INTC_PINT_E(E), \ | |
289 | INTC_PINT_E(E), INTC_PINT_E_NONE, INTC_PINT_E_NONE, INTC_PINT_E_NONE); | |
290 | ||
291 | static struct irqaction sh73a0_pint0_cascade; | |
292 | static struct irqaction sh73a0_pint1_cascade; | |
293 | ||
0a4b04dc | 294 | static void pint_demux(void __iomem *rr, void __iomem *er, int base_irq) |
566aad39 MD |
295 | { |
296 | unsigned long value = ioread32(rr) & ioread32(er); | |
297 | int k; | |
298 | ||
299 | for (k = 0; k < 32; k++) { | |
300 | if (value & (1 << (31 - k))) { | |
301 | generic_handle_irq(base_irq + k); | |
302 | iowrite32(~(1 << (31 - k)), rr); | |
303 | } | |
304 | } | |
305 | } | |
306 | ||
307 | static irqreturn_t sh73a0_pint0_demux(int irq, void *dev_id) | |
308 | { | |
0a4b04dc | 309 | pint_demux(PINTRR0, PINTER0_VIRT, SH73A0_PINT0_IRQ(0)); |
566aad39 MD |
310 | return IRQ_HANDLED; |
311 | } | |
312 | ||
313 | static irqreturn_t sh73a0_pint1_demux(int irq, void *dev_id) | |
314 | { | |
0a4b04dc | 315 | pint_demux(PINTRR1, PINTER1_VIRT, SH73A0_PINT1_IRQ(0)); |
566aad39 MD |
316 | return IRQ_HANDLED; |
317 | } | |
318 | ||
5f53a56a MD |
319 | void __init sh73a0_init_irq(void) |
320 | { | |
a2a47ca3 RH |
321 | void __iomem *gic_dist_base = IOMEM(0xf0001000); |
322 | void __iomem *gic_cpu_base = IOMEM(0xf0000100); | |
5f53a56a MD |
323 | void __iomem *intevtsa = ioremap_nocache(0xffd20100, PAGE_SIZE); |
324 | ||
bd1689cd | 325 | gic_init(0, 29, gic_dist_base, gic_cpu_base); |
485b2ab5 | 326 | gic_arch_extn.irq_set_wake = sh73a0_set_wake; |
5f53a56a MD |
327 | |
328 | register_intc_controller(&intcs_desc); | |
566aad39 MD |
329 | register_intc_controller(&intc_pint0_desc); |
330 | register_intc_controller(&intc_pint1_desc); | |
5f53a56a MD |
331 | |
332 | /* demux using INTEVTSA */ | |
333 | sh73a0_intcs_cascade.name = "INTCS cascade"; | |
334 | sh73a0_intcs_cascade.handler = sh73a0_intcs_demux; | |
335 | sh73a0_intcs_cascade.dev_id = intevtsa; | |
336 | setup_irq(gic_spi(50), &sh73a0_intcs_cascade); | |
a1993055 | 337 | |
566aad39 MD |
338 | /* PINT pins are sanely tied to the GIC as SPI */ |
339 | sh73a0_pint0_cascade.name = "PINT0 cascade"; | |
340 | sh73a0_pint0_cascade.handler = sh73a0_pint0_demux; | |
341 | setup_irq(gic_spi(33), &sh73a0_pint0_cascade); | |
342 | ||
343 | sh73a0_pint1_cascade.name = "PINT1 cascade"; | |
344 | sh73a0_pint1_cascade.handler = sh73a0_pint1_demux; | |
345 | setup_irq(gic_spi(34), &sh73a0_pint1_cascade); | |
5f53a56a | 346 | } |