config MIPS_CMP
        bool "MIPS CMP support"
        depends on SYS_SUPPORTS_MIPS_CMP && MIPS_MT_SMP
+       select MIPS_GIC_IPI
        select SYNC_R4K
        select WEAK_ORDERING
        default n
        help
          Enable Coherency Manager processor (CMP) support.
 
+config MIPS_GIC_IPI
+       bool
+
 config SB1_PASS_1_WORKAROUNDS
        bool
        depends on CPU_SB1_PASS_1
 
 
 #endif /* !CONFIG_SMP */
 
+extern void gic_send_ipi_single(int cpu, unsigned int action);
+extern void gic_send_ipi_mask(const struct cpumask *mask, unsigned int action);
+
 static inline int register_up_smp_ops(void)
 {
 #ifdef CONFIG_SMP_UP
 
 obj-$(CONFIG_MIPS_MT_SMTC)     += smtc.o smtc-asm.o smtc-proc.o
 obj-$(CONFIG_MIPS_MT_SMP)      += smp-mt.o
 obj-$(CONFIG_MIPS_CMP)         += smp-cmp.o
+obj-$(CONFIG_MIPS_GIC_IPI)     += smp-gic.o
 obj-$(CONFIG_CPU_MIPSR2)       += spram.o
 
 obj-$(CONFIG_MIPS_VPE_LOADER)  += vpe.o
 
 #include <asm/amon.h>
 #include <asm/gic.h>
 
-static void ipi_call_function(unsigned int cpu)
-{
-       pr_debug("CPU%d: %s cpu %d status %08x\n",
-                smp_processor_id(), __func__, cpu, read_c0_status());
-
-       gic_send_ipi(plat_ipi_call_int_xlate(cpu));
-}
-
-
-static void ipi_resched(unsigned int cpu)
-{
-       pr_debug("CPU%d: %s cpu %d status %08x\n",
-                smp_processor_id(), __func__, cpu, read_c0_status());
-
-       gic_send_ipi(plat_ipi_resched_int_xlate(cpu));
-}
-
-/*
- * FIXME: This isn't restricted to CMP
- * The SMVP kernel could use GIC interrupts if available
- */
-void cmp_send_ipi_single(int cpu, unsigned int action)
-{
-       unsigned long flags;
-
-       local_irq_save(flags);
-
-       switch (action) {
-       case SMP_CALL_FUNCTION:
-               ipi_call_function(cpu);
-               break;
-
-       case SMP_RESCHEDULE_YOURSELF:
-               ipi_resched(cpu);
-               break;
-       }
-
-       local_irq_restore(flags);
-}
-
-static void cmp_send_ipi_mask(const struct cpumask *mask, unsigned int action)
-{
-       unsigned int i;
-
-       for_each_cpu(i, mask)
-               cmp_send_ipi_single(i, action);
-}
-
 static void cmp_init_secondary(void)
 {
        struct cpuinfo_mips *c = ¤t_cpu_data;
 }
 
 struct plat_smp_ops cmp_smp_ops = {
-       .send_ipi_single        = cmp_send_ipi_single,
-       .send_ipi_mask          = cmp_send_ipi_mask,
+       .send_ipi_single        = gic_send_ipi_single,
+       .send_ipi_mask          = gic_send_ipi_mask,
        .init_secondary         = cmp_init_secondary,
        .smp_finish             = cmp_smp_finish,
        .cpus_done              = cmp_cpus_done,
 
--- /dev/null
+/*
+ * Copyright (C) 2013 Imagination Technologies
+ * Author: Paul Burton <paul.burton@imgtec.com>
+ *
+ * Based on smp-cmp.c:
+ *  Copyright (C) 2007 MIPS Technologies, Inc.
+ *  Author: Chris Dearman (chris@mips.com)
+ *
+ * This program is free software; you can redistribute it and/or modify it
+ * under the terms of the GNU General Public License as published by the
+ * Free Software Foundation;  either version 2 of the  License, or (at your
+ * option) any later version.
+ */
+
+#include <linux/printk.h>
+
+#include <asm/gic.h>
+#include <asm/smp-ops.h>
+
+void gic_send_ipi_single(int cpu, unsigned int action)
+{
+       unsigned long flags;
+       unsigned int intr;
+
+       pr_debug("CPU%d: %s cpu %d action %u status %08x\n",
+                smp_processor_id(), __func__, cpu, action, read_c0_status());
+
+       local_irq_save(flags);
+
+       switch (action) {
+       case SMP_CALL_FUNCTION:
+               intr = plat_ipi_call_int_xlate(cpu);
+               break;
+
+       case SMP_RESCHEDULE_YOURSELF:
+               intr = plat_ipi_resched_int_xlate(cpu);
+               break;
+
+       default:
+               BUG();
+       }
+
+       gic_send_ipi(intr);
+       local_irq_restore(flags);
+}
+
+void gic_send_ipi_mask(const struct cpumask *mask, unsigned int action)
+{
+       unsigned int i;
+
+       for_each_cpu(i, mask)
+               gic_send_ipi_single(i, action);
+}