1 files changed, 59 insertions, 0 deletions

diff --git a/arch/arm/mach-exynos/pmu.c b/arch/arm/mach-exynos/pmu.c
index db4dc515e416..4aacb66f7161 100644
--- a/arch/arm/mach-exynos/pmu.c
+++ b/arch/arm/mach-exynos/pmu.c
@@ -11,6 +11,7 @@
 
 #include <linux/io.h>
 #include <linux/kernel.h>
+#include <linux/bug.h>
 
 #include <mach/regs-clock.h>
 #include <mach/pmu.h>
@@ -314,10 +315,68 @@ static struct exynos_pmu_conf exynos5250_pmu_config[] = {
         { PMU_TABLE_END,},
 };
 
+void __iomem *exynos5_list_both_cnt_feed[] = {
+        EXYNOS5_ARM_CORE0_OPTION,
+        EXYNOS5_ARM_CORE1_OPTION,
+        EXYNOS5_ARM_COMMON_OPTION,
+        EXYNOS5_GSCL_OPTION,
+        EXYNOS5_ISP_OPTION,
+        EXYNOS5_MFC_OPTION,
+        EXYNOS5_G3D_OPTION,
+        EXYNOS5_DISP1_OPTION,
+        EXYNOS5_MAU_OPTION,
+        EXYNOS5_TOP_PWR_OPTION,
+        EXYNOS5_TOP_PWR_SYSMEM_OPTION,
+};
+
+void __iomem *exynos5_list_diable_wfi_wfe[] = {
+        EXYNOS5_ARM_CORE1_OPTION,
+        EXYNOS5_FSYS_ARM_OPTION,
+        EXYNOS5_ISP_ARM_OPTION,
+};
+
+static void exynos5_init_pmu(void)
+{
+        unsigned int i;
+        unsigned int tmp;
+
+        /*
+         * Enable both SC_FEEDBACK and SC_COUNTER
+         */
+        for (i = 0 ; i < ARRAY_SIZE(exynos5_list_both_cnt_feed) ; i++) {
+                tmp = __raw_readl(exynos5_list_both_cnt_feed[i]);
+                tmp |= (EXYNOS5_USE_SC_FEEDBACK |
+                        EXYNOS5_USE_SC_COUNTER);
+                __raw_writel(tmp, exynos5_list_both_cnt_feed[i]);
+        }
+
+        /*
+         * SKIP_DEACTIVATE_ACEACP_IN_PWDN_BITFIELD Enable
+         * MANUAL_L2RSTDISABLE_CONTROL_BITFIELD Enable
+         */
+        tmp = __raw_readl(EXYNOS5_ARM_COMMON_OPTION);
+        tmp |= (EXYNOS5_MANUAL_L2RSTDISABLE_CONTROL |
+                EXYNOS5_SKIP_DEACTIVATE_ACEACP_IN_PWDN);
+        __raw_writel(tmp, EXYNOS5_ARM_COMMON_OPTION);
+
+        /*
+         * Disable WFI/WFE on XXX_OPTION
+         */
+        for (i = 0 ; i < ARRAY_SIZE(exynos5_list_diable_wfi_wfe) ; i++) {
+                tmp = __raw_readl(exynos5_list_diable_wfi_wfe[i]);
+                tmp &= ~(EXYNOS5_OPTION_USE_STANDBYWFE |
+                         EXYNOS5_OPTION_USE_STANDBYWFI);
+                __raw_writel(tmp, exynos5_list_diable_wfi_wfe[i]);
+        }
+}
+
 void exynos_sys_powerdown_conf(enum sys_powerdown mode)
 {
         unsigned int i;
 
+        if (soc_is_exynos5250())
+                exynos5_init_pmu();
+
         for (i = 0; (exynos_pmu_config[i].reg != PMU_TABLE_END) ; i++)
                 __raw_writel(exynos_pmu_config[i].val[mode],
                                 exynos_pmu_config[i].reg);