]>
Commit | Line | Data |
---|---|---|
1da177e4 LT |
1 | /* |
2 | * icu.c, Interrupt Control Unit routines for the NEC VR4100 series. | |
3 | * | |
4 | * Copyright (C) 2001-2002 MontaVista Software Inc. | |
ada8e951 YY |
5 | * Author: Yoichi Yuasa <source@mvista.com> |
6 | * Copyright (C) 2003-2006 Yoichi Yuasa <yuasa@linux-mips.org> | |
1da177e4 LT |
7 | * |
8 | * This program is free software; you can redistribute it and/or modify | |
9 | * it under the terms of the GNU General Public License as published by | |
10 | * the Free Software Foundation; either version 2 of the License, or | |
11 | * (at your option) any later version. | |
12 | * | |
13 | * This program is distributed in the hope that it will be useful, | |
14 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | |
15 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
16 | * GNU General Public License for more details. | |
17 | * | |
18 | * You should have received a copy of the GNU General Public License | |
19 | * along with this program; if not, write to the Free Software | |
20 | * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA | |
21 | */ | |
22 | /* | |
23 | * Changes: | |
ada8e951 | 24 | * MontaVista Software Inc. <source@mvista.com> |
1da177e4 LT |
25 | * - New creation, NEC VR4122 and VR4131 are supported. |
26 | * - Added support for NEC VR4111 and VR4121. | |
27 | * | |
ada8e951 | 28 | * Yoichi Yuasa <yuasa@linux-mips.org> |
1da177e4 LT |
29 | * - Coped with INTASSIGN of NEC VR4133. |
30 | */ | |
31 | #include <linux/errno.h> | |
26dd3e4f | 32 | #include <linux/export.h> |
1da177e4 | 33 | #include <linux/init.h> |
979934da | 34 | #include <linux/ioport.h> |
1da177e4 | 35 | #include <linux/irq.h> |
1da177e4 LT |
36 | #include <linux/smp.h> |
37 | #include <linux/types.h> | |
38 | ||
39 | #include <asm/cpu.h> | |
40 | #include <asm/io.h> | |
66151bbd | 41 | #include <asm/vr41xx/irq.h> |
1da177e4 LT |
42 | #include <asm/vr41xx/vr41xx.h> |
43 | ||
979934da YY |
44 | static void __iomem *icu1_base; |
45 | static void __iomem *icu2_base; | |
1da177e4 LT |
46 | |
47 | static unsigned char sysint1_assign[16] = { | |
48 | 0, 0, 1, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0 }; | |
49 | static unsigned char sysint2_assign[16] = { | |
979934da | 50 | 2, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0 }; |
1da177e4 | 51 | |
70342287 RB |
52 | #define ICU1_TYPE1_BASE 0x0b000080UL |
53 | #define ICU2_TYPE1_BASE 0x0b000200UL | |
1da177e4 | 54 | |
70342287 RB |
55 | #define ICU1_TYPE2_BASE 0x0f000080UL |
56 | #define ICU2_TYPE2_BASE 0x0f0000a0UL | |
979934da YY |
57 | |
58 | #define ICU1_SIZE 0x20 | |
59 | #define ICU2_SIZE 0x1c | |
1da177e4 LT |
60 | |
61 | #define SYSINT1REG 0x00 | |
62 | #define PIUINTREG 0x02 | |
63 | #define INTASSIGN0 0x04 | |
64 | #define INTASSIGN1 0x06 | |
65 | #define GIUINTLREG 0x08 | |
66 | #define DSIUINTREG 0x0a | |
67 | #define MSYSINT1REG 0x0c | |
68 | #define MPIUINTREG 0x0e | |
69 | #define MAIUINTREG 0x10 | |
70 | #define MKIUINTREG 0x12 | |
9a0ad9e9 | 71 | #define MMACINTREG 0x12 |
1da177e4 LT |
72 | #define MGIUINTLREG 0x14 |
73 | #define MDSIUINTREG 0x16 | |
74 | #define NMIREG 0x18 | |
75 | #define SOFTREG 0x1a | |
76 | #define INTASSIGN2 0x1c | |
77 | #define INTASSIGN3 0x1e | |
78 | ||
79 | #define SYSINT2REG 0x00 | |
80 | #define GIUINTHREG 0x02 | |
81 | #define FIRINTREG 0x04 | |
82 | #define MSYSINT2REG 0x06 | |
83 | #define MGIUINTHREG 0x08 | |
84 | #define MFIRINTREG 0x0a | |
85 | #define PCIINTREG 0x0c | |
86 | #define PCIINT0 0x0001 | |
87 | #define SCUINTREG 0x0e | |
88 | #define SCUINT0 0x0001 | |
89 | #define CSIINTREG 0x10 | |
90 | #define MPCIINTREG 0x12 | |
91 | #define MSCUINTREG 0x14 | |
92 | #define MCSIINTREG 0x16 | |
93 | #define BCUINTREG 0x18 | |
94 | #define BCUINTR 0x0001 | |
95 | #define MBCUINTREG 0x1a | |
96 | ||
97 | #define SYSINT1_IRQ_TO_PIN(x) ((x) - SYSINT1_IRQ_BASE) /* Pin 0-15 */ | |
98 | #define SYSINT2_IRQ_TO_PIN(x) ((x) - SYSINT2_IRQ_BASE) /* Pin 0-15 */ | |
99 | ||
979934da YY |
100 | #define INT_TO_IRQ(x) ((x) + 2) /* Int0-4 -> IRQ2-6 */ |
101 | ||
102 | #define icu1_read(offset) readw(icu1_base + (offset)) | |
103 | #define icu1_write(offset, value) writew((value), icu1_base + (offset)) | |
1da177e4 | 104 | |
979934da YY |
105 | #define icu2_read(offset) readw(icu2_base + (offset)) |
106 | #define icu2_write(offset, value) writew((value), icu2_base + (offset)) | |
1da177e4 LT |
107 | |
108 | #define INTASSIGN_MAX 4 | |
109 | #define INTASSIGN_MASK 0x0007 | |
110 | ||
979934da | 111 | static inline uint16_t icu1_set(uint8_t offset, uint16_t set) |
1da177e4 | 112 | { |
979934da | 113 | uint16_t data; |
1da177e4 | 114 | |
979934da YY |
115 | data = icu1_read(offset); |
116 | data |= set; | |
117 | icu1_write(offset, data); | |
1da177e4 | 118 | |
979934da | 119 | return data; |
1da177e4 LT |
120 | } |
121 | ||
979934da | 122 | static inline uint16_t icu1_clear(uint8_t offset, uint16_t clear) |
1da177e4 | 123 | { |
979934da | 124 | uint16_t data; |
1da177e4 | 125 | |
979934da YY |
126 | data = icu1_read(offset); |
127 | data &= ~clear; | |
128 | icu1_write(offset, data); | |
1da177e4 | 129 | |
979934da | 130 | return data; |
1da177e4 LT |
131 | } |
132 | ||
979934da | 133 | static inline uint16_t icu2_set(uint8_t offset, uint16_t set) |
1da177e4 | 134 | { |
979934da | 135 | uint16_t data; |
1da177e4 | 136 | |
979934da YY |
137 | data = icu2_read(offset); |
138 | data |= set; | |
139 | icu2_write(offset, data); | |
1da177e4 | 140 | |
979934da | 141 | return data; |
1da177e4 LT |
142 | } |
143 | ||
979934da | 144 | static inline uint16_t icu2_clear(uint8_t offset, uint16_t clear) |
1da177e4 | 145 | { |
979934da | 146 | uint16_t data; |
1da177e4 | 147 | |
979934da YY |
148 | data = icu2_read(offset); |
149 | data &= ~clear; | |
150 | icu2_write(offset, data); | |
1da177e4 | 151 | |
979934da | 152 | return data; |
1da177e4 LT |
153 | } |
154 | ||
1da177e4 LT |
155 | void vr41xx_enable_piuint(uint16_t mask) |
156 | { | |
fbaa4e2a | 157 | struct irq_desc *desc = irq_to_desc(PIU_IRQ); |
1da177e4 LT |
158 | unsigned long flags; |
159 | ||
10cc3529 RB |
160 | if (current_cpu_type() == CPU_VR4111 || |
161 | current_cpu_type() == CPU_VR4121) { | |
239007b8 | 162 | raw_spin_lock_irqsave(&desc->lock, flags); |
979934da | 163 | icu1_set(MPIUINTREG, mask); |
239007b8 | 164 | raw_spin_unlock_irqrestore(&desc->lock, flags); |
1da177e4 LT |
165 | } |
166 | } | |
167 | ||
168 | EXPORT_SYMBOL(vr41xx_enable_piuint); | |
169 | ||
170 | void vr41xx_disable_piuint(uint16_t mask) | |
171 | { | |
fbaa4e2a | 172 | struct irq_desc *desc = irq_to_desc(PIU_IRQ); |
1da177e4 LT |
173 | unsigned long flags; |
174 | ||
10cc3529 RB |
175 | if (current_cpu_type() == CPU_VR4111 || |
176 | current_cpu_type() == CPU_VR4121) { | |
239007b8 | 177 | raw_spin_lock_irqsave(&desc->lock, flags); |
979934da | 178 | icu1_clear(MPIUINTREG, mask); |
239007b8 | 179 | raw_spin_unlock_irqrestore(&desc->lock, flags); |
1da177e4 LT |
180 | } |
181 | } | |
182 | ||
183 | EXPORT_SYMBOL(vr41xx_disable_piuint); | |
184 | ||
185 | void vr41xx_enable_aiuint(uint16_t mask) | |
186 | { | |
fbaa4e2a | 187 | struct irq_desc *desc = irq_to_desc(AIU_IRQ); |
1da177e4 LT |
188 | unsigned long flags; |
189 | ||
10cc3529 RB |
190 | if (current_cpu_type() == CPU_VR4111 || |
191 | current_cpu_type() == CPU_VR4121) { | |
239007b8 | 192 | raw_spin_lock_irqsave(&desc->lock, flags); |
979934da | 193 | icu1_set(MAIUINTREG, mask); |
239007b8 | 194 | raw_spin_unlock_irqrestore(&desc->lock, flags); |
1da177e4 LT |
195 | } |
196 | } | |
197 | ||
198 | EXPORT_SYMBOL(vr41xx_enable_aiuint); | |
199 | ||
200 | void vr41xx_disable_aiuint(uint16_t mask) | |
201 | { | |
fbaa4e2a | 202 | struct irq_desc *desc = irq_to_desc(AIU_IRQ); |
1da177e4 LT |
203 | unsigned long flags; |
204 | ||
10cc3529 RB |
205 | if (current_cpu_type() == CPU_VR4111 || |
206 | current_cpu_type() == CPU_VR4121) { | |
239007b8 | 207 | raw_spin_lock_irqsave(&desc->lock, flags); |
979934da | 208 | icu1_clear(MAIUINTREG, mask); |
239007b8 | 209 | raw_spin_unlock_irqrestore(&desc->lock, flags); |
1da177e4 LT |
210 | } |
211 | } | |
212 | ||
213 | EXPORT_SYMBOL(vr41xx_disable_aiuint); | |
214 | ||
215 | void vr41xx_enable_kiuint(uint16_t mask) | |
216 | { | |
fbaa4e2a | 217 | struct irq_desc *desc = irq_to_desc(KIU_IRQ); |
1da177e4 LT |
218 | unsigned long flags; |
219 | ||
10cc3529 RB |
220 | if (current_cpu_type() == CPU_VR4111 || |
221 | current_cpu_type() == CPU_VR4121) { | |
239007b8 | 222 | raw_spin_lock_irqsave(&desc->lock, flags); |
979934da | 223 | icu1_set(MKIUINTREG, mask); |
239007b8 | 224 | raw_spin_unlock_irqrestore(&desc->lock, flags); |
1da177e4 LT |
225 | } |
226 | } | |
227 | ||
228 | EXPORT_SYMBOL(vr41xx_enable_kiuint); | |
229 | ||
230 | void vr41xx_disable_kiuint(uint16_t mask) | |
231 | { | |
fbaa4e2a | 232 | struct irq_desc *desc = irq_to_desc(KIU_IRQ); |
1da177e4 LT |
233 | unsigned long flags; |
234 | ||
10cc3529 RB |
235 | if (current_cpu_type() == CPU_VR4111 || |
236 | current_cpu_type() == CPU_VR4121) { | |
239007b8 | 237 | raw_spin_lock_irqsave(&desc->lock, flags); |
979934da | 238 | icu1_clear(MKIUINTREG, mask); |
239007b8 | 239 | raw_spin_unlock_irqrestore(&desc->lock, flags); |
1da177e4 LT |
240 | } |
241 | } | |
242 | ||
243 | EXPORT_SYMBOL(vr41xx_disable_kiuint); | |
244 | ||
9a0ad9e9 YY |
245 | void vr41xx_enable_macint(uint16_t mask) |
246 | { | |
fbaa4e2a | 247 | struct irq_desc *desc = irq_to_desc(ETHERNET_IRQ); |
9a0ad9e9 YY |
248 | unsigned long flags; |
249 | ||
239007b8 | 250 | raw_spin_lock_irqsave(&desc->lock, flags); |
9a0ad9e9 | 251 | icu1_set(MMACINTREG, mask); |
239007b8 | 252 | raw_spin_unlock_irqrestore(&desc->lock, flags); |
9a0ad9e9 YY |
253 | } |
254 | ||
255 | EXPORT_SYMBOL(vr41xx_enable_macint); | |
256 | ||
257 | void vr41xx_disable_macint(uint16_t mask) | |
258 | { | |
fbaa4e2a | 259 | struct irq_desc *desc = irq_to_desc(ETHERNET_IRQ); |
9a0ad9e9 YY |
260 | unsigned long flags; |
261 | ||
239007b8 | 262 | raw_spin_lock_irqsave(&desc->lock, flags); |
9a0ad9e9 | 263 | icu1_clear(MMACINTREG, mask); |
239007b8 | 264 | raw_spin_unlock_irqrestore(&desc->lock, flags); |
9a0ad9e9 YY |
265 | } |
266 | ||
267 | EXPORT_SYMBOL(vr41xx_disable_macint); | |
268 | ||
1da177e4 LT |
269 | void vr41xx_enable_dsiuint(uint16_t mask) |
270 | { | |
fbaa4e2a | 271 | struct irq_desc *desc = irq_to_desc(DSIU_IRQ); |
1da177e4 LT |
272 | unsigned long flags; |
273 | ||
239007b8 | 274 | raw_spin_lock_irqsave(&desc->lock, flags); |
979934da | 275 | icu1_set(MDSIUINTREG, mask); |
239007b8 | 276 | raw_spin_unlock_irqrestore(&desc->lock, flags); |
1da177e4 LT |
277 | } |
278 | ||
279 | EXPORT_SYMBOL(vr41xx_enable_dsiuint); | |
280 | ||
281 | void vr41xx_disable_dsiuint(uint16_t mask) | |
282 | { | |
fbaa4e2a | 283 | struct irq_desc *desc = irq_to_desc(DSIU_IRQ); |
1da177e4 LT |
284 | unsigned long flags; |
285 | ||
239007b8 | 286 | raw_spin_lock_irqsave(&desc->lock, flags); |
979934da | 287 | icu1_clear(MDSIUINTREG, mask); |
239007b8 | 288 | raw_spin_unlock_irqrestore(&desc->lock, flags); |
1da177e4 LT |
289 | } |
290 | ||
291 | EXPORT_SYMBOL(vr41xx_disable_dsiuint); | |
292 | ||
293 | void vr41xx_enable_firint(uint16_t mask) | |
294 | { | |
fbaa4e2a | 295 | struct irq_desc *desc = irq_to_desc(FIR_IRQ); |
1da177e4 LT |
296 | unsigned long flags; |
297 | ||
239007b8 | 298 | raw_spin_lock_irqsave(&desc->lock, flags); |
979934da | 299 | icu2_set(MFIRINTREG, mask); |
239007b8 | 300 | raw_spin_unlock_irqrestore(&desc->lock, flags); |
1da177e4 LT |
301 | } |
302 | ||
303 | EXPORT_SYMBOL(vr41xx_enable_firint); | |
304 | ||
305 | void vr41xx_disable_firint(uint16_t mask) | |
306 | { | |
fbaa4e2a | 307 | struct irq_desc *desc = irq_to_desc(FIR_IRQ); |
1da177e4 LT |
308 | unsigned long flags; |
309 | ||
239007b8 | 310 | raw_spin_lock_irqsave(&desc->lock, flags); |
979934da | 311 | icu2_clear(MFIRINTREG, mask); |
239007b8 | 312 | raw_spin_unlock_irqrestore(&desc->lock, flags); |
1da177e4 LT |
313 | } |
314 | ||
315 | EXPORT_SYMBOL(vr41xx_disable_firint); | |
316 | ||
317 | void vr41xx_enable_pciint(void) | |
318 | { | |
fbaa4e2a | 319 | struct irq_desc *desc = irq_to_desc(PCI_IRQ); |
1da177e4 LT |
320 | unsigned long flags; |
321 | ||
10cc3529 RB |
322 | if (current_cpu_type() == CPU_VR4122 || |
323 | current_cpu_type() == CPU_VR4131 || | |
324 | current_cpu_type() == CPU_VR4133) { | |
239007b8 | 325 | raw_spin_lock_irqsave(&desc->lock, flags); |
979934da | 326 | icu2_write(MPCIINTREG, PCIINT0); |
239007b8 | 327 | raw_spin_unlock_irqrestore(&desc->lock, flags); |
1da177e4 LT |
328 | } |
329 | } | |
330 | ||
331 | EXPORT_SYMBOL(vr41xx_enable_pciint); | |
332 | ||
333 | void vr41xx_disable_pciint(void) | |
334 | { | |
fbaa4e2a | 335 | struct irq_desc *desc = irq_to_desc(PCI_IRQ); |
1da177e4 LT |
336 | unsigned long flags; |
337 | ||
10cc3529 RB |
338 | if (current_cpu_type() == CPU_VR4122 || |
339 | current_cpu_type() == CPU_VR4131 || | |
340 | current_cpu_type() == CPU_VR4133) { | |
239007b8 | 341 | raw_spin_lock_irqsave(&desc->lock, flags); |
979934da | 342 | icu2_write(MPCIINTREG, 0); |
239007b8 | 343 | raw_spin_unlock_irqrestore(&desc->lock, flags); |
1da177e4 LT |
344 | } |
345 | } | |
346 | ||
347 | EXPORT_SYMBOL(vr41xx_disable_pciint); | |
348 | ||
349 | void vr41xx_enable_scuint(void) | |
350 | { | |
fbaa4e2a | 351 | struct irq_desc *desc = irq_to_desc(SCU_IRQ); |
1da177e4 LT |
352 | unsigned long flags; |
353 | ||
10cc3529 RB |
354 | if (current_cpu_type() == CPU_VR4122 || |
355 | current_cpu_type() == CPU_VR4131 || | |
356 | current_cpu_type() == CPU_VR4133) { | |
239007b8 | 357 | raw_spin_lock_irqsave(&desc->lock, flags); |
979934da | 358 | icu2_write(MSCUINTREG, SCUINT0); |
239007b8 | 359 | raw_spin_unlock_irqrestore(&desc->lock, flags); |
1da177e4 LT |
360 | } |
361 | } | |
362 | ||
363 | EXPORT_SYMBOL(vr41xx_enable_scuint); | |
364 | ||
365 | void vr41xx_disable_scuint(void) | |
366 | { | |
fbaa4e2a | 367 | struct irq_desc *desc = irq_to_desc(SCU_IRQ); |
1da177e4 LT |
368 | unsigned long flags; |
369 | ||
10cc3529 RB |
370 | if (current_cpu_type() == CPU_VR4122 || |
371 | current_cpu_type() == CPU_VR4131 || | |
372 | current_cpu_type() == CPU_VR4133) { | |
239007b8 | 373 | raw_spin_lock_irqsave(&desc->lock, flags); |
979934da | 374 | icu2_write(MSCUINTREG, 0); |
239007b8 | 375 | raw_spin_unlock_irqrestore(&desc->lock, flags); |
1da177e4 LT |
376 | } |
377 | } | |
378 | ||
379 | EXPORT_SYMBOL(vr41xx_disable_scuint); | |
380 | ||
381 | void vr41xx_enable_csiint(uint16_t mask) | |
382 | { | |
fbaa4e2a | 383 | struct irq_desc *desc = irq_to_desc(CSI_IRQ); |
1da177e4 LT |
384 | unsigned long flags; |
385 | ||
10cc3529 RB |
386 | if (current_cpu_type() == CPU_VR4122 || |
387 | current_cpu_type() == CPU_VR4131 || | |
388 | current_cpu_type() == CPU_VR4133) { | |
239007b8 | 389 | raw_spin_lock_irqsave(&desc->lock, flags); |
979934da | 390 | icu2_set(MCSIINTREG, mask); |
239007b8 | 391 | raw_spin_unlock_irqrestore(&desc->lock, flags); |
1da177e4 LT |
392 | } |
393 | } | |
394 | ||
395 | EXPORT_SYMBOL(vr41xx_enable_csiint); | |
396 | ||
397 | void vr41xx_disable_csiint(uint16_t mask) | |
398 | { | |
fbaa4e2a | 399 | struct irq_desc *desc = irq_to_desc(CSI_IRQ); |
1da177e4 LT |
400 | unsigned long flags; |
401 | ||
10cc3529 RB |
402 | if (current_cpu_type() == CPU_VR4122 || |
403 | current_cpu_type() == CPU_VR4131 || | |
404 | current_cpu_type() == CPU_VR4133) { | |
239007b8 | 405 | raw_spin_lock_irqsave(&desc->lock, flags); |
979934da | 406 | icu2_clear(MCSIINTREG, mask); |
239007b8 | 407 | raw_spin_unlock_irqrestore(&desc->lock, flags); |
1da177e4 LT |
408 | } |
409 | } | |
410 | ||
411 | EXPORT_SYMBOL(vr41xx_disable_csiint); | |
412 | ||
413 | void vr41xx_enable_bcuint(void) | |
414 | { | |
fbaa4e2a | 415 | struct irq_desc *desc = irq_to_desc(BCU_IRQ); |
1da177e4 LT |
416 | unsigned long flags; |
417 | ||
10cc3529 RB |
418 | if (current_cpu_type() == CPU_VR4122 || |
419 | current_cpu_type() == CPU_VR4131 || | |
420 | current_cpu_type() == CPU_VR4133) { | |
239007b8 | 421 | raw_spin_lock_irqsave(&desc->lock, flags); |
979934da | 422 | icu2_write(MBCUINTREG, BCUINTR); |
239007b8 | 423 | raw_spin_unlock_irqrestore(&desc->lock, flags); |
1da177e4 LT |
424 | } |
425 | } | |
426 | ||
427 | EXPORT_SYMBOL(vr41xx_enable_bcuint); | |
428 | ||
429 | void vr41xx_disable_bcuint(void) | |
430 | { | |
fbaa4e2a | 431 | struct irq_desc *desc = irq_to_desc(BCU_IRQ); |
1da177e4 LT |
432 | unsigned long flags; |
433 | ||
10cc3529 RB |
434 | if (current_cpu_type() == CPU_VR4122 || |
435 | current_cpu_type() == CPU_VR4131 || | |
436 | current_cpu_type() == CPU_VR4133) { | |
239007b8 | 437 | raw_spin_lock_irqsave(&desc->lock, flags); |
979934da | 438 | icu2_write(MBCUINTREG, 0); |
239007b8 | 439 | raw_spin_unlock_irqrestore(&desc->lock, flags); |
1da177e4 LT |
440 | } |
441 | } | |
442 | ||
443 | EXPORT_SYMBOL(vr41xx_disable_bcuint); | |
444 | ||
fbaa4e2a | 445 | static void disable_sysint1_irq(struct irq_data *d) |
1da177e4 | 446 | { |
fbaa4e2a | 447 | icu1_clear(MSYSINT1REG, 1 << SYSINT1_IRQ_TO_PIN(d->irq)); |
1da177e4 LT |
448 | } |
449 | ||
fbaa4e2a | 450 | static void enable_sysint1_irq(struct irq_data *d) |
1da177e4 | 451 | { |
fbaa4e2a | 452 | icu1_set(MSYSINT1REG, 1 << SYSINT1_IRQ_TO_PIN(d->irq)); |
1da177e4 LT |
453 | } |
454 | ||
94dee171 | 455 | static struct irq_chip sysint1_irq_type = { |
70d21cde | 456 | .name = "SYSINT1", |
fbaa4e2a TG |
457 | .irq_mask = disable_sysint1_irq, |
458 | .irq_unmask = enable_sysint1_irq, | |
1da177e4 LT |
459 | }; |
460 | ||
fbaa4e2a | 461 | static void disable_sysint2_irq(struct irq_data *d) |
1da177e4 | 462 | { |
fbaa4e2a | 463 | icu2_clear(MSYSINT2REG, 1 << SYSINT2_IRQ_TO_PIN(d->irq)); |
1da177e4 LT |
464 | } |
465 | ||
fbaa4e2a | 466 | static void enable_sysint2_irq(struct irq_data *d) |
1da177e4 | 467 | { |
fbaa4e2a | 468 | icu2_set(MSYSINT2REG, 1 << SYSINT2_IRQ_TO_PIN(d->irq)); |
1da177e4 LT |
469 | } |
470 | ||
94dee171 | 471 | static struct irq_chip sysint2_irq_type = { |
70d21cde | 472 | .name = "SYSINT2", |
fbaa4e2a TG |
473 | .irq_mask = disable_sysint2_irq, |
474 | .irq_unmask = enable_sysint2_irq, | |
1da177e4 LT |
475 | }; |
476 | ||
1da177e4 LT |
477 | static inline int set_sysint1_assign(unsigned int irq, unsigned char assign) |
478 | { | |
fbaa4e2a | 479 | struct irq_desc *desc = irq_to_desc(irq); |
1da177e4 LT |
480 | uint16_t intassign0, intassign1; |
481 | unsigned int pin; | |
482 | ||
483 | pin = SYSINT1_IRQ_TO_PIN(irq); | |
484 | ||
239007b8 | 485 | raw_spin_lock_irq(&desc->lock); |
1da177e4 | 486 | |
979934da YY |
487 | intassign0 = icu1_read(INTASSIGN0); |
488 | intassign1 = icu1_read(INTASSIGN1); | |
1da177e4 LT |
489 | |
490 | switch (pin) { | |
491 | case 0: | |
492 | intassign0 &= ~INTASSIGN_MASK; | |
493 | intassign0 |= (uint16_t)assign; | |
494 | break; | |
495 | case 1: | |
496 | intassign0 &= ~(INTASSIGN_MASK << 3); | |
497 | intassign0 |= (uint16_t)assign << 3; | |
498 | break; | |
499 | case 2: | |
500 | intassign0 &= ~(INTASSIGN_MASK << 6); | |
501 | intassign0 |= (uint16_t)assign << 6; | |
502 | break; | |
503 | case 3: | |
504 | intassign0 &= ~(INTASSIGN_MASK << 9); | |
505 | intassign0 |= (uint16_t)assign << 9; | |
506 | break; | |
507 | case 8: | |
508 | intassign0 &= ~(INTASSIGN_MASK << 12); | |
509 | intassign0 |= (uint16_t)assign << 12; | |
510 | break; | |
511 | case 9: | |
512 | intassign1 &= ~INTASSIGN_MASK; | |
513 | intassign1 |= (uint16_t)assign; | |
514 | break; | |
515 | case 11: | |
516 | intassign1 &= ~(INTASSIGN_MASK << 6); | |
517 | intassign1 |= (uint16_t)assign << 6; | |
518 | break; | |
519 | case 12: | |
520 | intassign1 &= ~(INTASSIGN_MASK << 9); | |
521 | intassign1 |= (uint16_t)assign << 9; | |
522 | break; | |
523 | default: | |
239007b8 | 524 | raw_spin_unlock_irq(&desc->lock); |
1da177e4 LT |
525 | return -EINVAL; |
526 | } | |
527 | ||
528 | sysint1_assign[pin] = assign; | |
979934da YY |
529 | icu1_write(INTASSIGN0, intassign0); |
530 | icu1_write(INTASSIGN1, intassign1); | |
1da177e4 | 531 | |
239007b8 | 532 | raw_spin_unlock_irq(&desc->lock); |
1da177e4 LT |
533 | |
534 | return 0; | |
535 | } | |
536 | ||
537 | static inline int set_sysint2_assign(unsigned int irq, unsigned char assign) | |
538 | { | |
fbaa4e2a | 539 | struct irq_desc *desc = irq_to_desc(irq); |
1da177e4 LT |
540 | uint16_t intassign2, intassign3; |
541 | unsigned int pin; | |
542 | ||
543 | pin = SYSINT2_IRQ_TO_PIN(irq); | |
544 | ||
239007b8 | 545 | raw_spin_lock_irq(&desc->lock); |
1da177e4 | 546 | |
979934da YY |
547 | intassign2 = icu1_read(INTASSIGN2); |
548 | intassign3 = icu1_read(INTASSIGN3); | |
1da177e4 LT |
549 | |
550 | switch (pin) { | |
551 | case 0: | |
552 | intassign2 &= ~INTASSIGN_MASK; | |
553 | intassign2 |= (uint16_t)assign; | |
554 | break; | |
555 | case 1: | |
556 | intassign2 &= ~(INTASSIGN_MASK << 3); | |
557 | intassign2 |= (uint16_t)assign << 3; | |
558 | break; | |
559 | case 3: | |
560 | intassign2 &= ~(INTASSIGN_MASK << 6); | |
561 | intassign2 |= (uint16_t)assign << 6; | |
562 | break; | |
563 | case 4: | |
564 | intassign2 &= ~(INTASSIGN_MASK << 9); | |
565 | intassign2 |= (uint16_t)assign << 9; | |
566 | break; | |
567 | case 5: | |
568 | intassign2 &= ~(INTASSIGN_MASK << 12); | |
569 | intassign2 |= (uint16_t)assign << 12; | |
570 | break; | |
571 | case 6: | |
572 | intassign3 &= ~INTASSIGN_MASK; | |
573 | intassign3 |= (uint16_t)assign; | |
574 | break; | |
575 | case 7: | |
576 | intassign3 &= ~(INTASSIGN_MASK << 3); | |
577 | intassign3 |= (uint16_t)assign << 3; | |
578 | break; | |
579 | case 8: | |
580 | intassign3 &= ~(INTASSIGN_MASK << 6); | |
581 | intassign3 |= (uint16_t)assign << 6; | |
582 | break; | |
583 | case 9: | |
584 | intassign3 &= ~(INTASSIGN_MASK << 9); | |
585 | intassign3 |= (uint16_t)assign << 9; | |
586 | break; | |
587 | case 10: | |
588 | intassign3 &= ~(INTASSIGN_MASK << 12); | |
589 | intassign3 |= (uint16_t)assign << 12; | |
590 | break; | |
591 | default: | |
239007b8 | 592 | raw_spin_unlock_irq(&desc->lock); |
1da177e4 LT |
593 | return -EINVAL; |
594 | } | |
595 | ||
596 | sysint2_assign[pin] = assign; | |
979934da YY |
597 | icu1_write(INTASSIGN2, intassign2); |
598 | icu1_write(INTASSIGN3, intassign3); | |
1da177e4 | 599 | |
239007b8 | 600 | raw_spin_unlock_irq(&desc->lock); |
1da177e4 LT |
601 | |
602 | return 0; | |
603 | } | |
604 | ||
605 | int vr41xx_set_intassign(unsigned int irq, unsigned char intassign) | |
606 | { | |
607 | int retval = -EINVAL; | |
608 | ||
10cc3529 | 609 | if (current_cpu_type() != CPU_VR4133) |
1da177e4 LT |
610 | return -EINVAL; |
611 | ||
612 | if (intassign > INTASSIGN_MAX) | |
613 | return -EINVAL; | |
614 | ||
615 | if (irq >= SYSINT1_IRQ_BASE && irq <= SYSINT1_IRQ_LAST) | |
616 | retval = set_sysint1_assign(irq, intassign); | |
617 | else if (irq >= SYSINT2_IRQ_BASE && irq <= SYSINT2_IRQ_LAST) | |
618 | retval = set_sysint2_assign(irq, intassign); | |
619 | ||
620 | return retval; | |
621 | } | |
622 | ||
623 | EXPORT_SYMBOL(vr41xx_set_intassign); | |
624 | ||
937a8015 | 625 | static int icu_get_irq(unsigned int irq) |
1da177e4 LT |
626 | { |
627 | uint16_t pend1, pend2; | |
628 | uint16_t mask1, mask2; | |
629 | int i; | |
630 | ||
979934da YY |
631 | pend1 = icu1_read(SYSINT1REG); |
632 | mask1 = icu1_read(MSYSINT1REG); | |
1da177e4 | 633 | |
979934da YY |
634 | pend2 = icu2_read(SYSINT2REG); |
635 | mask2 = icu2_read(MSYSINT2REG); | |
1da177e4 LT |
636 | |
637 | mask1 &= pend1; | |
638 | mask2 &= pend2; | |
639 | ||
640 | if (mask1) { | |
641 | for (i = 0; i < 16; i++) { | |
979934da YY |
642 | if (irq == INT_TO_IRQ(sysint1_assign[i]) && (mask1 & (1 << i))) |
643 | return SYSINT1_IRQ(i); | |
1da177e4 LT |
644 | } |
645 | } | |
646 | ||
647 | if (mask2) { | |
648 | for (i = 0; i < 16; i++) { | |
979934da YY |
649 | if (irq == INT_TO_IRQ(sysint2_assign[i]) && (mask2 & (1 << i))) |
650 | return SYSINT2_IRQ(i); | |
1da177e4 LT |
651 | } |
652 | } | |
653 | ||
654 | printk(KERN_ERR "spurious ICU interrupt: %04x,%04x\n", pend1, pend2); | |
655 | ||
656 | atomic_inc(&irq_err_count); | |
1da177e4 | 657 | |
979934da YY |
658 | return -1; |
659 | } | |
1da177e4 LT |
660 | |
661 | static int __init vr41xx_icu_init(void) | |
662 | { | |
979934da YY |
663 | unsigned long icu1_start, icu2_start; |
664 | int i; | |
665 | ||
10cc3529 | 666 | switch (current_cpu_type()) { |
1da177e4 LT |
667 | case CPU_VR4111: |
668 | case CPU_VR4121: | |
979934da YY |
669 | icu1_start = ICU1_TYPE1_BASE; |
670 | icu2_start = ICU2_TYPE1_BASE; | |
1da177e4 LT |
671 | break; |
672 | case CPU_VR4122: | |
673 | case CPU_VR4131: | |
674 | case CPU_VR4133: | |
979934da YY |
675 | icu1_start = ICU1_TYPE2_BASE; |
676 | icu2_start = ICU2_TYPE2_BASE; | |
1da177e4 LT |
677 | break; |
678 | default: | |
679 | printk(KERN_ERR "ICU: Unexpected CPU of NEC VR4100 series\n"); | |
979934da | 680 | return -ENODEV; |
1da177e4 LT |
681 | } |
682 | ||
979934da YY |
683 | if (request_mem_region(icu1_start, ICU1_SIZE, "ICU") == NULL) |
684 | return -EBUSY; | |
1da177e4 | 685 | |
979934da YY |
686 | if (request_mem_region(icu2_start, ICU2_SIZE, "ICU") == NULL) { |
687 | release_mem_region(icu1_start, ICU1_SIZE); | |
688 | return -EBUSY; | |
689 | } | |
1da177e4 | 690 | |
979934da YY |
691 | icu1_base = ioremap(icu1_start, ICU1_SIZE); |
692 | if (icu1_base == NULL) { | |
693 | release_mem_region(icu1_start, ICU1_SIZE); | |
694 | release_mem_region(icu2_start, ICU2_SIZE); | |
695 | return -ENOMEM; | |
696 | } | |
1da177e4 | 697 | |
979934da YY |
698 | icu2_base = ioremap(icu2_start, ICU2_SIZE); |
699 | if (icu2_base == NULL) { | |
700 | iounmap(icu1_base); | |
701 | release_mem_region(icu1_start, ICU1_SIZE); | |
702 | release_mem_region(icu2_start, ICU2_SIZE); | |
703 | return -ENOMEM; | |
704 | } | |
1da177e4 | 705 | |
979934da YY |
706 | icu1_write(MSYSINT1REG, 0); |
707 | icu1_write(MGIUINTLREG, 0xffff); | |
1da177e4 | 708 | |
979934da YY |
709 | icu2_write(MSYSINT2REG, 0); |
710 | icu2_write(MGIUINTHREG, 0xffff); | |
1da177e4 LT |
711 | |
712 | for (i = SYSINT1_IRQ_BASE; i <= SYSINT1_IRQ_LAST; i++) | |
e4ec7989 | 713 | irq_set_chip_and_handler(i, &sysint1_irq_type, |
1417836e | 714 | handle_level_irq); |
1da177e4 LT |
715 | |
716 | for (i = SYSINT2_IRQ_BASE; i <= SYSINT2_IRQ_LAST; i++) | |
e4ec7989 | 717 | irq_set_chip_and_handler(i, &sysint2_irq_type, |
1417836e | 718 | handle_level_irq); |
1da177e4 | 719 | |
979934da YY |
720 | cascade_irq(INT0_IRQ, icu_get_irq); |
721 | cascade_irq(INT1_IRQ, icu_get_irq); | |
722 | cascade_irq(INT2_IRQ, icu_get_irq); | |
723 | cascade_irq(INT3_IRQ, icu_get_irq); | |
724 | cascade_irq(INT4_IRQ, icu_get_irq); | |
1da177e4 | 725 | |
979934da | 726 | return 0; |
1da177e4 | 727 | } |
979934da YY |
728 | |
729 | core_initcall(vr41xx_icu_init); |