1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17#include <linux/errno.h>
18#include <linux/io.h>
19#include <linux/irq.h>
20#include <linux/irqdomain.h>
21#include <linux/of.h>
22#include <linux/of_address.h>
23#include <linux/slab.h>
24
25#include "irq-atmel-aic-common.h"
26
27#define AT91_AIC_PRIOR GENMASK(2, 0)
28#define AT91_AIC_IRQ_MIN_PRIORITY 0
29#define AT91_AIC_IRQ_MAX_PRIORITY 7
30
31#define AT91_AIC_SRCTYPE GENMASK(6, 5)
32#define AT91_AIC_SRCTYPE_LOW (0 << 5)
33#define AT91_AIC_SRCTYPE_FALLING (1 << 5)
34#define AT91_AIC_SRCTYPE_HIGH (2 << 5)
35#define AT91_AIC_SRCTYPE_RISING (3 << 5)
36
37struct aic_chip_data {
38 u32 ext_irqs;
39};
40
41static void aic_common_shutdown(struct irq_data *d)
42{
43 struct irq_chip_type *ct = irq_data_get_chip_type(d);
44
45 ct->chip.irq_mask(d);
46}
47
48int aic_common_set_type(struct irq_data *d, unsigned type, unsigned *val)
49{
50 struct irq_chip_generic *gc = irq_data_get_irq_chip_data(d);
51 struct aic_chip_data *aic = gc->private;
52 unsigned aic_type;
53
54 switch (type) {
55 case IRQ_TYPE_LEVEL_HIGH:
56 aic_type = AT91_AIC_SRCTYPE_HIGH;
57 break;
58 case IRQ_TYPE_EDGE_RISING:
59 aic_type = AT91_AIC_SRCTYPE_RISING;
60 break;
61 case IRQ_TYPE_LEVEL_LOW:
62 if (!(d->mask & aic->ext_irqs))
63 return -EINVAL;
64
65 aic_type = AT91_AIC_SRCTYPE_LOW;
66 break;
67 case IRQ_TYPE_EDGE_FALLING:
68 if (!(d->mask & aic->ext_irqs))
69 return -EINVAL;
70
71 aic_type = AT91_AIC_SRCTYPE_FALLING;
72 break;
73 default:
74 return -EINVAL;
75 }
76
77 *val &= ~AT91_AIC_SRCTYPE;
78 *val |= aic_type;
79
80 return 0;
81}
82
83void aic_common_set_priority(int priority, unsigned *val)
84{
85 *val &= ~AT91_AIC_PRIOR;
86 *val |= priority;
87}
88
89int aic_common_irq_domain_xlate(struct irq_domain *d,
90 struct device_node *ctrlr,
91 const u32 *intspec,
92 unsigned int intsize,
93 irq_hw_number_t *out_hwirq,
94 unsigned int *out_type)
95{
96 if (WARN_ON(intsize < 3))
97 return -EINVAL;
98
99 if (WARN_ON((intspec[2] < AT91_AIC_IRQ_MIN_PRIORITY) ||
100 (intspec[2] > AT91_AIC_IRQ_MAX_PRIORITY)))
101 return -EINVAL;
102
103 *out_hwirq = intspec[0];
104 *out_type = intspec[1] & IRQ_TYPE_SENSE_MASK;
105
106 return 0;
107}
108
109static void __init aic_common_ext_irq_of_init(struct irq_domain *domain)
110{
111 struct device_node *node = irq_domain_get_of_node(domain);
112 struct irq_chip_generic *gc;
113 struct aic_chip_data *aic;
114 struct property *prop;
115 const __be32 *p;
116 u32 hwirq;
117
118 gc = irq_get_domain_generic_chip(domain, 0);
119
120 aic = gc->private;
121 aic->ext_irqs |= 1;
122
123 of_property_for_each_u32(node, "atmel,external-irqs", prop, p, hwirq) {
124 gc = irq_get_domain_generic_chip(domain, hwirq);
125 if (!gc) {
126 pr_warn("AIC: external irq %d >= %d skip it\n",
127 hwirq, domain->revmap_size);
128 continue;
129 }
130
131 aic = gc->private;
132 aic->ext_irqs |= (1 << (hwirq % 32));
133 }
134}
135
136#define AT91_RTC_IDR 0x24
137#define AT91_RTC_IMR 0x28
138#define AT91_RTC_IRQ_MASK 0x1f
139
140void __init aic_common_rtc_irq_fixup(struct device_node *root)
141{
142 struct device_node *np;
143 void __iomem *regs;
144
145 np = of_find_compatible_node(root, NULL, "atmel,at91rm9200-rtc");
146 if (!np)
147 np = of_find_compatible_node(root, NULL,
148 "atmel,at91sam9x5-rtc");
149
150 if (!np)
151 return;
152
153 regs = of_iomap(np, 0);
154 of_node_put(np);
155
156 if (!regs)
157 return;
158
159 writel(AT91_RTC_IRQ_MASK, regs + AT91_RTC_IDR);
160
161 iounmap(regs);
162}
163
164#define AT91_RTT_MR 0x00
165#define AT91_RTT_ALMIEN (1 << 16)
166#define AT91_RTT_RTTINCIEN (1 << 17)
167
168void __init aic_common_rtt_irq_fixup(struct device_node *root)
169{
170 struct device_node *np;
171 void __iomem *regs;
172
173
174
175
176
177 for_each_compatible_node(np, NULL, "atmel,at91sam9260-rtt") {
178 regs = of_iomap(np, 0);
179 if (!regs)
180 continue;
181
182 writel(readl(regs + AT91_RTT_MR) &
183 ~(AT91_RTT_ALMIEN | AT91_RTT_RTTINCIEN),
184 regs + AT91_RTT_MR);
185
186 iounmap(regs);
187 }
188}
189
190static void __init aic_common_irq_fixup(const struct of_device_id *matches)
191{
192 struct device_node *root = of_find_node_by_path("/");
193 const struct of_device_id *match;
194
195 if (!root)
196 return;
197
198 match = of_match_node(matches, root);
199 of_node_put(root);
200
201 if (match) {
202 void (*fixup)(struct device_node *) = match->data;
203 fixup(root);
204 }
205
206 of_node_put(root);
207}
208
209struct irq_domain *__init aic_common_of_init(struct device_node *node,
210 const struct irq_domain_ops *ops,
211 const char *name, int nirqs,
212 const struct of_device_id *matches)
213{
214 struct irq_chip_generic *gc;
215 struct irq_domain *domain;
216 struct aic_chip_data *aic;
217 void __iomem *reg_base;
218 int nchips;
219 int ret;
220 int i;
221
222 nchips = DIV_ROUND_UP(nirqs, 32);
223
224 reg_base = of_iomap(node, 0);
225 if (!reg_base)
226 return ERR_PTR(-ENOMEM);
227
228 aic = kcalloc(nchips, sizeof(*aic), GFP_KERNEL);
229 if (!aic) {
230 ret = -ENOMEM;
231 goto err_iounmap;
232 }
233
234 domain = irq_domain_add_linear(node, nchips * 32, ops, aic);
235 if (!domain) {
236 ret = -ENOMEM;
237 goto err_free_aic;
238 }
239
240 ret = irq_alloc_domain_generic_chips(domain, 32, 1, name,
241 handle_fasteoi_irq,
242 IRQ_NOREQUEST | IRQ_NOPROBE |
243 IRQ_NOAUTOEN, 0, 0);
244 if (ret)
245 goto err_domain_remove;
246
247 for (i = 0; i < nchips; i++) {
248 gc = irq_get_domain_generic_chip(domain, i * 32);
249
250 gc->reg_base = reg_base;
251
252 gc->unused = 0;
253 gc->wake_enabled = ~0;
254 gc->chip_types[0].type = IRQ_TYPE_SENSE_MASK;
255 gc->chip_types[0].chip.irq_eoi = irq_gc_eoi;
256 gc->chip_types[0].chip.irq_set_wake = irq_gc_set_wake;
257 gc->chip_types[0].chip.irq_shutdown = aic_common_shutdown;
258 gc->private = &aic[i];
259 }
260
261 aic_common_ext_irq_of_init(domain);
262 aic_common_irq_fixup(matches);
263
264 return domain;
265
266err_domain_remove:
267 irq_domain_remove(domain);
268
269err_free_aic:
270 kfree(aic);
271
272err_iounmap:
273 iounmap(reg_base);
274
275 return ERR_PTR(ret);
276}
277
