|
@@ -22,6 +22,7 @@
|
|
|
#include <linux/of_address.h>
|
|
|
|
|
|
#include <asm/cacheflush.h>
|
|
|
+#include <asm/cp15.h>
|
|
|
#include <asm/smp_plat.h>
|
|
|
#include <asm/smp_scu.h>
|
|
|
#include <asm/firmware.h>
|
|
@@ -33,6 +34,54 @@
|
|
|
|
|
|
extern void exynos4_secondary_startup(void);
|
|
|
|
|
|
+#ifdef CONFIG_HOTPLUG_CPU
|
|
|
+static inline void cpu_leave_lowpower(void)
|
|
|
+{
|
|
|
+ unsigned int v;
|
|
|
+
|
|
|
+ asm volatile(
|
|
|
+ "mrc p15, 0, %0, c1, c0, 0\n"
|
|
|
+ " orr %0, %0, %1\n"
|
|
|
+ " mcr p15, 0, %0, c1, c0, 0\n"
|
|
|
+ " mrc p15, 0, %0, c1, c0, 1\n"
|
|
|
+ " orr %0, %0, %2\n"
|
|
|
+ " mcr p15, 0, %0, c1, c0, 1\n"
|
|
|
+ : "=&r" (v)
|
|
|
+ : "Ir" (CR_C), "Ir" (0x40)
|
|
|
+ : "cc");
|
|
|
+}
|
|
|
+
|
|
|
+static inline void platform_do_lowpower(unsigned int cpu, int *spurious)
|
|
|
+{
|
|
|
+ u32 mpidr = cpu_logical_map(cpu);
|
|
|
+ u32 core_id = MPIDR_AFFINITY_LEVEL(mpidr, 0);
|
|
|
+
|
|
|
+ for (;;) {
|
|
|
+
|
|
|
+ /* Turn the CPU off on next WFI instruction. */
|
|
|
+ exynos_cpu_power_down(core_id);
|
|
|
+
|
|
|
+ wfi();
|
|
|
+
|
|
|
+ if (pen_release == core_id) {
|
|
|
+ /*
|
|
|
+ * OK, proper wakeup, we're done
|
|
|
+ */
|
|
|
+ break;
|
|
|
+ }
|
|
|
+
|
|
|
+ /*
|
|
|
+ * Getting here, means that we have come out of WFI without
|
|
|
+ * having been woken up - this shouldn't happen
|
|
|
+ *
|
|
|
+ * Just note it happening - when we're woken, we can report
|
|
|
+ * its occurrence.
|
|
|
+ */
|
|
|
+ (*spurious)++;
|
|
|
+ }
|
|
|
+}
|
|
|
+#endif /* CONFIG_HOTPLUG_CPU */
|
|
|
+
|
|
|
/**
|
|
|
* exynos_core_power_down : power down the specified cpu
|
|
|
* @cpu : the cpu to power down
|
|
@@ -318,6 +367,31 @@ static void __init exynos_smp_prepare_cpus(unsigned int max_cpus)
|
|
|
}
|
|
|
}
|
|
|
|
|
|
+#ifdef CONFIG_HOTPLUG_CPU
|
|
|
+/*
|
|
|
+ * platform-specific code to shutdown a CPU
|
|
|
+ *
|
|
|
+ * Called with IRQs disabled
|
|
|
+ */
|
|
|
+static void __ref exynos_cpu_die(unsigned int cpu)
|
|
|
+{
|
|
|
+ int spurious = 0;
|
|
|
+
|
|
|
+ v7_exit_coherency_flush(louis);
|
|
|
+
|
|
|
+ platform_do_lowpower(cpu, &spurious);
|
|
|
+
|
|
|
+ /*
|
|
|
+ * bring this CPU back into the world of cache
|
|
|
+ * coherency, and then restore interrupts
|
|
|
+ */
|
|
|
+ cpu_leave_lowpower();
|
|
|
+
|
|
|
+ if (spurious)
|
|
|
+ pr_warn("CPU%u: %u spurious wakeup calls\n", cpu, spurious);
|
|
|
+}
|
|
|
+#endif /* CONFIG_HOTPLUG_CPU */
|
|
|
+
|
|
|
struct smp_operations exynos_smp_ops __initdata = {
|
|
|
.smp_init_cpus = exynos_smp_init_cpus,
|
|
|
.smp_prepare_cpus = exynos_smp_prepare_cpus,
|