Merge tag 's5pv210-dt' of git://git.kernel.org/pub/scm/linux/kernel/git/kgene/linux...

[deliverable/linux.git] / arch / arm / mach-s5pv210 / pm.c

diff --git a/arch/arm/mach-s5pv210/pm.c b/arch/arm/mach-s5pv210/pm.c
index 3cf3f9c8ddd124e84e7124514544377cfcc4d430..123163dd2ab0b394c100eda6c828cf644fb3e495 100644 (file)
--- a/arch/arm/mach-s5pv210/pm.c
+++ b/arch/arm/mach-s5pv210/pm.c
@@ -1,6 +1,6 @@
 /* linux/arch/arm/mach-s5pv210/pm.c
  *
- * Copyright (c) 2010 Samsung Electronics Co., Ltd.
+ * Copyright (c) 2010-2014 Samsung Electronics Co., Ltd.
  *             http://www.samsung.com
  *
  * S5PV210 - Power Management support
@@ -19,65 +19,28 @@
 #include <linux/syscore_ops.h>
 #include <linux/io.h>
 
-#include <plat/cpu.h>
-#include <plat/pm.h>
+#include <asm/cacheflush.h>
+#include <asm/suspend.h>
+
+#include <plat/pm-common.h>
 
-#include <mach/regs-irq.h>
 #include <mach/regs-clock.h>
 
-static struct sleep_save s5pv210_core_save[] = {
-       /* Clock source */
-       SAVE_ITEM(S5P_CLK_SRC0),
-       SAVE_ITEM(S5P_CLK_SRC1),
-       SAVE_ITEM(S5P_CLK_SRC2),
-       SAVE_ITEM(S5P_CLK_SRC3),
-       SAVE_ITEM(S5P_CLK_SRC4),
-       SAVE_ITEM(S5P_CLK_SRC5),
-       SAVE_ITEM(S5P_CLK_SRC6),
-
-       /* Clock source Mask */
-       SAVE_ITEM(S5P_CLK_SRC_MASK0),
-       SAVE_ITEM(S5P_CLK_SRC_MASK1),
-
-       /* Clock Divider */
-       SAVE_ITEM(S5P_CLK_DIV0),
-       SAVE_ITEM(S5P_CLK_DIV1),
-       SAVE_ITEM(S5P_CLK_DIV2),
-       SAVE_ITEM(S5P_CLK_DIV3),
-       SAVE_ITEM(S5P_CLK_DIV4),
-       SAVE_ITEM(S5P_CLK_DIV5),
-       SAVE_ITEM(S5P_CLK_DIV6),
-       SAVE_ITEM(S5P_CLK_DIV7),
-
-       /* Clock Main Gate */
-       SAVE_ITEM(S5P_CLKGATE_MAIN0),
-       SAVE_ITEM(S5P_CLKGATE_MAIN1),
-       SAVE_ITEM(S5P_CLKGATE_MAIN2),
-
-       /* Clock source Peri Gate */
-       SAVE_ITEM(S5P_CLKGATE_PERI0),
-       SAVE_ITEM(S5P_CLKGATE_PERI1),
-
-       /* Clock source SCLK Gate */
-       SAVE_ITEM(S5P_CLKGATE_SCLK0),
-       SAVE_ITEM(S5P_CLKGATE_SCLK1),
-
-       /* Clock IP Clock gate */
-       SAVE_ITEM(S5P_CLKGATE_IP0),
-       SAVE_ITEM(S5P_CLKGATE_IP1),
-       SAVE_ITEM(S5P_CLKGATE_IP2),
-       SAVE_ITEM(S5P_CLKGATE_IP3),
-       SAVE_ITEM(S5P_CLKGATE_IP4),
-
-       /* Clock Blcok and Bus gate */
-       SAVE_ITEM(S5P_CLKGATE_BLOCK),
-       SAVE_ITEM(S5P_CLKGATE_BUS0),
+#include "common.h"
 
+static struct sleep_save s5pv210_core_save[] = {
        /* Clock ETC */
-       SAVE_ITEM(S5P_CLK_OUT),
        SAVE_ITEM(S5P_MDNIE_SEL),
 };
 
