2 * arch/arm/mach-iop33x/irq.c
4 * Generic IOP331 IRQ handling functionality
6 * Author: Dave Jiang <dave.jiang@intel.com>
7 * Copyright (C) 2003 Intel Corp.
9 * This program is free software; you can redistribute it and/or modify
10 * it under the terms of the GNU General Public License version 2 as
11 * published by the Free Software Foundation.
14 #include <linux/init.h>
15 #include <linux/interrupt.h>
16 #include <linux/list.h>
17 #include <asm/mach/irq.h>
19 #include <mach/hardware.h>
20 #include <asm/mach-types.h>
22 static u32 iop33x_mask0
;
23 static u32 iop33x_mask1
;
25 static void intctl0_write(u32 val
)
27 asm volatile("mcr p6, 0, %0, c0, c0, 0" : : "r" (val
));
30 static void intctl1_write(u32 val
)
32 asm volatile("mcr p6, 0, %0, c1, c0, 0" : : "r" (val
));
35 static void intstr0_write(u32 val
)
37 asm volatile("mcr p6, 0, %0, c2, c0, 0" : : "r" (val
));
40 static void intstr1_write(u32 val
)
42 asm volatile("mcr p6, 0, %0, c3, c0, 0" : : "r" (val
));
45 static void intbase_write(u32 val
)
47 asm volatile("mcr p6, 0, %0, c12, c0, 0" : : "r" (val
));
50 static void intsize_write(u32 val
)
52 asm volatile("mcr p6, 0, %0, c13, c0, 0" : : "r" (val
));
56 iop33x_irq_mask1 (struct irq_data
*d
)
58 iop33x_mask0
&= ~(1 << d
->irq
);
59 intctl0_write(iop33x_mask0
);
63 iop33x_irq_mask2 (struct irq_data
*d
)
65 iop33x_mask1
&= ~(1 << (d
->irq
- 32));
66 intctl1_write(iop33x_mask1
);
70 iop33x_irq_unmask1(struct irq_data
*d
)
72 iop33x_mask0
|= 1 << d
->irq
;
73 intctl0_write(iop33x_mask0
);
77 iop33x_irq_unmask2(struct irq_data
*d
)
79 iop33x_mask1
|= (1 << (d
->irq
- 32));
80 intctl1_write(iop33x_mask1
);
83 struct irq_chip iop33x_irqchip1
= {
85 .irq_ack
= iop33x_irq_mask1
,
86 .irq_mask
= iop33x_irq_mask1
,
87 .irq_unmask
= iop33x_irq_unmask1
,
90 struct irq_chip iop33x_irqchip2
= {
92 .irq_ack
= iop33x_irq_mask2
,
93 .irq_mask
= iop33x_irq_mask2
,
94 .irq_unmask
= iop33x_irq_unmask2
,
97 void __init
iop33x_init_irq(void)
101 iop_init_cp6_handler();
109 if (machine_is_iq80331())
110 *IOP3XX_PCIIRSR
= 0x0f;
112 for (i
= 0; i
< NR_IRQS
; i
++) {
113 irq_set_chip_and_handler(i
,
114 (i
< 32) ? &iop33x_irqchip1
: &iop33x_irqchip2
,
116 set_irq_flags(i
, IRQF_VALID
| IRQF_PROBE
);