[ARM] mmp: add support for Marvell MMP2

Marvell MMP2 (aka ARMADA610) is a SoC based on PJ4 core. It's
ARMv6 compatible.  Support basic interrupt handler and timer,
and basic support for MMP2 based FLINT platform.

Signed-off-by: Haojian Zhuang <haojian.zhuang@marvell.com>
Signed-off-by: Eric Miao <eric.y.miao@gmail.com>

1 files changed, 6 insertions, 1 deletions

diff --git a/arch/arm/mach-mmp/include/mach/entry-macro.S b/arch/arm/mach-mmp/include/mach/entry-macro.S
index 6d3cd35478b5..c42d9d4e892d 100644
--- a/arch/arm/mach-mmp/include/mach/entry-macro.S
+++ b/arch/arm/mach-mmp/include/mach/entry-macro.S
@@ -15,7 +15,12 @@
         .endm
 
         .macro  get_irqnr_preamble, base, tmp
-        ldr     \base, =ICU_AP_IRQ_SEL_INT_NUM
+        mrc     p15, 0, \tmp, c0, c0, 0         @ CPUID
+        and     \tmp, \tmp, #0xff00
+        cmp     \tmp, #0x5800
+        ldr     \base, =ICU_VIRT_BASE
+        addne   \base, \base, #0x10c            @ PJ1 AP INT SEL register
+        addeq   \base, \base, #0x104            @ PJ4 IRQ SEL register
         .endm
 
         .macro  get_irqnr_and_base, irqnr, irqstat, base, tmp