+/*
+ * VIC wake-up support (TODO)
+ */
+static u32 s5pv210_irqwake_intmask = 0xffffffff;
+
+/*
+ * Suspend helpers.
+ */
 static int s5pv210_cpu_suspend(unsigned long arg)
 {
        unsigned long tmp;
@@ -102,8 +65,12 @@ static void s5pv210_pm_prepare(void)
 {
        unsigned int tmp;
 
+       /* Set wake-up mask registers */
+       __raw_writel(exynos_get_eint_wake_mask(), S5P_EINT_WAKEUP_MASK);
+       __raw_writel(s5pv210_irqwake_intmask, S5P_WAKEUP_MASK);
+
        /* ensure at least INFORM0 has the resume address */
-       __raw_writel(virt_to_phys(s3c_cpu_resume), S5P_INFORM0);
+       __raw_writel(virt_to_phys(s5pv210_cpu_resume), S5P_INFORM0);
 
        tmp = __raw_readl(S5P_SLEEP_CFG);
        tmp &= ~(S5P_SLEEP_CFG_OSC_EN | S5P_SLEEP_CFG_USBOSC_EN);
@@ -123,26 +90,70 @@ static void s5pv210_pm_prepare(void)
        s3c_pm_do_save(s5pv210_core_save, ARRAY_SIZE(s5pv210_core_save));
 }
 
-static int s5pv210_pm_add(struct device *dev, struct subsys_interface *sif)
+/*
+ * Suspend operations.
+ */
+static int s5pv210_suspend_enter(suspend_state_t state)
 {
-       pm_cpu_prep = s5pv210_pm_prepare;
-       pm_cpu_sleep = s5pv210_cpu_suspend;
+       int ret;
+
+       s3c_pm_debug_init();
+
+       S3C_PMDBG("%s: suspending the system...\n", __func__);
+
+       S3C_PMDBG("%s: wakeup masks: %08x,%08x\n", __func__,
+                       s5pv210_irqwake_intmask, exynos_get_eint_wake_mask());
+
+       if (s5pv210_irqwake_intmask == -1U
+           && exynos_get_eint_wake_mask() == -1U) {
+               pr_err("%s: No wake-up sources!\n", __func__);
+               pr_err("%s: Aborting sleep\n", __func__);
+               return -EINVAL;
+       }
+
+       s3c_pm_save_uarts();
+       s5pv210_pm_prepare();
+       flush_cache_all();
+       s3c_pm_check_store();
+
+       ret = cpu_suspend(0, s5pv210_cpu_suspend);
+       if (ret)
+               return ret;
+
+       s3c_pm_restore_uarts();
+
+       S3C_PMDBG("%s: wakeup stat: %08x\n", __func__,
+                       __raw_readl(S5P_WAKEUP_STAT));
+
+       s3c_pm_check_restore();
+
+       S3C_PMDBG("%s: resuming the system...\n", __func__);
 
        return 0;
 }
 
-static struct subsys_interface s5pv210_pm_interface = {
-       .name           = "s5pv210_pm",
-       .subsys         = &s5pv210_subsys,
-       .add_dev        = s5pv210_pm_add,
-};
+static int s5pv210_suspend_prepare(void)
+{
+       s3c_pm_check_prepare();
 
-static __init int s5pv210_pm_drvinit(void)
+       return 0;
+}
+
+static void s5pv210_suspend_finish(void)
 {
-       return subsys_interface_register(&s5pv210_pm_interface);
+       s3c_pm_check_cleanup();
 }
-arch_initcall(s5pv210_pm_drvinit);
 
+static const struct platform_suspend_ops s5pv210_suspend_ops = {
+       .enter          = s5pv210_suspend_enter,
+       .prepare        = s5pv210_suspend_prepare,
+       .finish         = s5pv210_suspend_finish,
+       .valid          = suspend_valid_only_mem,
+};
+
+/*
+ * Syscore operations used to delay restore of certain registers.
+ */
 static void s5pv210_pm_resume(void)
 {
        u32 tmp;
@@ -159,9 +170,11 @@ static struct syscore_ops s5pv210_pm_syscore_ops = {
        .resume         = s5pv210_pm_resume,
 };
 
-static __init int s5pv210_pm_syscore_init(void)
+/*
+ * Initialization entry point.
+ */
+void __init s5pv210_pm_init(void)
 {
        register_syscore_ops(&s5pv210_pm_syscore_ops);
-       return 0;
+       suspend_set_ops(&s5pv210_suspend_ops);
 }
-arch_initcall(s5pv210_pm_syscore_init);