clk: samsung: exynos4: Move suspend/resume handling to SoC driver

Since there are multiple differences in how suspend/resume of particular
Exynos SoCs must be handled, SoC driver is better place for
suspend/resume handlers and so this patch moves them.

Signed-off-by: Tomasz Figa <t.figa@samsung.com>
Acked-by: Kyungmin Park <kyungmin.park@samsung.com>
Reviewed-by: Thomas Abraham <thomas.ab@samsung.com>
Reviewed-by: Sylwester Nawrocki <s.nawrocki@samsung.com>
Signed-off-by: Kukjin Kim <kgene.kim@samsung.com>

1 files changed, 80 insertions, 10 deletions

diff --git a/drivers/clk/samsung/clk-exynos4.c b/drivers/clk/samsung/clk-exynos4.c
index 12a9f28f9f17..325f29248af5 100644
--- a/drivers/clk/samsung/clk-exynos4.c
+++ b/drivers/clk/samsung/clk-exynos4.c
@@ -16,6 +16,7 @@
 #include <linux/clk-provider.h>
 #include <linux/of.h>
 #include <linux/of_address.h>
+#include <linux/syscore_ops.h>
 
 #include "clk.h"
 
@@ -130,6 +131,16 @@ enum exynos4_plls {
         nr_plls                 /* number of PLLs */
 };
 
+static void __iomem *reg_base;
+static enum exynos4_soc exynos4_soc;
+
+/*
+ * Support for CMU save/restore across system suspends
+ */
+#ifdef CONFIG_PM_SLEEP
+static struct samsung_clk_reg_dump *exynos4_save_common;
+static struct samsung_clk_reg_dump *exynos4_save_soc;
+
 /*
  * list of controller registers to be saved and restored during a
  * suspend/resume cycle.
@@ -227,6 +238,70 @@ static unsigned long exynos4_clk_regs[] __initdata = {
         GATE_IP_CPU,
 };
 
+static int exynos4_clk_suspend(void)
+{
+        samsung_clk_save(reg_base, exynos4_save_common,
+                                ARRAY_SIZE(exynos4_clk_regs));
+
+        if (exynos4_soc == EXYNOS4210)
+                samsung_clk_save(reg_base, exynos4_save_soc,
+                                        ARRAY_SIZE(exynos4210_clk_save));
+        else
+                samsung_clk_save(reg_base, exynos4_save_soc,
+                                        ARRAY_SIZE(exynos4x12_clk_save));
+
+        return 0;
+}
+
+static void exynos4_clk_resume(void)
+{
+        samsung_clk_restore(reg_base, exynos4_save_common,
+                                ARRAY_SIZE(exynos4_clk_regs));
+
+        if (exynos4_soc == EXYNOS4210)
+                samsung_clk_restore(reg_base, exynos4_save_soc,
+                                        ARRAY_SIZE(exynos4210_clk_save));
+        else
+                samsung_clk_restore(reg_base, exynos4_save_soc,
+                                        ARRAY_SIZE(exynos4x12_clk_save));
+}
+
+static struct syscore_ops exynos4_clk_syscore_ops = {
+        .suspend = exynos4_clk_suspend,
+        .resume = exynos4_clk_resume,
+};
+
+static void exynos4_clk_sleep_init(void)
+{
+        exynos4_save_common = samsung_clk_alloc_reg_dump(exynos4_clk_regs,
+                                        ARRAY_SIZE(exynos4_clk_regs));
+        if (!exynos4_save_common)
+                goto err_warn;
+
+        if (exynos4_soc == EXYNOS4210)
+                exynos4_save_soc = samsung_clk_alloc_reg_dump(
+                                        exynos4210_clk_save,
+                                        ARRAY_SIZE(exynos4210_clk_save));
+        else
+                exynos4_save_soc = samsung_clk_alloc_reg_dump(
+                                        exynos4x12_clk_save,
+                                        ARRAY_SIZE(exynos4x12_clk_save));
+        if (!exynos4_save_soc)
+                goto err_common;
+
+        register_syscore_ops(&exynos4_clk_syscore_ops);
+        return;
+
+err_common:
+        kfree(exynos4_save_common);
+err_warn:
+        pr_warn("%s: failed to allocate sleep save data, no sleep support!\n",
+                __func__);
+}
+#else
+static void exynos4_clk_sleep_init(void) {}
+#endif
+
 /* list of all parent clock list */
 PNAME(mout_apll_p)      = { "fin_pll", "fout_apll", };
 PNAME(mout_mpll_p)      = { "fin_pll", "fout_mpll", };
@@ -1039,22 +1114,15 @@ static struct samsung_pll_clock exynos4x12_plls[nr_plls] __initdata = {
 
 /* register exynos4 clocks */
 static void __init exynos4_clk_init(struct device_node *np,
-                                    enum exynos4_soc exynos4_soc)
+                                    enum exynos4_soc soc)
 {
-        void __iomem *reg_base;
+        exynos4_soc = soc;
 
         reg_base = of_iomap(np, 0);
         if (!reg_base)
                 panic("%s: failed to map registers\n", __func__);
 
-        if (exynos4_soc == EXYNOS4210)
-                samsung_clk_init(np, reg_base, CLK_NR_CLKS,
-                        exynos4_clk_regs, ARRAY_SIZE(exynos4_clk_regs),
-                        exynos4210_clk_save, ARRAY_SIZE(exynos4210_clk_save));
-        else
-                samsung_clk_init(np, reg_base, CLK_NR_CLKS,
-                        exynos4_clk_regs, ARRAY_SIZE(exynos4_clk_regs),
-                        exynos4x12_clk_save, ARRAY_SIZE(exynos4x12_clk_save));
+        samsung_clk_init(np, reg_base, CLK_NR_CLKS, NULL, 0, NULL, 0);
 
         samsung_clk_of_register_fixed_ext(exynos4_fixed_rate_ext_clks,
                         ARRAY_SIZE(exynos4_fixed_rate_ext_clks),
@@ -1127,6 +1195,8 @@ static void __init exynos4_clk_init(struct device_node *np,
         samsung_clk_register_alias(exynos4_aliases,
                         ARRAY_SIZE(exynos4_aliases));
 
+        exynos4_clk_sleep_init();
+
         pr_info("%s clocks: sclk_apll = %ld, sclk_mpll = %ld\n"
                 "\tsclk_epll = %ld, sclk_vpll = %ld, arm_clk = %ld\n",
                 exynos4_soc == EXYNOS4210 ? "Exynos4210" : "Exynos4x12",