Commit | Line | Data |
---|---|---|
1da177e4 LT |
1 | #include <linux/init.h> |
2 | #include <linux/list.h> | |
fced80c7 | 3 | #include <linux/io.h> |
1da177e4 LT |
4 | |
5 | #include <asm/mach/irq.h> | |
6 | #include <asm/hardware/iomd.h> | |
7 | #include <asm/irq.h> | |
1da177e4 | 8 | |
9a364da7 | 9 | static void iomd_ack_irq_a(struct irq_data *d) |
1da177e4 LT |
10 | { |
11 | unsigned int val, mask; | |
12 | ||
9a364da7 | 13 | mask = 1 << d->irq; |
1da177e4 LT |
14 | val = iomd_readb(IOMD_IRQMASKA); |
15 | iomd_writeb(val & ~mask, IOMD_IRQMASKA); | |
16 | iomd_writeb(mask, IOMD_IRQCLRA); | |
17 | } | |
18 | ||
9a364da7 | 19 | static void iomd_mask_irq_a(struct irq_data *d) |
1da177e4 LT |
20 | { |
21 | unsigned int val, mask; | |
22 | ||
9a364da7 | 23 | mask = 1 << d->irq; |
1da177e4 LT |
24 | val = iomd_readb(IOMD_IRQMASKA); |
25 | iomd_writeb(val & ~mask, IOMD_IRQMASKA); | |
26 | } | |
27 | ||
9a364da7 | 28 | static void iomd_unmask_irq_a(struct irq_data *d) |
1da177e4 LT |
29 | { |
30 | unsigned int val, mask; | |
31 | ||
9a364da7 | 32 | mask = 1 << d->irq; |
1da177e4 LT |
33 | val = iomd_readb(IOMD_IRQMASKA); |
34 | iomd_writeb(val | mask, IOMD_IRQMASKA); | |
35 | } | |
36 | ||
10dd5ce2 | 37 | static struct irq_chip iomd_a_chip = { |
9a364da7 LB |
38 | .irq_ack = iomd_ack_irq_a, |
39 | .irq_mask = iomd_mask_irq_a, | |
40 | .irq_unmask = iomd_unmask_irq_a, | |
1da177e4 LT |
41 | }; |
42 | ||
9a364da7 | 43 | static void iomd_mask_irq_b(struct irq_data *d) |
1da177e4 LT |
44 | { |
45 | unsigned int val, mask; | |
46 | ||
9a364da7 | 47 | mask = 1 << (d->irq & 7); |
1da177e4 LT |
48 | val = iomd_readb(IOMD_IRQMASKB); |
49 | iomd_writeb(val & ~mask, IOMD_IRQMASKB); | |
50 | } | |
51 | ||
9a364da7 | 52 | static void iomd_unmask_irq_b(struct irq_data *d) |
1da177e4 LT |
53 | { |
54 | unsigned int val, mask; | |
55 | ||
9a364da7 | 56 | mask = 1 << (d->irq & 7); |
1da177e4 LT |
57 | val = iomd_readb(IOMD_IRQMASKB); |
58 | iomd_writeb(val | mask, IOMD_IRQMASKB); | |
59 | } | |
60 | ||
10dd5ce2 | 61 | static struct irq_chip iomd_b_chip = { |
9a364da7 LB |
62 | .irq_ack = iomd_mask_irq_b, |
63 | .irq_mask = iomd_mask_irq_b, | |
64 | .irq_unmask = iomd_unmask_irq_b, | |
1da177e4 LT |
65 | }; |
66 | ||
9a364da7 | 67 | static void iomd_mask_irq_dma(struct irq_data *d) |
1da177e4 LT |
68 | { |
69 | unsigned int val, mask; | |
70 | ||
9a364da7 | 71 | mask = 1 << (d->irq & 7); |
1da177e4 LT |
72 | val = iomd_readb(IOMD_DMAMASK); |
73 | iomd_writeb(val & ~mask, IOMD_DMAMASK); | |
74 | } | |
75 | ||
9a364da7 | 76 | static void iomd_unmask_irq_dma(struct irq_data *d) |
1da177e4 LT |
77 | { |
78 | unsigned int val, mask; | |
79 | ||
9a364da7 | 80 | mask = 1 << (d->irq & 7); |
1da177e4 LT |
81 | val = iomd_readb(IOMD_DMAMASK); |
82 | iomd_writeb(val | mask, IOMD_DMAMASK); | |
83 | } | |
84 | ||
10dd5ce2 | 85 | static struct irq_chip iomd_dma_chip = { |
9a364da7 LB |
86 | .irq_ack = iomd_mask_irq_dma, |
87 | .irq_mask = iomd_mask_irq_dma, | |
88 | .irq_unmask = iomd_unmask_irq_dma, | |
1da177e4 LT |
89 | }; |
90 | ||
9a364da7 | 91 | static void iomd_mask_irq_fiq(struct irq_data *d) |
1da177e4 LT |
92 | { |
93 | unsigned int val, mask; | |
94 | ||
9a364da7 | 95 | mask = 1 << (d->irq & 7); |
1da177e4 LT |
96 | val = iomd_readb(IOMD_FIQMASK); |
97 | iomd_writeb(val & ~mask, IOMD_FIQMASK); | |
98 | } | |
99 | ||
9a364da7 | 100 | static void iomd_unmask_irq_fiq(struct irq_data *d) |
1da177e4 LT |
101 | { |
102 | unsigned int val, mask; | |
103 | ||
9a364da7 | 104 | mask = 1 << (d->irq & 7); |
1da177e4 LT |
105 | val = iomd_readb(IOMD_FIQMASK); |
106 | iomd_writeb(val | mask, IOMD_FIQMASK); | |
107 | } | |
108 | ||
10dd5ce2 | 109 | static struct irq_chip iomd_fiq_chip = { |
9a364da7 LB |
110 | .irq_ack = iomd_mask_irq_fiq, |
111 | .irq_mask = iomd_mask_irq_fiq, | |
112 | .irq_unmask = iomd_unmask_irq_fiq, | |
1da177e4 LT |
113 | }; |
114 | ||
115 | void __init rpc_init_irq(void) | |
116 | { | |
117 | unsigned int irq, flags; | |
118 | ||
119 | iomd_writeb(0, IOMD_IRQMASKA); | |
120 | iomd_writeb(0, IOMD_IRQMASKB); | |
121 | iomd_writeb(0, IOMD_FIQMASK); | |
122 | iomd_writeb(0, IOMD_DMAMASK); | |
123 | ||
124 | for (irq = 0; irq < NR_IRQS; irq++) { | |
125 | flags = IRQF_VALID; | |
126 | ||
127 | if (irq <= 6 || (irq >= 9 && irq <= 15)) | |
128 | flags |= IRQF_PROBE; | |
129 | ||
130 | if (irq == 21 || (irq >= 16 && irq <= 19) || | |
131 | irq == IRQ_KEYBOARDTX) | |
132 | flags |= IRQF_NOAUTOEN; | |
133 | ||
134 | switch (irq) { | |
135 | case 0 ... 7: | |
f38c02f3 TG |
136 | irq_set_chip_and_handler(irq, &iomd_a_chip, |
137 | handle_level_irq); | |
1da177e4 LT |
138 | set_irq_flags(irq, flags); |
139 | break; | |
140 | ||
141 | case 8 ... 15: | |
f38c02f3 TG |
142 | irq_set_chip_and_handler(irq, &iomd_b_chip, |
143 | handle_level_irq); | |
1da177e4 LT |
144 | set_irq_flags(irq, flags); |
145 | break; | |
146 | ||
147 | case 16 ... 21: | |
f38c02f3 TG |
148 | irq_set_chip_and_handler(irq, &iomd_dma_chip, |
149 | handle_level_irq); | |
1da177e4 LT |
150 | set_irq_flags(irq, flags); |
151 | break; | |
152 | ||
153 | case 64 ... 71: | |
6845664a | 154 | irq_set_chip(irq, &iomd_fiq_chip); |
1da177e4 LT |
155 | set_irq_flags(irq, IRQF_VALID); |
156 | break; | |
157 | } | |
158 | } | |
159 | ||
160 | init_FIQ(); | |
161 | } | |
162 |