do not use MULTI_IRQ_HANDLER it is bogus on our platform

[openwrt/staging/chunkeey.git] / target / linux / mcs814x / files-3.3 / arch / arm / mach-mcs814x / include / mach / entry-macro.S

diff --git a/target/linux/mcs814x/files-3.3/arch/arm/mach-mcs814x/include/mach/entry-macro.S b/target/linux/mcs814x/files-3.3/arch/arm/mach-mcs814x/include/mach/entry-macro.S
index 9974dad293325e998809c22a5fe87beb20748b64..eeff72ca643bd9d35df003d1fe55458e75b37261 100644 (file)
--- a/target/linux/mcs814x/files-3.3/arch/arm/mach-mcs814x/include/mach/entry-macro.S
+++ b/target/linux/mcs814x/files-3.3/arch/arm/mach-mcs814x/include/mach/entry-macro.S
@@ -4,3 +4,26 @@
 
                .macro arch_ret_to_user, tmp1, tmp2
                .endm
+
+               .macro  get_irqnr_preamble, base, tmp
+               ldr     \base, =mcs814x_intc_base       @ base virtual address of AIC peripheral
+               ldr     \base, [\base]
+               .endm
+
+               .macro  get_irqnr_and_base, irqnr, irqstat, base, tmp
+               mov     \tmp, #0x40
+               ldr     \irqstat, [\base, \tmp]
+               tst     \irqstat, \irqstat       @ test if no active IRQ's
+               beq     1002f                    @ if no active irqs return with status 0
+               mov     \irqnr, #0               @ start from irq zero
+               mov     \tmp,   #1               @ the mask initially 1
+1001:
+               tst     \irqstat, \tmp           @ and with mask
+               addeq   \irqnr, \irqnr, #1       @ if  zero then add one to nr
+               moveq   \tmp,   \tmp, lsl #1     @ shift mask one to left
+               beq     1001b                    @ if  zero then loop again
+               mov     \irqstat, \tmp           @ save the return mask
+               mov     \tmp, #0x00              @ ICR offset
+               str     \irqstat,  [\base, \tmp] @ clear irq with selected mask
+1002:
+                .endm