aboutsummaryrefslogtreecommitdiffstats
path: root/arch/arm/mach-at91/irq.c
diff options
context:
space:
mode:
authorJonathan Herman <hermanjl@cs.unc.edu>2013-01-17 16:15:55 -0500
committerJonathan Herman <hermanjl@cs.unc.edu>2013-01-17 16:15:55 -0500
commit8dea78da5cee153b8af9c07a2745f6c55057fe12 (patch)
treea8f4d49d63b1ecc92f2fddceba0655b2472c5bd9 /arch/arm/mach-at91/irq.c
parent406089d01562f1e2bf9f089fd7637009ebaad589 (diff)
Patched in Tegra support.
Diffstat (limited to 'arch/arm/mach-at91/irq.c')
-rw-r--r--arch/arm/mach-at91/irq.c511
1 files changed, 63 insertions, 448 deletions
diff --git a/arch/arm/mach-at91/irq.c b/arch/arm/mach-at91/irq.c
index 8e210262aee..9665265ec75 100644
--- a/arch/arm/mach-at91/irq.c
+++ b/arch/arm/mach-at91/irq.c
@@ -23,226 +23,36 @@
23#include <linux/init.h> 23#include <linux/init.h>
24#include <linux/module.h> 24#include <linux/module.h>
25#include <linux/mm.h> 25#include <linux/mm.h>
26#include <linux/bitmap.h>
27#include <linux/types.h> 26#include <linux/types.h>
28#include <linux/irq.h>
29#include <linux/of.h>
30#include <linux/of_address.h>
31#include <linux/of_irq.h>
32#include <linux/irqdomain.h>
33#include <linux/err.h>
34#include <linux/slab.h>
35 27
36#include <mach/hardware.h> 28#include <mach/hardware.h>
37#include <asm/irq.h> 29#include <asm/irq.h>
38#include <asm/setup.h> 30#include <asm/setup.h>
39 31
40#include <asm/exception.h>
41#include <asm/mach/arch.h> 32#include <asm/mach/arch.h>
42#include <asm/mach/irq.h> 33#include <asm/mach/irq.h>
43#include <asm/mach/map.h> 34#include <asm/mach/map.h>
44 35
45#include "at91_aic.h"
46
47void __iomem *at91_aic_base;
48static struct irq_domain *at91_aic_domain;
49static struct device_node *at91_aic_np;
50static unsigned int n_irqs = NR_AIC_IRQS;
51static unsigned long at91_aic_caps = 0;
52
53/* AIC5 introduces a Source Select Register */
54#define AT91_AIC_CAP_AIC5 (1 << 0)
55#define has_aic5() (at91_aic_caps & AT91_AIC_CAP_AIC5)
56
57#ifdef CONFIG_PM
58
59static unsigned long *wakeups;
60static unsigned long *backups;
61
62#define set_backup(bit) set_bit(bit, backups)
63#define clear_backup(bit) clear_bit(bit, backups)
64
65static int at91_aic_pm_init(void)
66{
67 backups = kzalloc(BITS_TO_LONGS(n_irqs) * sizeof(*backups), GFP_KERNEL);
68 if (!backups)
69 return -ENOMEM;
70
71 wakeups = kzalloc(BITS_TO_LONGS(n_irqs) * sizeof(*backups), GFP_KERNEL);
72 if (!wakeups) {
73 kfree(backups);
74 return -ENOMEM;
75 }
76
77 return 0;
78}
79
80static int at91_aic_set_wake(struct irq_data *d, unsigned value)
81{
82 if (unlikely(d->hwirq >= n_irqs))
83 return -EINVAL;
84
85 if (value)
86 set_bit(d->hwirq, wakeups);
87 else
88 clear_bit(d->hwirq, wakeups);
89
90 return 0;
91}
92
93void at91_irq_suspend(void)
94{
95 int i = 0, bit;
96
97 if (has_aic5()) {
98 /* disable enabled irqs */
99 while ((bit = find_next_bit(backups, n_irqs, i)) < n_irqs) {
100 at91_aic_write(AT91_AIC5_SSR,
101 bit & AT91_AIC5_INTSEL_MSK);
102 at91_aic_write(AT91_AIC5_IDCR, 1);
103 i = bit;
104 }
105 /* enable wakeup irqs */
106 i = 0;
107 while ((bit = find_next_bit(wakeups, n_irqs, i)) < n_irqs) {
108 at91_aic_write(AT91_AIC5_SSR,
109 bit & AT91_AIC5_INTSEL_MSK);
110 at91_aic_write(AT91_AIC5_IECR, 1);
111 i = bit;
112 }
113 } else {
114 at91_aic_write(AT91_AIC_IDCR, *backups);
115 at91_aic_write(AT91_AIC_IECR, *wakeups);
116 }
117}
118
119void at91_irq_resume(void)
120{
121 int i = 0, bit;
122
123 if (has_aic5()) {
124 /* disable wakeup irqs */
125 while ((bit = find_next_bit(wakeups, n_irqs, i)) < n_irqs) {
126 at91_aic_write(AT91_AIC5_SSR,
127 bit & AT91_AIC5_INTSEL_MSK);
128 at91_aic_write(AT91_AIC5_IDCR, 1);
129 i = bit;
130 }
131 /* enable irqs disabled for suspend */
132 i = 0;
133 while ((bit = find_next_bit(backups, n_irqs, i)) < n_irqs) {
134 at91_aic_write(AT91_AIC5_SSR,
135 bit & AT91_AIC5_INTSEL_MSK);
136 at91_aic_write(AT91_AIC5_IECR, 1);
137 i = bit;
138 }
139 } else {
140 at91_aic_write(AT91_AIC_IDCR, *wakeups);
141 at91_aic_write(AT91_AIC_IECR, *backups);
142 }
143}
144
145#else
146static inline int at91_aic_pm_init(void)
147{
148 return 0;
149}
150
151#define set_backup(bit)
152#define clear_backup(bit)
153#define at91_aic_set_wake NULL
154
155#endif /* CONFIG_PM */
156
157asmlinkage void __exception_irq_entry
158at91_aic_handle_irq(struct pt_regs *regs)
159{
160 u32 irqnr;
161 u32 irqstat;
162
163 irqnr = at91_aic_read(AT91_AIC_IVR);
164 irqstat = at91_aic_read(AT91_AIC_ISR);
165
166 /*
167 * ISR value is 0 when there is no current interrupt or when there is
168 * a spurious interrupt
169 */
170 if (!irqstat)
171 at91_aic_write(AT91_AIC_EOICR, 0);
172 else
173 handle_IRQ(irqnr, regs);
174}
175
176asmlinkage void __exception_irq_entry
177at91_aic5_handle_irq(struct pt_regs *regs)
178{
179 u32 irqnr;
180 u32 irqstat;
181
182 irqnr = at91_aic_read(AT91_AIC5_IVR);
183 irqstat = at91_aic_read(AT91_AIC5_ISR);
184
185 if (!irqstat)
186 at91_aic_write(AT91_AIC5_EOICR, 0);
187 else
188 handle_IRQ(irqnr, regs);
189}
190 36
191static void at91_aic_mask_irq(struct irq_data *d) 37static void at91_aic_mask_irq(struct irq_data *d)
192{ 38{
193 /* Disable interrupt on AIC */ 39 /* Disable interrupt on AIC */
194 at91_aic_write(AT91_AIC_IDCR, 1 << d->hwirq); 40 at91_sys_write(AT91_AIC_IDCR, 1 << d->irq);
195 /* Update ISR cache */
196 clear_backup(d->hwirq);
197}
198
199static void __maybe_unused at91_aic5_mask_irq(struct irq_data *d)
200{
201 /* Disable interrupt on AIC5 */
202 at91_aic_write(AT91_AIC5_SSR, d->hwirq & AT91_AIC5_INTSEL_MSK);
203 at91_aic_write(AT91_AIC5_IDCR, 1);
204 /* Update ISR cache */
205 clear_backup(d->hwirq);
206} 41}
207 42
208static void at91_aic_unmask_irq(struct irq_data *d) 43static void at91_aic_unmask_irq(struct irq_data *d)
209{ 44{
210 /* Enable interrupt on AIC */ 45 /* Enable interrupt on AIC */
211 at91_aic_write(AT91_AIC_IECR, 1 << d->hwirq); 46 at91_sys_write(AT91_AIC_IECR, 1 << d->irq);
212 /* Update ISR cache */
213 set_backup(d->hwirq);
214} 47}
215 48
216static void __maybe_unused at91_aic5_unmask_irq(struct irq_data *d) 49unsigned int at91_extern_irq;
217{
218 /* Enable interrupt on AIC5 */
219 at91_aic_write(AT91_AIC5_SSR, d->hwirq & AT91_AIC5_INTSEL_MSK);
220 at91_aic_write(AT91_AIC5_IECR, 1);
221 /* Update ISR cache */
222 set_backup(d->hwirq);
223}
224
225static void at91_aic_eoi(struct irq_data *d)
226{
227 /*
228 * Mark end-of-interrupt on AIC, the controller doesn't care about
229 * the value written. Moreover it's a write-only register.
230 */
231 at91_aic_write(AT91_AIC_EOICR, 0);
232}
233
234static void __maybe_unused at91_aic5_eoi(struct irq_data *d)
235{
236 at91_aic_write(AT91_AIC5_EOICR, 0);
237}
238
239unsigned long *at91_extern_irq;
240 50
241#define is_extern_irq(hwirq) test_bit(hwirq, at91_extern_irq) 51#define is_extern_irq(irq) ((1 << (irq)) & at91_extern_irq)
242 52
243static int at91_aic_compute_srctype(struct irq_data *d, unsigned type) 53static int at91_aic_set_type(struct irq_data *d, unsigned type)
244{ 54{
245 int srctype; 55 unsigned int smr, srctype;
246 56
247 switch (type) { 57 switch (type) {
248 case IRQ_TYPE_LEVEL_HIGH: 58 case IRQ_TYPE_LEVEL_HIGH:
@@ -252,300 +62,105 @@ static int at91_aic_compute_srctype(struct irq_data *d, unsigned type)
252 srctype = AT91_AIC_SRCTYPE_RISING; 62 srctype = AT91_AIC_SRCTYPE_RISING;
253 break; 63 break;
254 case IRQ_TYPE_LEVEL_LOW: 64 case IRQ_TYPE_LEVEL_LOW:
255 if ((d->hwirq == AT91_ID_FIQ) || is_extern_irq(d->hwirq)) /* only supported on external interrupts */ 65 if ((d->irq == AT91_ID_FIQ) || is_extern_irq(d->irq)) /* only supported on external interrupts */
256 srctype = AT91_AIC_SRCTYPE_LOW; 66 srctype = AT91_AIC_SRCTYPE_LOW;
257 else 67 else
258 srctype = -EINVAL; 68 return -EINVAL;
259 break; 69 break;
260 case IRQ_TYPE_EDGE_FALLING: 70 case IRQ_TYPE_EDGE_FALLING:
261 if ((d->hwirq == AT91_ID_FIQ) || is_extern_irq(d->hwirq)) /* only supported on external interrupts */ 71 if ((d->irq == AT91_ID_FIQ) || is_extern_irq(d->irq)) /* only supported on external interrupts */
262 srctype = AT91_AIC_SRCTYPE_FALLING; 72 srctype = AT91_AIC_SRCTYPE_FALLING;
263 else 73 else
264 srctype = -EINVAL; 74 return -EINVAL;
265 break; 75 break;
266 default: 76 default:
267 srctype = -EINVAL; 77 return -EINVAL;
268 }
269
270 return srctype;
271}
272
273static int at91_aic_set_type(struct irq_data *d, unsigned type)
274{
275 unsigned int smr;
276 int srctype;
277
278 srctype = at91_aic_compute_srctype(d, type);
279 if (srctype < 0)
280 return srctype;
281
282 if (has_aic5()) {
283 at91_aic_write(AT91_AIC5_SSR,
284 d->hwirq & AT91_AIC5_INTSEL_MSK);
285 smr = at91_aic_read(AT91_AIC5_SMR) & ~AT91_AIC_SRCTYPE;
286 at91_aic_write(AT91_AIC5_SMR, smr | srctype);
287 } else {
288 smr = at91_aic_read(AT91_AIC_SMR(d->hwirq))
289 & ~AT91_AIC_SRCTYPE;
290 at91_aic_write(AT91_AIC_SMR(d->hwirq), smr | srctype);
291 }
292
293 return 0;
294}
295
296static struct irq_chip at91_aic_chip = {
297 .name = "AIC",
298 .irq_mask = at91_aic_mask_irq,
299 .irq_unmask = at91_aic_unmask_irq,
300 .irq_set_type = at91_aic_set_type,
301 .irq_set_wake = at91_aic_set_wake,
302 .irq_eoi = at91_aic_eoi,
303};
304
305static void __init at91_aic_hw_init(unsigned int spu_vector)
306{
307 int i;
308
309 /*
310 * Perform 8 End Of Interrupt Command to make sure AIC
311 * will not Lock out nIRQ
312 */
313 for (i = 0; i < 8; i++)
314 at91_aic_write(AT91_AIC_EOICR, 0);
315
316 /*
317 * Spurious Interrupt ID in Spurious Vector Register.
318 * When there is no current interrupt, the IRQ Vector Register
319 * reads the value stored in AIC_SPU
320 */
321 at91_aic_write(AT91_AIC_SPU, spu_vector);
322
323 /* No debugging in AIC: Debug (Protect) Control Register */
324 at91_aic_write(AT91_AIC_DCR, 0);
325
326 /* Disable and clear all interrupts initially */
327 at91_aic_write(AT91_AIC_IDCR, 0xFFFFFFFF);
328 at91_aic_write(AT91_AIC_ICCR, 0xFFFFFFFF);
329}
330
331static void __init __maybe_unused at91_aic5_hw_init(unsigned int spu_vector)
332{
333 int i;
334
335 /*
336 * Perform 8 End Of Interrupt Command to make sure AIC
337 * will not Lock out nIRQ
338 */
339 for (i = 0; i < 8; i++)
340 at91_aic_write(AT91_AIC5_EOICR, 0);
341
342 /*
343 * Spurious Interrupt ID in Spurious Vector Register.
344 * When there is no current interrupt, the IRQ Vector Register
345 * reads the value stored in AIC_SPU
346 */
347 at91_aic_write(AT91_AIC5_SPU, spu_vector);
348
349 /* No debugging in AIC: Debug (Protect) Control Register */
350 at91_aic_write(AT91_AIC5_DCR, 0);
351
352 /* Disable and clear all interrupts initially */
353 for (i = 0; i < n_irqs; i++) {
354 at91_aic_write(AT91_AIC5_SSR, i & AT91_AIC5_INTSEL_MSK);
355 at91_aic_write(AT91_AIC5_IDCR, 1);
356 at91_aic_write(AT91_AIC5_ICCR, 1);
357 } 78 }
358}
359
360#if defined(CONFIG_OF)
361static unsigned int *at91_aic_irq_priorities;
362
363static int at91_aic_irq_map(struct irq_domain *h, unsigned int virq,
364 irq_hw_number_t hw)
365{
366 /* Put virq number in Source Vector Register */
367 at91_aic_write(AT91_AIC_SVR(hw), virq);
368
369 /* Active Low interrupt, with priority */
370 at91_aic_write(AT91_AIC_SMR(hw),
371 AT91_AIC_SRCTYPE_LOW | at91_aic_irq_priorities[hw]);
372
373 irq_set_chip_and_handler(virq, &at91_aic_chip, handle_fasteoi_irq);
374 set_irq_flags(virq, IRQF_VALID | IRQF_PROBE);
375 79
80 smr = at91_sys_read(AT91_AIC_SMR(d->irq)) & ~AT91_AIC_SRCTYPE;
81 at91_sys_write(AT91_AIC_SMR(d->irq), smr | srctype);
376 return 0; 82 return 0;
377} 83}
378 84
379static int at91_aic5_irq_map(struct irq_domain *h, unsigned int virq, 85#ifdef CONFIG_PM
380 irq_hw_number_t hw)
381{
382 at91_aic_write(AT91_AIC5_SSR, hw & AT91_AIC5_INTSEL_MSK);
383
384 /* Put virq number in Source Vector Register */
385 at91_aic_write(AT91_AIC5_SVR, virq);
386
387 /* Active Low interrupt, with priority */
388 at91_aic_write(AT91_AIC5_SMR,
389 AT91_AIC_SRCTYPE_LOW | at91_aic_irq_priorities[hw]);
390
391 irq_set_chip_and_handler(virq, &at91_aic_chip, handle_fasteoi_irq);
392 set_irq_flags(virq, IRQF_VALID | IRQF_PROBE);
393 86
394 return 0; 87static u32 wakeups;
395} 88static u32 backups;
396 89
397static int at91_aic_irq_domain_xlate(struct irq_domain *d, struct device_node *ctrlr, 90static int at91_aic_set_wake(struct irq_data *d, unsigned value)
398 const u32 *intspec, unsigned int intsize,
399 irq_hw_number_t *out_hwirq, unsigned int *out_type)
400{ 91{
401 if (WARN_ON(intsize < 3)) 92 if (unlikely(d->irq >= 32))
402 return -EINVAL;
403 if (WARN_ON(intspec[0] >= n_irqs))
404 return -EINVAL;
405 if (WARN_ON((intspec[2] < AT91_AIC_IRQ_MIN_PRIORITY)
406 || (intspec[2] > AT91_AIC_IRQ_MAX_PRIORITY)))
407 return -EINVAL; 93 return -EINVAL;
408 94
409 *out_hwirq = intspec[0]; 95 if (value)
410 *out_type = intspec[1] & IRQ_TYPE_SENSE_MASK; 96 wakeups |= (1 << d->irq);
411 at91_aic_irq_priorities[*out_hwirq] = intspec[2]; 97 else
98 wakeups &= ~(1 << d->irq);
412 99
413 return 0; 100 return 0;
414} 101}
415 102
416static struct irq_domain_ops at91_aic_irq_ops = { 103void at91_irq_suspend(void)
417 .map = at91_aic_irq_map,
418 .xlate = at91_aic_irq_domain_xlate,
419};
420
421int __init at91_aic_of_common_init(struct device_node *node,
422 struct device_node *parent)
423{ 104{
424 struct property *prop; 105 backups = at91_sys_read(AT91_AIC_IMR);
425 const __be32 *p; 106 at91_sys_write(AT91_AIC_IDCR, backups);
426 u32 val; 107 at91_sys_write(AT91_AIC_IECR, wakeups);
427
428 at91_extern_irq = kzalloc(BITS_TO_LONGS(n_irqs)
429 * sizeof(*at91_extern_irq), GFP_KERNEL);
430 if (!at91_extern_irq)
431 return -ENOMEM;
432
433 if (at91_aic_pm_init()) {
434 kfree(at91_extern_irq);
435 return -ENOMEM;
436 }
437
438 at91_aic_irq_priorities = kzalloc(n_irqs
439 * sizeof(*at91_aic_irq_priorities),
440 GFP_KERNEL);
441 if (!at91_aic_irq_priorities)
442 return -ENOMEM;
443
444 at91_aic_base = of_iomap(node, 0);
445 at91_aic_np = node;
446
447 at91_aic_domain = irq_domain_add_linear(at91_aic_np, n_irqs,
448 &at91_aic_irq_ops, NULL);
449 if (!at91_aic_domain)
450 panic("Unable to add AIC irq domain (DT)\n");
451
452 of_property_for_each_u32(node, "atmel,external-irqs", prop, p, val) {
453 if (val >= n_irqs)
454 pr_warn("AIC: external irq %d >= %d skip it\n",
455 val, n_irqs);
456 else
457 set_bit(val, at91_extern_irq);
458 }
459
460 irq_set_default_host(at91_aic_domain);
461
462 return 0;
463} 108}
464 109
465int __init at91_aic_of_init(struct device_node *node, 110void at91_irq_resume(void)
466 struct device_node *parent)
467{ 111{
468 int err; 112 at91_sys_write(AT91_AIC_IDCR, wakeups);
469 113 at91_sys_write(AT91_AIC_IECR, backups);
470 err = at91_aic_of_common_init(node, parent);
471 if (err)
472 return err;
473
474 at91_aic_hw_init(n_irqs);
475
476 return 0;
477} 114}
478 115
479int __init at91_aic5_of_init(struct device_node *node, 116#else
480 struct device_node *parent) 117#define at91_aic_set_wake NULL
481{
482 int err;
483
484 at91_aic_caps |= AT91_AIC_CAP_AIC5;
485 n_irqs = NR_AIC5_IRQS;
486 at91_aic_chip.irq_ack = at91_aic5_mask_irq;
487 at91_aic_chip.irq_mask = at91_aic5_mask_irq;
488 at91_aic_chip.irq_unmask = at91_aic5_unmask_irq;
489 at91_aic_chip.irq_eoi = at91_aic5_eoi;
490 at91_aic_irq_ops.map = at91_aic5_irq_map;
491
492 err = at91_aic_of_common_init(node, parent);
493 if (err)
494 return err;
495
496 at91_aic5_hw_init(n_irqs);
497
498 return 0;
499}
500#endif 118#endif
501 119
120static struct irq_chip at91_aic_chip = {
121 .name = "AIC",
122 .irq_ack = at91_aic_mask_irq,
123 .irq_mask = at91_aic_mask_irq,
124 .irq_unmask = at91_aic_unmask_irq,
125 .irq_set_type = at91_aic_set_type,
126 .irq_set_wake = at91_aic_set_wake,
127};
128
502/* 129/*
503 * Initialize the AIC interrupt controller. 130 * Initialize the AIC interrupt controller.
504 */ 131 */
505void __init at91_aic_init(unsigned int *priority, unsigned int ext_irq_mask) 132void __init at91_aic_init(unsigned int priority[NR_AIC_IRQS])
506{ 133{
507 unsigned int i; 134 unsigned int i;
508 int irq_base;
509
510 at91_extern_irq = kzalloc(BITS_TO_LONGS(n_irqs)
511 * sizeof(*at91_extern_irq), GFP_KERNEL);
512
513 if (at91_aic_pm_init() || at91_extern_irq == NULL)
514 panic("Unable to allocate bit maps\n");
515
516 *at91_extern_irq = ext_irq_mask;
517
518 at91_aic_base = ioremap(AT91_AIC, 512);
519 if (!at91_aic_base)
520 panic("Unable to ioremap AIC registers\n");
521
522 /* Add irq domain for AIC */
523 irq_base = irq_alloc_descs(-1, 0, n_irqs, 0);
524 if (irq_base < 0) {
525 WARN(1, "Cannot allocate irq_descs, assuming pre-allocated\n");
526 irq_base = 0;
527 }
528 at91_aic_domain = irq_domain_add_legacy(at91_aic_np, n_irqs,
529 irq_base, 0,
530 &irq_domain_simple_ops, NULL);
531
532 if (!at91_aic_domain)
533 panic("Unable to add AIC irq domain\n");
534
535 irq_set_default_host(at91_aic_domain);
536 135
537 /* 136 /*
538 * The IVR is used by macro get_irqnr_and_base to read and verify. 137 * The IVR is used by macro get_irqnr_and_base to read and verify.
539 * The irq number is NR_AIC_IRQS when a spurious interrupt has occurred. 138 * The irq number is NR_AIC_IRQS when a spurious interrupt has occurred.
540 */ 139 */
541 for (i = 0; i < n_irqs; i++) { 140 for (i = 0; i < NR_AIC_IRQS; i++) {
542 /* Put hardware irq number in Source Vector Register: */ 141 /* Put irq number in Source Vector Register: */
543 at91_aic_write(AT91_AIC_SVR(i), NR_IRQS_LEGACY + i); 142 at91_sys_write(AT91_AIC_SVR(i), i);
544 /* Active Low interrupt, with the specified priority */ 143 /* Active Low interrupt, with the specified priority */
545 at91_aic_write(AT91_AIC_SMR(i), AT91_AIC_SRCTYPE_LOW | priority[i]); 144 at91_sys_write(AT91_AIC_SMR(i), AT91_AIC_SRCTYPE_LOW | priority[i]);
546 irq_set_chip_and_handler(NR_IRQS_LEGACY + i, &at91_aic_chip, handle_fasteoi_irq); 145
146 irq_set_chip_and_handler(i, &at91_aic_chip, handle_level_irq);
547 set_irq_flags(i, IRQF_VALID | IRQF_PROBE); 147 set_irq_flags(i, IRQF_VALID | IRQF_PROBE);
148
149 /* Perform 8 End Of Interrupt Command to make sure AIC will not Lock out nIRQ */
150 if (i < 8)
151 at91_sys_write(AT91_AIC_EOICR, 0);
548 } 152 }
549 153
550 at91_aic_hw_init(n_irqs); 154 /*
155 * Spurious Interrupt ID in Spurious Vector Register is NR_AIC_IRQS
156 * When there is no current interrupt, the IRQ Vector Register reads the value stored in AIC_SPU
157 */
158 at91_sys_write(AT91_AIC_SPU, NR_AIC_IRQS);
159
160 /* No debugging in AIC: Debug (Protect) Control Register */
161 at91_sys_write(AT91_AIC_DCR, 0);
162
163 /* Disable and clear all interrupts initially */
164 at91_sys_write(AT91_AIC_IDCR, 0xFFFFFFFF);
165 at91_sys_write(AT91_AIC_ICCR, 0xFFFFFFFF);
551} 166}