5cccd37e |
1 | /* |
2 | * Freescale STMP37XX/STMP378X common interrupt handling code |
3 | * |
4 | * Author: Vladislav Buzov <vbuzov@embeddedalley.com> |
5 | * |
6 | * Copyright 2008 Freescale Semiconductor, Inc. All Rights Reserved. |
7 | * Copyright 2008 Embedded Alley Solutions, Inc All Rights Reserved. |
8 | */ |
9 | |
10 | /* |
11 | * The code contained herein is licensed under the GNU General Public |
12 | * License. You may obtain a copy of the GNU General Public License |
13 | * Version 2 or later at the following locations: |
14 | * |
15 | * http://www.opensource.org/licenses/gpl-license.html |
16 | * http://www.gnu.org/copyleft/gpl.html |
17 | */ |
18 | #include <linux/init.h> |
19 | #include <linux/interrupt.h> |
20 | #include <linux/delay.h> |
21 | #include <linux/irq.h> |
22 | #include <linux/sysdev.h> |
23 | |
24 | #include <mach/stmp3xxx.h> |
98f420b2 |
25 | #include <mach/platform.h> |
5cccd37e |
26 | #include <mach/regs-icoll.h> |
27 | |
28 | void __init stmp3xxx_init_irq(struct irq_chip *chip) |
29 | { |
98f420b2 |
30 | unsigned int i, lv; |
5cccd37e |
31 | |
32 | /* Reset the interrupt controller */ |
98f420b2 |
33 | stmp3xxx_reset_block(REGS_ICOLL_BASE + HW_ICOLL_CTRL, true); |
5cccd37e |
34 | |
35 | /* Disable all interrupts initially */ |
36 | for (i = 0; i < NR_REAL_IRQS; i++) { |
5b88128f |
37 | chip->irq_mask(irq_get_irq_data(i)); |
f38c02f3 |
38 | irq_set_chip_and_handler(i, chip, handle_level_irq); |
5cccd37e |
39 | set_irq_flags(i, IRQF_VALID | IRQF_PROBE); |
40 | } |
41 | |
42 | /* Ensure vector is cleared */ |
98f420b2 |
43 | for (lv = 0; lv < 4; lv++) |
44 | __raw_writel(1 << lv, REGS_ICOLL_BASE + HW_ICOLL_LEVELACK); |
45 | __raw_writel(0, REGS_ICOLL_BASE + HW_ICOLL_VECTOR); |
5cccd37e |
46 | |
5cccd37e |
47 | /* Barrier */ |
98f420b2 |
48 | (void)__raw_readl(REGS_ICOLL_BASE + HW_ICOLL_STAT); |
5cccd37e |
49 | } |
50 | |