[MIPS] PMC MSP71xx core platform

Patch to add core platform support for the PMC-Sierra MSP71xx devices.

Signed-off-by: Marc St-Jean <Marc_St-Jean@pmc-sierra.com>
Signed-off-by: Ralf Baechle <ralf@linux-mips.org>

1 files changed, 124 insertions, 0 deletions

diff --git a/arch/mips/pmc-sierra/msp71xx/msp_irq.c b/arch/mips/pmc-sierra/msp71xx/msp_irq.c
new file mode 100644
index 000000000000..734d598a2e3a
--- /dev/null
+++ b/arch/mips/pmc-sierra/msp71xx/msp_irq.c
@@ -0,0 +1,124 @@
+/*
+ * IRQ vector handles
+ *
+ * Copyright (C) 1995, 1996, 1997, 2003 by Ralf Baechle
+ *
+ * This file is subject to the terms and conditions of the GNU General Public
+ * License.  See the file "COPYING" in the main directory of this archive
+ * for more details.
+ */
+
+#include <linux/kernel.h>
+#include <linux/init.h>
+#include <linux/irq.h>
+#include <linux/interrupt.h>
+#include <linux/ptrace.h>
+#include <linux/time.h>
+
+#include <asm/irq_cpu.h>
+
+#include <msp_int.h>
+
+extern void msp_int_handle(void);
+
+/* SLP bases systems */
+extern void msp_slp_irq_init(void);
+extern void msp_slp_irq_dispatch(void);
+
+/* CIC based systems */
+extern void msp_cic_irq_init(void);
+extern void msp_cic_irq_dispatch(void);
+
+/*
+ * The PMC-Sierra MSP interrupts are arranged in a 3 level cascaded
+ * hierarchical system.  The first level are the direct MIPS interrupts
+ * and are assigned the interrupt range 0-7.  The second level is the SLM
+ * interrupt controller and is assigned the range 8-39.  The third level
+ * comprises the Peripherial block, the PCI block, the PCI MSI block and
+ * the SLP.  The PCI interrupts and the SLP errors are handled by the
+ * relevant subsystems so the core interrupt code needs only concern
+ * itself with the Peripheral block.  These are assigned interrupts in
+ * the range 40-71.
+ */
+
+asmlinkage void plat_irq_dispatch(struct pt_regs *regs)
+{
+        u32 pending;
+
+        pending = read_c0_status() & read_c0_cause();
+
+        /*
+         * jump to the correct interrupt routine
+         * These are arranged in priority order and the timer
+         * comes first!
+         */
+
+#ifdef CONFIG_IRQ_MSP_CIC       /* break out the CIC stuff for now */
+        if (pending & C_IRQ4)   /* do the peripherals first, that's the timer */
+                msp_cic_irq_dispatch();
+
+        else if (pending & C_IRQ0)
+                do_IRQ(MSP_INT_MAC0);
+
+        else if (pending & C_IRQ1)
+                do_IRQ(MSP_INT_MAC1);
+
+        else if (pending & C_IRQ2)
+                do_IRQ(MSP_INT_USB);
+
+        else if (pending & C_IRQ3)
+                do_IRQ(MSP_INT_SAR);
+
+        else if (pending & C_IRQ5)
+                do_IRQ(MSP_INT_SEC);
+
+#else
+        if (pending & C_IRQ5)
+                do_IRQ(MSP_INT_TIMER);
+
+        else if (pending & C_IRQ0)
+                do_IRQ(MSP_INT_MAC0);
+
+        else if (pending & C_IRQ1)
+                do_IRQ(MSP_INT_MAC1);
+
+        else if (pending & C_IRQ3)
+                do_IRQ(MSP_INT_VE);
+
+        else if (pending & C_IRQ4)
+                msp_slp_irq_dispatch();
+#endif
+
+        else if (pending & C_SW0)       /* do software after hardware */
+                do_IRQ(MSP_INT_SW0);
+
+        else if (pending & C_SW1)
+                do_IRQ(MSP_INT_SW1);
+}
+
+static struct irqaction cascade_msp = {
+        .handler = no_action,
+        .name    = "MSP cascade"
+};
+
+
+void __init arch_init_irq(void)
+{
+        /* initialize the 1st-level CPU based interrupt controller */
+        mips_cpu_irq_init();
+
+#ifdef CONFIG_IRQ_MSP_CIC
+        msp_cic_irq_init();
+
+        /* setup the cascaded interrupts */
+        setup_irq(MSP_INT_CIC, &cascade_msp);
+        setup_irq(MSP_INT_PER, &cascade_msp);
+#else
+        /* setup the 2nd-level SLP register based interrupt controller */
+        msp_slp_irq_init();
+
+        /* setup the cascaded SLP/PER interrupts */
+        setup_irq(MSP_INT_SLP, &cascade_msp);
+        setup_irq(MSP_INT_PER, &cascade_msp);
+#endif
+}