ARM: OMAP2+: pm33xx-core: Extend platform_data ops for cpuidle
authorDave Gerlach <d-gerlach@ti.com>
Fri, 2 Nov 2018 10:29:48 +0000 (15:59 +0530)
committerTero Kristo <t-kristo@ti.com>
Tue, 6 Nov 2018 13:25:30 +0000 (15:25 +0200)
In order for am335x and am437x to properly enter deeper c-states in
cpuidle they must always call into the sleep33/43xx suspend code and
also sometimes invoke the wkup_m3_ipc driver. These are both controlled
by the pm33xx module so we must provide a method for the platform code
to call back into the module when it is available as the core cpuidle
ops that are invoked by the cpuidle-arm driver must remain as built in.

Extend the init platform op to take an idle function as an argument so
that we can use this to call into the pm33xx module for c-states that
need it. Also add a deinit op so we can unregister this idle function
from the PM core when the pm33xx module gets unloaded.

Signed-off-by: Dave Gerlach <d-gerlach@ti.com>
arch/arm/mach-omap2/pm33xx-core.c
drivers/soc/ti/pm33xx.c
include/linux/platform_data/pm33xx.h

index a99b46f17d36854185033f7a08599b3d890cfd58..ce52ad6442f706c597e5eb87f6e2bb502c045275 100644 (file)
@@ -77,7 +77,7 @@ static int am43xx_check_off_mode_enable(void)
        return enable_off_mode;
 }
 
-static int amx3_common_init(void)
+static int amx3_common_init(int (*idle)(u32 wfi_flags))
 {
        gfx_pwrdm = pwrdm_lookup("gfx_pwrdm");
        per_pwrdm = pwrdm_lookup("per_pwrdm");
@@ -95,10 +95,12 @@ static int amx3_common_init(void)
        else
                pr_err("PM: Failed to get cefuse_pwrdm\n");
 
+       idle_fn = idle;
+
        return 0;
 }
 
-static int am33xx_suspend_init(void)
+static int am33xx_suspend_init(int (*idle)(u32 wfi_flags))
 {
        int ret;
 
@@ -109,12 +111,12 @@ static int am33xx_suspend_init(void)
                return -ENODEV;
        }
 
-       ret = amx3_common_init();
+       ret = amx3_common_init(idle);
 
        return ret;
 }
 
-static int am43xx_suspend_init(void)
+static int am43xx_suspend_init(int (*idle)(u32 wfi_flags))
 {
        int ret = 0;
 
@@ -124,11 +126,17 @@ static int am43xx_suspend_init(void)
                return ret;
        }
 
-       ret = amx3_common_init();
+       ret = amx3_common_init(idle);
 
        return ret;
 }
 
+static int amx3_suspend_deinit(void)
+{
+       idle_fn = NULL;
+       return 0;
+}
+
 static void amx3_pre_suspend_common(void)
 {
        omap_set_pwrdm_state(gfx_pwrdm, PWRDM_POWER_OFF);
@@ -263,6 +271,7 @@ static void am43xx_prepare_rtc_resume(void)
 
 static struct am33xx_pm_platform_data am33xx_ops = {
        .init = am33xx_suspend_init,
+       .deinit = amx3_suspend_deinit,
        .soc_suspend = am33xx_suspend,
        .cpu_suspend = am33xx_cpu_suspend,
        .get_sram_addrs = amx3_get_sram_addrs,
@@ -276,6 +285,7 @@ static struct am33xx_pm_platform_data am33xx_ops = {
 
 static struct am33xx_pm_platform_data am43xx_ops = {
        .init = am43xx_suspend_init,
+       .deinit = amx3_suspend_deinit,
        .soc_suspend = am43xx_suspend,
        .cpu_suspend = am43xx_cpu_suspend,
        .get_sram_addrs = amx3_get_sram_addrs,
index 0dc1e3ccb72b9ef5490d6c43f35e47880a2ef74a..a1374aebf8cfb19ec61f6f079d649e76d977fa52 100644 (file)
@@ -493,7 +493,7 @@ static int am33xx_pm_probe(struct platform_device *pdev)
        suspend_wfi_flags |= WFI_FLAG_WAKE_M3;
 #endif /* CONFIG_SUSPEND */
 
-       ret = pm_ops->init();
+       ret = pm_ops->init(NULL);
        if (ret) {
                dev_err(dev, "Unable to call core pm init!\n");
                ret = -ENODEV;
index c595e0109fa1449298bc52cead8ffc10b0eeadd0..3b287a2c4ffae44f364f5e69e2486903716bcfaa 100644 (file)
@@ -46,7 +46,8 @@ struct am33xx_pm_sram_addr {
 };
 
 struct am33xx_pm_platform_data {
-       int     (*init)(void);
+       int     (*init)(int (*idle)(u32 wfi_flags));
+       int     (*deinit)(void);
        int     (*soc_suspend)(unsigned int state, int (*fn)(unsigned long),
                               unsigned long args);
        int     (*cpu_suspend)(int (*fn)(unsigned long), unsigned long args);