Commit | Line | Data |
---|---|---|
1da177e4 | 1 | /* |
a09e64fb | 2 | * arch/arm/mach-integrator/include/mach/entry-macro.S |
1da177e4 LT |
3 | * |
4 | * Low-level IRQ helper macros for Integrator platforms | |
5 | * | |
6 | * This file is licensed under the terms of the GNU General Public | |
7 | * License version 2. This program is licensed "as is" without any | |
8 | * warranty of any kind, whether express or implied. | |
9 | */ | |
a09e64fb | 10 | #include <mach/hardware.h> |
a285edcf | 11 | #include <mach/platform.h> |
a09e64fb | 12 | #include <mach/irqs.h> |
1da177e4 | 13 | |
f80dff9d DW |
14 | .macro get_irqnr_preamble, base, tmp |
15 | .endm | |
16 | ||
1da177e4 LT |
17 | .macro get_irqnr_and_base, irqnr, irqstat, base, tmp |
18 | /* FIXME: should not be using soo many LDRs here */ | |
19 | ldr \base, =IO_ADDRESS(INTEGRATOR_IC_BASE) | |
20 | mov \irqnr, #IRQ_PIC_START | |
21 | ldr \irqstat, [\base, #IRQ_STATUS] @ get masked status | |
22 | ldr \base, =IO_ADDRESS(INTEGRATOR_HDR_BASE) | |
23 | teq \irqstat, #0 | |
24 | ldreq \irqstat, [\base, #(INTEGRATOR_HDR_IC_OFFSET+IRQ_STATUS)] | |
25 | moveq \irqnr, #IRQ_CIC_START | |
26 | ||
27 | 1001: tst \irqstat, #15 | |
28 | bne 1002f | |
29 | add \irqnr, \irqnr, #4 | |
30 | movs \irqstat, \irqstat, lsr #4 | |
31 | bne 1001b | |
32 | 1002: tst \irqstat, #1 | |
33 | bne 1003f | |
34 | add \irqnr, \irqnr, #1 | |
35 | movs \irqstat, \irqstat, lsr #1 | |
36 | bne 1002b | |
37 | 1003: /* EQ will be set if no irqs pending */ | |
38 | .endm | |
39 |