1 files changed, 56 insertions, 0 deletions

diff --git a/include/asm-arm/arch-iop3xx/entry-macro.S b/include/asm-arm/arch-iop3xx/entry-macro.S
new file mode 100644
index 000000000000..e2ce7f5467c8
--- /dev/null
+++ b/include/asm-arm/arch-iop3xx/entry-macro.S
@@ -0,0 +1,56 @@
+/*
+ * include/asm-arm/arch-iop3xx/entry-macro.S
+ *
+ * Low-level IRQ helper macros for IOP3xx-based platforms
+ *
+ * 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.
+ */
+
+#if defined(CONFIG_ARCH_IOP321)
+                .macro  disable_fiq
+                .endm
+
+                /*
+                 * Note: only deal with normal interrupts, not FIQ
+                 */
+                .macro  get_irqnr_and_base, irqnr, irqstat, base, tmp
+                mov     \irqnr, #0
+                mrc     p6, 0, \irqstat, c8, c0, 0      @ Read IINTSRC
+                cmp     \irqstat, #0
+                beq     1001f
+                clz     \irqnr, \irqstat
+                mov     \base, #31
+                subs    \irqnr,\base,\irqnr
+                add     \irqnr,\irqnr,#IRQ_IOP321_DMA0_EOT
+1001:
+                .endm
+
+#elif defined(CONFIG_ARCH_IOP331)
+                .macro  disable_fiq
+                .endm
+
+                /*
+                 * Note: only deal with normal interrupts, not FIQ
+                 */
+                .macro  get_irqnr_and_base, irqnr, irqstat, base, tmp
+                mov     \irqnr, #0
+                mrc     p6, 0, \irqstat, c4, c0, 0      @ Read IINTSRC0
+                cmp     \irqstat, #0
+                bne     1002f
+                mrc     p6, 0, \irqstat, c5, c0, 0      @ Read IINTSRC1
+                cmp     \irqstat, #0
+                beq     1001f
+                clz     \irqnr, \irqstat
+                rsbs    \irqnr,\irqnr,#31   @ recommend by RMK
+                add     \irqnr,\irqnr,#IRQ_IOP331_XINT8
+                b       1001f
+1002:   clz     \irqnr, \irqstat
+                rsbs    \irqnr,\irqnr,#31   @ recommend by RMK
+                add     \irqnr,\irqnr,#IRQ_IOP331_DMA0_EOT
+1001:
+                .endm
+
+#endif
+