1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21#undef DEBUG
22
23#include <linux/kernel.h>
24#include <linux/irq.h>
25#include <linux/of.h>
26#include <linux/of_address.h>
27#include <linux/of_irq.h>
28#include <asm/io.h>
29#include <asm/processor.h>
30#include <asm/i8259.h>
31#include <asm/irq.h>
32
33
34
35
36#define XINTC_ISR 0
37#define XINTC_IPR 4
38#define XINTC_IER 8
39#define XINTC_IAR 12
40#define XINTC_SIE 16
41#define XINTC_CIE 20
42#define XINTC_IVR 24
43#define XINTC_MER 28
44
45static struct irq_domain *master_irqhost;
46
47#define XILINX_INTC_MAXIRQS (32)
48
49
50
51
52
53static int xilinx_intc_typetable[XILINX_INTC_MAXIRQS];
54
55
56
57
58static unsigned char xilinx_intc_map_senses[] = {
59 IRQ_TYPE_EDGE_RISING,
60 IRQ_TYPE_EDGE_FALLING,
61 IRQ_TYPE_LEVEL_HIGH,
62 IRQ_TYPE_LEVEL_LOW,
63};
64
65
66
67
68
69
70
71
72
73
74static void xilinx_intc_mask(struct irq_data *d)
75{
76 int irq = irqd_to_hwirq(d);
77 void * regs = irq_data_get_irq_chip_data(d);
78 pr_debug("mask: %d\n", irq);
79 out_be32(regs + XINTC_CIE, 1 << irq);
80}
81
82static int xilinx_intc_set_type(struct irq_data *d, unsigned int flow_type)
83{
84 return 0;
85}
86
87
88
89
90static void xilinx_intc_level_unmask(struct irq_data *d)
91{
92 int irq = irqd_to_hwirq(d);
93 void * regs = irq_data_get_irq_chip_data(d);
94 pr_debug("unmask: %d\n", irq);
95 out_be32(regs + XINTC_SIE, 1 << irq);
96
97
98
99
100
101 out_be32(regs + XINTC_IAR, 1 << irq);
102}
103
104static struct irq_chip xilinx_intc_level_irqchip = {
105 .name = "Xilinx Level INTC",
106 .irq_mask = xilinx_intc_mask,
107 .irq_mask_ack = xilinx_intc_mask,
108 .irq_unmask = xilinx_intc_level_unmask,
109 .irq_set_type = xilinx_intc_set_type,
110};
111
112
113
114
115static void xilinx_intc_edge_unmask(struct irq_data *d)
116{
117 int irq = irqd_to_hwirq(d);
118 void *regs = irq_data_get_irq_chip_data(d);
119 pr_debug("unmask: %d\n", irq);
120 out_be32(regs + XINTC_SIE, 1 << irq);
121}
122
123static void xilinx_intc_edge_ack(struct irq_data *d)
124{
125 int irq = irqd_to_hwirq(d);
126 void * regs = irq_data_get_irq_chip_data(d);
127 pr_debug("ack: %d\n", irq);
128 out_be32(regs + XINTC_IAR, 1 << irq);
129}
130
131static struct irq_chip xilinx_intc_edge_irqchip = {
132 .name = "Xilinx Edge INTC",
133 .irq_mask = xilinx_intc_mask,
134 .irq_unmask = xilinx_intc_edge_unmask,
135 .irq_ack = xilinx_intc_edge_ack,
136 .irq_set_type = xilinx_intc_set_type,
137};
138
139
140
141
142
143
144
145
146static int xilinx_intc_xlate(struct irq_domain *h, struct device_node *ct,
147 const u32 *intspec, unsigned int intsize,
148 irq_hw_number_t *out_hwirq,
149 unsigned int *out_flags)
150{
151 if ((intsize < 2) || (intspec[0] >= XILINX_INTC_MAXIRQS))
152 return -EINVAL;
153
154
155
156 xilinx_intc_typetable[intspec[0]] = xilinx_intc_map_senses[intspec[1]];
157
158
159
160
161 *out_hwirq = intspec[0];
162 *out_flags = xilinx_intc_map_senses[intspec[1]];
163
164 return 0;
165}
166static int xilinx_intc_map(struct irq_domain *h, unsigned int virq,
167 irq_hw_number_t irq)
168{
169 irq_set_chip_data(virq, h->host_data);
170
171 if (xilinx_intc_typetable[irq] == IRQ_TYPE_LEVEL_HIGH ||
172 xilinx_intc_typetable[irq] == IRQ_TYPE_LEVEL_LOW) {
173 irq_set_chip_and_handler(virq, &xilinx_intc_level_irqchip,
174 handle_level_irq);
175 } else {
176 irq_set_chip_and_handler(virq, &xilinx_intc_edge_irqchip,
177 handle_edge_irq);
178 }
179 return 0;
180}
181
182static struct irq_domain_ops xilinx_intc_ops = {
183 .map = xilinx_intc_map,
184 .xlate = xilinx_intc_xlate,
185};
186
187struct irq_domain * __init
188xilinx_intc_init(struct device_node *np)
189{
190 struct irq_domain * irq;
191 void * regs;
192
193
194 regs = of_iomap(np, 0);
195 if (!regs) {
196 pr_err("xilinx_intc: could not map registers\n");
197 return NULL;
198 }
199
200
201 out_be32(regs + XINTC_IER, 0);
202 out_be32(regs + XINTC_IAR, ~(u32) 0);
203 out_be32(regs + XINTC_MER, 0x3UL);
204
205
206 irq = irq_domain_add_linear(np, XILINX_INTC_MAXIRQS, &xilinx_intc_ops,
207 regs);
208 if (!irq)
209 panic(__FILE__ ": Cannot allocate IRQ host\n");
210
211 return irq;
212}
213
214int xilinx_intc_get_irq(void)
215{
216 void * regs = master_irqhost->host_data;
217 pr_debug("get_irq:\n");
218 return irq_linear_revmap(master_irqhost, in_be32(regs + XINTC_IVR));
219}
220
221#if defined(CONFIG_PPC_I8259)
222
223
224
225static void xilinx_i8259_cascade(unsigned int irq, struct irq_desc *desc)
226{
227 struct irq_chip *chip = irq_desc_get_chip(desc);
228 unsigned int cascade_irq = i8259_irq();
229
230 if (cascade_irq)
231 generic_handle_irq(cascade_irq);
232
233
234 chip->irq_unmask(&desc->irq_data);
235}
236
237static void __init xilinx_i8259_setup_cascade(void)
238{
239 struct device_node *cascade_node;
240 int cascade_irq;
241
242
243 cascade_node = of_find_compatible_node(NULL, NULL, "chrp,iic");
244 if (!cascade_node)
245 return;
246
247 cascade_irq = irq_of_parse_and_map(cascade_node, 0);
248 if (!cascade_irq) {
249 pr_err("virtex_ml510: Failed to map cascade interrupt\n");
250 goto out;
251 }
252
253 i8259_init(cascade_node, 0);
254 irq_set_chained_handler(cascade_irq, xilinx_i8259_cascade);
255
256
257
258 outb(0xc0, 0x4d0);
259 outb(0xc0, 0x4d1);
260
261 out:
262 of_node_put(cascade_node);
263}
264#else
265static inline void xilinx_i8259_setup_cascade(void) { return; }
266#endif
267
268static const struct of_device_id xilinx_intc_match[] __initconst = {
269 { .compatible = "xlnx,opb-intc-1.00.c", },
270 { .compatible = "xlnx,xps-intc-1.00.a", },
271 {}
272};
273
274
275
276
277void __init xilinx_intc_init_tree(void)
278{
279 struct device_node *np;
280
281
282 for_each_matching_node(np, xilinx_intc_match) {
283 if (!of_get_property(np, "interrupts", NULL))
284 break;
285 }
286 BUG_ON(!np);
287
288 master_irqhost = xilinx_intc_init(np);
289 BUG_ON(!master_irqhost);
290
291 irq_set_default_host(master_irqhost);
292 of_node_put(np);
293
294 xilinx_i8259_setup_cascade();
295}
296