powerpc/mpic: Add ability to reset a core via MPIC

We need the ability to reset cores for use with kexec/kdump for
SMP systems. Calling this function with the specific core you want
to reset will cause the CPU to spin in reset.

Signed-off-by: Matthew McClintock <msm@freescale.com>
Signed-off-by: Benjamin Herrenschmidt <benh@kernel.crashing.org>

1 files changed, 18 insertions, 0 deletions

diff --git a/arch/powerpc/sysdev/mpic.c b/arch/powerpc/sysdev/mpic.c
index 20b73c025a45..7c1342618a30 100644
--- a/arch/powerpc/sysdev/mpic.c
+++ b/arch/powerpc/sysdev/mpic.c
@@ -1636,6 +1636,24 @@ void __devinit smp_mpic_setup_cpu(int cpu)
 {
         mpic_setup_this_cpu();
 }
+
+void mpic_reset_core(int cpu)
+{
+        struct mpic *mpic = mpic_primary;
+        u32 pir;
+        int cpuid = get_hard_smp_processor_id(cpu);
+
+        /* Set target bit for core reset */
+        pir = mpic_read(mpic->gregs, MPIC_INFO(GREG_PROCESSOR_INIT));
+        pir |= (1 << cpuid);
+        mpic_write(mpic->gregs, MPIC_INFO(GREG_PROCESSOR_INIT), pir);
+        mpic_read(mpic->gregs, MPIC_INFO(GREG_PROCESSOR_INIT));
+
+        /* Restore target bit after reset complete */
+        pir &= ~(1 << cpuid);
+        mpic_write(mpic->gregs, MPIC_INFO(GREG_PROCESSOR_INIT), pir);
+        mpic_read(mpic->gregs, MPIC_INFO(GREG_PROCESSOR_INIT));
+}
 #endif /* CONFIG_SMP */
 
 #ifdef CONFIG_PM