2 files changed, 22 insertions, 3 deletions

diff --git a/arch/arm/mach-exynos/platsmp.c b/arch/arm/mach-exynos/platsmp.c
index 3f32c47a6d74..511b81ac2a18 100644
--- a/arch/arm/mach-exynos/platsmp.c
+++ b/arch/arm/mach-exynos/platsmp.c
@@ -126,6 +126,8 @@ static inline void platform_do_lowpower(unsigned int cpu, int *spurious)
  */
 void exynos_cpu_power_down(int cpu)
 {
+        u32 core_conf;
+
         if (cpu == 0 && (of_machine_is_compatible("samsung,exynos5420") ||
                 of_machine_is_compatible("samsung,exynos5800"))) {
                 /*
@@ -138,7 +140,10 @@ void exynos_cpu_power_down(int cpu)
                 if (!(val & S5P_CORE_LOCAL_PWR_EN))
                         return;
         }
-        pmu_raw_writel(0, EXYNOS_ARM_CORE_CONFIGURATION(cpu));
+
+        core_conf = pmu_raw_readl(EXYNOS_ARM_CORE_CONFIGURATION(cpu));
+        core_conf &= ~S5P_CORE_LOCAL_PWR_EN;
+        pmu_raw_writel(core_conf, EXYNOS_ARM_CORE_CONFIGURATION(cpu));
 }
 
 /**
@@ -149,7 +154,12 @@ void exynos_cpu_power_down(int cpu)
  */
 void exynos_cpu_power_up(int cpu)
 {
-        pmu_raw_writel(S5P_CORE_LOCAL_PWR_EN,
+        u32 core_conf = S5P_CORE_LOCAL_PWR_EN;
+
+        if (soc_is_exynos3250())
+                core_conf |= S5P_CORE_AUTOWAKEUP_EN;
+
+        pmu_raw_writel(core_conf,
                         EXYNOS_ARM_CORE_CONFIGURATION(cpu));
 }
 
@@ -227,6 +237,10 @@ static void exynos_core_restart(u32 core_id)
         if (!of_machine_is_compatible("samsung,exynos3250"))
                 return;
 
+        while (!pmu_raw_readl(S5P_PMU_SPARE2))
+                udelay(10);
+        udelay(10);
+
         val = pmu_raw_readl(EXYNOS_ARM_CORE_STATUS(core_id));
         val |= S5P_CORE_WAKEUP_FROM_LOCAL_CFG;
         pmu_raw_writel(val, EXYNOS_ARM_CORE_STATUS(core_id));
@@ -347,7 +361,10 @@ static int exynos_boot_secondary(unsigned int cpu, struct task_struct *idle)
 
                 call_firmware_op(cpu_boot, core_id);
 
-                arch_send_wakeup_ipi_mask(cpumask_of(cpu));
+                if (soc_is_exynos3250())
+                        dsb_sev();
+                else
+                        arch_send_wakeup_ipi_mask(cpumask_of(cpu));
 
                 if (pen_release == -1)
                         break;
diff --git a/arch/arm/mach-exynos/regs-pmu.h b/arch/arm/mach-exynos/regs-pmu.h
index eb461e1c325a..84ddce142ab1 100644
--- a/arch/arm/mach-exynos/regs-pmu.h
+++ b/arch/arm/mach-exynos/regs-pmu.h
@@ -49,6 +49,7 @@
 #define S5P_INFORM5                             0x0814
 #define S5P_INFORM6                             0x0818
 #define S5P_INFORM7                             0x081C
+#define S5P_PMU_SPARE2                          0x0908
 #define S5P_PMU_SPARE3                          0x090C
 
 #define EXYNOS_IROM_DATA2                       0x0988
@@ -182,6 +183,7 @@
 
 #define S5P_CORE_LOCAL_PWR_EN                   0x3
 #define S5P_CORE_WAKEUP_FROM_LOCAL_CFG          (0x3 << 8)
+#define S5P_CORE_AUTOWAKEUP_EN                  (1 << 31)
 
 /* Only for EXYNOS4210 */
 #define S5P_CMU_CLKSTOP_LCD1_LOWPWR     0x1154