]> git.proxmox.com Git - mirror_ubuntu-bionic-kernel.git/blame - arch/mips/vr41xx/common/icu.c
MIPS: Whitespace cleanup.
[mirror_ubuntu-bionic-kernel.git] / arch / mips / vr41xx / common / icu.c
CommitLineData
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>
32#include <linux/init.h>
979934da 33#include <linux/ioport.h>
1da177e4
LT
34#include <linux/irq.h>
35#include <linux/module.h>
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
44static void __iomem *icu1_base;
45static void __iomem *icu2_base;
1da177e4
LT
46
47static unsigned char sysint1_assign[16] = {
48 0, 0, 1, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0 };
49static 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 111static 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 122static 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 133static 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 144static 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
155void 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
168EXPORT_SYMBOL(vr41xx_enable_piuint);
169
170void 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
183EXPORT_SYMBOL(vr41xx_disable_piuint);
184
185void 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
198EXPORT_SYMBOL(vr41xx_enable_aiuint);
199
200void 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
213EXPORT_SYMBOL(vr41xx_disable_aiuint);
214
215void 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
228EXPORT_SYMBOL(vr41xx_enable_kiuint);
229
230void 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
243EXPORT_SYMBOL(vr41xx_disable_kiuint);
244
9a0ad9e9
YY
245void 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
255EXPORT_SYMBOL(vr41xx_enable_macint);
256
257void 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
267EXPORT_SYMBOL(vr41xx_disable_macint);
268
1da177e4
LT
269void 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
279EXPORT_SYMBOL(vr41xx_enable_dsiuint);
280
281void 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
291EXPORT_SYMBOL(vr41xx_disable_dsiuint);
292
293void 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
303EXPORT_SYMBOL(vr41xx_enable_firint);
304
305void 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
315EXPORT_SYMBOL(vr41xx_disable_firint);
316
317void 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
331EXPORT_SYMBOL(vr41xx_enable_pciint);
332
333void 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
347EXPORT_SYMBOL(vr41xx_disable_pciint);
348
349void 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
363EXPORT_SYMBOL(vr41xx_enable_scuint);
364
365void 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
379EXPORT_SYMBOL(vr41xx_disable_scuint);
380
381void 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
395EXPORT_SYMBOL(vr41xx_enable_csiint);
396
397void 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
411EXPORT_SYMBOL(vr41xx_disable_csiint);
412
413void 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
427EXPORT_SYMBOL(vr41xx_enable_bcuint);
428
429void 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
443EXPORT_SYMBOL(vr41xx_disable_bcuint);
444
fbaa4e2a 445static 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 450static 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 455static 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 461static 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 466static 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 471static 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
477static 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
537static 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
605int 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
623EXPORT_SYMBOL(vr41xx_set_intassign);
624
937a8015 625static 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
661static 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
729core_initcall(vr41xx_icu_init);