Blame view
drivers/irqchip/irq-atmel-aic5.c
10.6 KB
b1479ebb7 irqchip: atmel-ai... |
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 |
/* * Atmel AT91 AIC5 (Advanced Interrupt Controller) driver * * Copyright (C) 2004 SAN People * Copyright (C) 2004 ATMEL * Copyright (C) Rick Bronson * Copyright (C) 2014 Free Electrons * * Author: Boris BREZILLON <boris.brezillon@free-electrons.com> * * This file is licensed under the terms of the GNU General Public * License version 2. This program is licensed "as is" without any * warranty of any kind, whether express or implied. */ #include <linux/init.h> #include <linux/module.h> #include <linux/mm.h> #include <linux/bitmap.h> #include <linux/types.h> #include <linux/irq.h> |
41a83e06e irqchip: Prepare ... |
22 |
#include <linux/irqchip.h> |
b1479ebb7 irqchip: atmel-ai... |
23 24 25 26 27 28 29 30 31 32 33 34 |
#include <linux/of.h> #include <linux/of_address.h> #include <linux/of_irq.h> #include <linux/irqdomain.h> #include <linux/err.h> #include <linux/slab.h> #include <linux/io.h> #include <asm/exception.h> #include <asm/mach/irq.h> #include "irq-atmel-aic-common.h" |
b1479ebb7 irqchip: atmel-ai... |
35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 |
/* Number of irq lines managed by AIC */ #define NR_AIC5_IRQS 128 #define AT91_AIC5_SSR 0x0 #define AT91_AIC5_INTSEL_MSK (0x7f << 0) #define AT91_AIC5_SMR 0x4 #define AT91_AIC5_SVR 0x8 #define AT91_AIC5_IVR 0x10 #define AT91_AIC5_FVR 0x14 #define AT91_AIC5_ISR 0x18 #define AT91_AIC5_IPR0 0x20 #define AT91_AIC5_IPR1 0x24 #define AT91_AIC5_IPR2 0x28 #define AT91_AIC5_IPR3 0x2c #define AT91_AIC5_IMR 0x30 #define AT91_AIC5_CISR 0x34 #define AT91_AIC5_IECR 0x40 #define AT91_AIC5_IDCR 0x44 #define AT91_AIC5_ICCR 0x48 #define AT91_AIC5_ISCR 0x4c #define AT91_AIC5_EOICR 0x38 #define AT91_AIC5_SPU 0x3c #define AT91_AIC5_DCR 0x6c #define AT91_AIC5_FFER 0x50 #define AT91_AIC5_FFDR 0x54 #define AT91_AIC5_FFSR 0x58 static struct irq_domain *aic5_domain; static asmlinkage void __exception_irq_entry aic5_handle(struct pt_regs *regs) { |
b55a3bb86 irqchip/atmel-aic... |
73 |
struct irq_chip_generic *bgc = irq_get_domain_generic_chip(aic5_domain, 0); |
b1479ebb7 irqchip: atmel-ai... |
74 75 |
u32 irqnr; u32 irqstat; |
414a431ad irqchip/atmel-aic... |
76 77 |
irqnr = irq_reg_readl(bgc, AT91_AIC5_IVR); irqstat = irq_reg_readl(bgc, AT91_AIC5_ISR); |
b1479ebb7 irqchip: atmel-ai... |
78 |
|
b1479ebb7 irqchip: atmel-ai... |
79 |
if (!irqstat) |
414a431ad irqchip/atmel-aic... |
80 |
irq_reg_writel(bgc, 0, AT91_AIC5_EOICR); |
b1479ebb7 irqchip: atmel-ai... |
81 |
else |
31b7b6a86 irqchip: atmel-ai... |
82 |
handle_domain_irq(aic5_domain, irqnr, regs); |
b1479ebb7 irqchip: atmel-ai... |
83 84 85 86 87 |
} static void aic5_mask(struct irq_data *d) { struct irq_domain *domain = d->domain; |
b55a3bb86 irqchip/atmel-aic... |
88 |
struct irq_chip_generic *bgc = irq_get_domain_generic_chip(domain, 0); |
d32dc9aa1 irqchip/atmel-aic... |
89 90 91 92 93 94 95 |
struct irq_chip_generic *gc = irq_data_get_irq_chip_data(d); /* * Disable interrupt on AIC5. We always take the lock of the * first irq chip as all chips share the same registers. */ irq_gc_lock(bgc); |
332fd7c4f genirq: Generic c... |
96 97 |
irq_reg_writel(gc, d->hwirq, AT91_AIC5_SSR); irq_reg_writel(gc, 1, AT91_AIC5_IDCR); |
b1479ebb7 irqchip: atmel-ai... |
98 |
gc->mask_cache &= ~d->mask; |
d32dc9aa1 irqchip/atmel-aic... |
99 |
irq_gc_unlock(bgc); |
b1479ebb7 irqchip: atmel-ai... |
100 101 102 103 104 |
} static void aic5_unmask(struct irq_data *d) { struct irq_domain *domain = d->domain; |
b55a3bb86 irqchip/atmel-aic... |
105 |
struct irq_chip_generic *bgc = irq_get_domain_generic_chip(domain, 0); |
d32dc9aa1 irqchip/atmel-aic... |
106 107 108 109 110 111 112 |
struct irq_chip_generic *gc = irq_data_get_irq_chip_data(d); /* * Enable interrupt on AIC5. We always take the lock of the * first irq chip as all chips share the same registers. */ irq_gc_lock(bgc); |
332fd7c4f genirq: Generic c... |
113 114 |
irq_reg_writel(gc, d->hwirq, AT91_AIC5_SSR); irq_reg_writel(gc, 1, AT91_AIC5_IECR); |
b1479ebb7 irqchip: atmel-ai... |
115 |
gc->mask_cache |= d->mask; |
d32dc9aa1 irqchip/atmel-aic... |
116 |
irq_gc_unlock(bgc); |
b1479ebb7 irqchip: atmel-ai... |
117 118 119 120 121 |
} static int aic5_retrigger(struct irq_data *d) { struct irq_domain *domain = d->domain; |
b55a3bb86 irqchip/atmel-aic... |
122 |
struct irq_chip_generic *bgc = irq_get_domain_generic_chip(domain, 0); |
b1479ebb7 irqchip: atmel-ai... |
123 124 |
/* Enable interrupt on AIC5 */ |
414a431ad irqchip/atmel-aic... |
125 126 127 128 |
irq_gc_lock(bgc); irq_reg_writel(bgc, d->hwirq, AT91_AIC5_SSR); irq_reg_writel(bgc, 1, AT91_AIC5_ISCR); irq_gc_unlock(bgc); |
b1479ebb7 irqchip: atmel-ai... |
129 |
|
4ddfc459d irqchip/atmel-aic... |
130 |
return 1; |
b1479ebb7 irqchip: atmel-ai... |
131 132 133 134 135 |
} static int aic5_set_type(struct irq_data *d, unsigned type) { struct irq_domain *domain = d->domain; |
b55a3bb86 irqchip/atmel-aic... |
136 |
struct irq_chip_generic *bgc = irq_get_domain_generic_chip(domain, 0); |
b1479ebb7 irqchip: atmel-ai... |
137 138 |
unsigned int smr; int ret; |
414a431ad irqchip/atmel-aic... |
139 140 141 |
irq_gc_lock(bgc); irq_reg_writel(bgc, d->hwirq, AT91_AIC5_SSR); smr = irq_reg_readl(bgc, AT91_AIC5_SMR); |
b1479ebb7 irqchip: atmel-ai... |
142 143 |
ret = aic_common_set_type(d, type, &smr); if (!ret) |
414a431ad irqchip/atmel-aic... |
144 145 |
irq_reg_writel(bgc, smr, AT91_AIC5_SMR); irq_gc_unlock(bgc); |
b1479ebb7 irqchip: atmel-ai... |
146 147 148 149 150 |
return ret; } #ifdef CONFIG_PM |
a50ac562e irqchip/atmel-aic... |
151 |
static u32 *smr_cache; |
b1479ebb7 irqchip: atmel-ai... |
152 153 154 155 |
static void aic5_suspend(struct irq_data *d) { struct irq_domain *domain = d->domain; struct irq_domain_chip_generic *dgc = domain->gc; |
b55a3bb86 irqchip/atmel-aic... |
156 |
struct irq_chip_generic *bgc = irq_get_domain_generic_chip(domain, 0); |
b1479ebb7 irqchip: atmel-ai... |
157 158 159 |
struct irq_chip_generic *gc = irq_data_get_irq_chip_data(d); int i; u32 mask; |
a50ac562e irqchip/atmel-aic... |
160 161 162 163 164 |
if (smr_cache) for (i = 0; i < domain->revmap_size; i++) { irq_reg_writel(bgc, i, AT91_AIC5_SSR); smr_cache[i] = irq_reg_readl(bgc, AT91_AIC5_SMR); } |
b1479ebb7 irqchip: atmel-ai... |
165 166 167 168 169 |
irq_gc_lock(bgc); for (i = 0; i < dgc->irqs_per_chip; i++) { mask = 1 << i; if ((mask & gc->mask_cache) == (mask & gc->wake_active)) continue; |
332fd7c4f genirq: Generic c... |
170 |
irq_reg_writel(bgc, i + gc->irq_base, AT91_AIC5_SSR); |
b1479ebb7 irqchip: atmel-ai... |
171 |
if (mask & gc->wake_active) |
332fd7c4f genirq: Generic c... |
172 |
irq_reg_writel(bgc, 1, AT91_AIC5_IECR); |
b1479ebb7 irqchip: atmel-ai... |
173 |
else |
332fd7c4f genirq: Generic c... |
174 |
irq_reg_writel(bgc, 1, AT91_AIC5_IDCR); |
b1479ebb7 irqchip: atmel-ai... |
175 176 177 178 179 180 181 182 |
} irq_gc_unlock(bgc); } static void aic5_resume(struct irq_data *d) { struct irq_domain *domain = d->domain; struct irq_domain_chip_generic *dgc = domain->gc; |
b55a3bb86 irqchip/atmel-aic... |
183 |
struct irq_chip_generic *bgc = irq_get_domain_generic_chip(domain, 0); |
b1479ebb7 irqchip: atmel-ai... |
184 185 186 187 188 |
struct irq_chip_generic *gc = irq_data_get_irq_chip_data(d); int i; u32 mask; irq_gc_lock(bgc); |
a50ac562e irqchip/atmel-aic... |
189 190 191 192 193 194 195 196 197 |
if (smr_cache) { irq_reg_writel(bgc, 0xffffffff, AT91_AIC5_SPU); for (i = 0; i < domain->revmap_size; i++) { irq_reg_writel(bgc, i, AT91_AIC5_SSR); irq_reg_writel(bgc, i, AT91_AIC5_SVR); irq_reg_writel(bgc, smr_cache[i], AT91_AIC5_SMR); } } |
b1479ebb7 irqchip: atmel-ai... |
198 199 |
for (i = 0; i < dgc->irqs_per_chip; i++) { mask = 1 << i; |
a50ac562e irqchip/atmel-aic... |
200 201 202 |
if (!smr_cache && ((mask & gc->mask_cache) == (mask & gc->wake_active))) |
b1479ebb7 irqchip: atmel-ai... |
203 |
continue; |
332fd7c4f genirq: Generic c... |
204 |
irq_reg_writel(bgc, i + gc->irq_base, AT91_AIC5_SSR); |
b1479ebb7 irqchip: atmel-ai... |
205 |
if (mask & gc->mask_cache) |
332fd7c4f genirq: Generic c... |
206 |
irq_reg_writel(bgc, 1, AT91_AIC5_IECR); |
b1479ebb7 irqchip: atmel-ai... |
207 |
else |
332fd7c4f genirq: Generic c... |
208 |
irq_reg_writel(bgc, 1, AT91_AIC5_IDCR); |
b1479ebb7 irqchip: atmel-ai... |
209 210 211 212 213 214 215 216 |
} irq_gc_unlock(bgc); } static void aic5_pm_shutdown(struct irq_data *d) { struct irq_domain *domain = d->domain; struct irq_domain_chip_generic *dgc = domain->gc; |
b55a3bb86 irqchip/atmel-aic... |
217 |
struct irq_chip_generic *bgc = irq_get_domain_generic_chip(domain, 0); |
b1479ebb7 irqchip: atmel-ai... |
218 219 220 221 222 |
struct irq_chip_generic *gc = irq_data_get_irq_chip_data(d); int i; irq_gc_lock(bgc); for (i = 0; i < dgc->irqs_per_chip; i++) { |
332fd7c4f genirq: Generic c... |
223 224 225 |
irq_reg_writel(bgc, i + gc->irq_base, AT91_AIC5_SSR); irq_reg_writel(bgc, 1, AT91_AIC5_IDCR); irq_reg_writel(bgc, 1, AT91_AIC5_ICCR); |
b1479ebb7 irqchip: atmel-ai... |
226 227 228 229 230 231 232 233 234 235 236 237 238 239 240 241 242 243 244 |
} irq_gc_unlock(bgc); } #else #define aic5_suspend NULL #define aic5_resume NULL #define aic5_pm_shutdown NULL #endif /* CONFIG_PM */ static void __init aic5_hw_init(struct irq_domain *domain) { struct irq_chip_generic *gc = irq_get_domain_generic_chip(domain, 0); int i; /* * Perform 8 End Of Interrupt Command to make sure AIC * will not Lock out nIRQ */ for (i = 0; i < 8; i++) |
332fd7c4f genirq: Generic c... |
245 |
irq_reg_writel(gc, 0, AT91_AIC5_EOICR); |
b1479ebb7 irqchip: atmel-ai... |
246 247 248 249 250 251 |
/* * Spurious Interrupt ID in Spurious Vector Register. * When there is no current interrupt, the IRQ Vector Register * reads the value stored in AIC_SPU */ |
332fd7c4f genirq: Generic c... |
252 |
irq_reg_writel(gc, 0xffffffff, AT91_AIC5_SPU); |
b1479ebb7 irqchip: atmel-ai... |
253 254 |
/* No debugging in AIC: Debug (Protect) Control Register */ |
332fd7c4f genirq: Generic c... |
255 |
irq_reg_writel(gc, 0, AT91_AIC5_DCR); |
b1479ebb7 irqchip: atmel-ai... |
256 257 258 |
/* Disable and clear all interrupts initially */ for (i = 0; i < domain->revmap_size; i++) { |
332fd7c4f genirq: Generic c... |
259 260 261 262 |
irq_reg_writel(gc, i, AT91_AIC5_SSR); irq_reg_writel(gc, i, AT91_AIC5_SVR); irq_reg_writel(gc, 1, AT91_AIC5_IDCR); irq_reg_writel(gc, 1, AT91_AIC5_ICCR); |
b1479ebb7 irqchip: atmel-ai... |
263 264 265 266 267 268 269 270 271 |
} } static int aic5_irq_domain_xlate(struct irq_domain *d, struct device_node *ctrlr, const u32 *intspec, unsigned int intsize, irq_hw_number_t *out_hwirq, unsigned int *out_type) { |
b55a3bb86 irqchip/atmel-aic... |
272 |
struct irq_chip_generic *bgc = irq_get_domain_generic_chip(d, 0); |
5eb0d6eb3 irqchip/atmel-aic... |
273 |
unsigned long flags; |
b1479ebb7 irqchip: atmel-ai... |
274 275 |
unsigned smr; int ret; |
b55a3bb86 irqchip/atmel-aic... |
276 |
if (!bgc) |
b1479ebb7 irqchip: atmel-ai... |
277 278 279 280 281 282 |
return -EINVAL; ret = aic_common_irq_domain_xlate(d, ctrlr, intspec, intsize, out_hwirq, out_type); if (ret) return ret; |
5eb0d6eb3 irqchip/atmel-aic... |
283 |
irq_gc_lock_irqsave(bgc, flags); |
414a431ad irqchip/atmel-aic... |
284 285 |
irq_reg_writel(bgc, *out_hwirq, AT91_AIC5_SSR); smr = irq_reg_readl(bgc, AT91_AIC5_SMR); |
5fd26a0bb irqchip/atmel-aic... |
286 |
aic_common_set_priority(intspec[2], &smr); |
4b5ce20b5 irqchip/atmel-aic... |
287 |
irq_reg_writel(bgc, smr, AT91_AIC5_SMR); |
5eb0d6eb3 irqchip/atmel-aic... |
288 |
irq_gc_unlock_irqrestore(bgc, flags); |
b1479ebb7 irqchip: atmel-ai... |
289 290 291 292 293 294 295 296 |
return ret; } static const struct irq_domain_ops aic5_irq_ops = { .map = irq_map_generic_chip, .xlate = aic5_irq_domain_xlate, }; |
0a46230bf irqchip/atmel-aic... |
297 |
static void __init sama5d3_aic_irq_fixup(void) |
6704d12d6 irqchip: atmel-ai... |
298 |
{ |
0a46230bf irqchip/atmel-aic... |
299 |
aic_common_rtc_irq_fixup(); |
6704d12d6 irqchip: atmel-ai... |
300 |
} |
293953d60 irqchip/atmel-aic... |
301 302 303 304 305 |
static void __init sam9x60_aic_irq_fixup(void) { aic_common_rtc_irq_fixup(); aic_common_rtt_irq_fixup(); } |
c376023b7 irqchip: Appropri... |
306 |
static const struct of_device_id aic5_irq_fixups[] __initconst = { |
6704d12d6 irqchip: atmel-ai... |
307 |
{ .compatible = "atmel,sama5d3", .data = sama5d3_aic_irq_fixup }, |
20afdeb81 irqchip: atmel-ai... |
308 |
{ .compatible = "atmel,sama5d4", .data = sama5d3_aic_irq_fixup }, |
293953d60 irqchip/atmel-aic... |
309 |
{ .compatible = "microchip,sam9x60", .data = sam9x60_aic_irq_fixup }, |
6704d12d6 irqchip: atmel-ai... |
310 311 |
{ /* sentinel */ }, }; |
b1479ebb7 irqchip: atmel-ai... |
312 313 314 315 316 317 318 319 320 321 322 323 324 325 326 327 |
static int __init aic5_of_init(struct device_node *node, struct device_node *parent, int nirqs) { struct irq_chip_generic *gc; struct irq_domain *domain; int nchips; int i; if (nirqs > NR_AIC5_IRQS) return -EINVAL; if (aic5_domain) return -EEXIST; domain = aic_common_of_init(node, &aic5_irq_ops, "atmel-aic5", |
dd85c7915 irqchip/atmel-aic... |
328 |
nirqs, aic5_irq_fixups); |
b1479ebb7 irqchip: atmel-ai... |
329 330 331 332 333 334 335 336 337 338 339 340 341 342 343 344 345 346 347 348 349 350 351 |
if (IS_ERR(domain)) return PTR_ERR(domain); aic5_domain = domain; nchips = aic5_domain->revmap_size / 32; for (i = 0; i < nchips; i++) { gc = irq_get_domain_generic_chip(domain, i * 32); gc->chip_types[0].regs.eoi = AT91_AIC5_EOICR; gc->chip_types[0].chip.irq_mask = aic5_mask; gc->chip_types[0].chip.irq_unmask = aic5_unmask; gc->chip_types[0].chip.irq_retrigger = aic5_retrigger; gc->chip_types[0].chip.irq_set_type = aic5_set_type; gc->chip_types[0].chip.irq_suspend = aic5_suspend; gc->chip_types[0].chip.irq_resume = aic5_resume; gc->chip_types[0].chip.irq_pm_shutdown = aic5_pm_shutdown; } aic5_hw_init(domain); set_handle_irq(aic5_handle); return 0; } |
62a993df3 irqchip: atmel-ai... |
352 353 354 355 356 |
#define NR_SAMA5D2_IRQS 77 static int __init sama5d2_aic5_of_init(struct device_node *node, struct device_node *parent) { |
a50ac562e irqchip/atmel-aic... |
357 358 359 360 361 362 |
#ifdef CONFIG_PM smr_cache = kcalloc(DIV_ROUND_UP(NR_SAMA5D2_IRQS, 32) * 32, sizeof(*smr_cache), GFP_KERNEL); if (!smr_cache) return -ENOMEM; #endif |
62a993df3 irqchip: atmel-ai... |
363 364 365 |
return aic5_of_init(node, parent, NR_SAMA5D2_IRQS); } IRQCHIP_DECLARE(sama5d2_aic5, "atmel,sama5d2-aic", sama5d2_aic5_of_init); |
0cae165ff irqchip: atmel-ai... |
366 |
#define NR_SAMA5D3_IRQS 48 |
b1479ebb7 irqchip: atmel-ai... |
367 368 369 370 371 372 373 |
static int __init sama5d3_aic5_of_init(struct device_node *node, struct device_node *parent) { return aic5_of_init(node, parent, NR_SAMA5D3_IRQS); } IRQCHIP_DECLARE(sama5d3_aic5, "atmel,sama5d3-aic", sama5d3_aic5_of_init); |
20afdeb81 irqchip: atmel-ai... |
374 375 376 377 378 379 380 381 382 |
#define NR_SAMA5D4_IRQS 68 static int __init sama5d4_aic5_of_init(struct device_node *node, struct device_node *parent) { return aic5_of_init(node, parent, NR_SAMA5D4_IRQS); } IRQCHIP_DECLARE(sama5d4_aic5, "atmel,sama5d4-aic", sama5d4_aic5_of_init); |
212fbf2c9 irqchip/atmel-aic... |
383 384 385 386 387 388 389 390 391 |
#define NR_SAM9X60_IRQS 50 static int __init sam9x60_aic5_of_init(struct device_node *node, struct device_node *parent) { return aic5_of_init(node, parent, NR_SAM9X60_IRQS); } IRQCHIP_DECLARE(sam9x60_aic5, "microchip,sam9x60-aic", sam9x60_aic5_of_init); |