From mboxrd@z Thu Jan 1 00:00:00 1970 From: d-gerlach@ti.com (Dave Gerlach) Date: Mon, 9 May 2016 16:49:24 -0500 Subject: [PATCH 4/6] ARM: OMAP2+: pm34xx: Convert to use generic sram driver for idle code In-Reply-To: <1462830566-28708-1-git-send-email-d-gerlach@ti.com> References: <1462830566-28708-1-git-send-email-d-gerlach@ti.com> Message-ID: <1462830566-28708-5-git-send-email-d-gerlach@ti.com> To: linux-arm-kernel@lists.infradead.org List-Id: linux-arm-kernel.lists.infradead.org Change to use the generic SRAM driver and genalloc framework to allocate SRAM space for low-level ASM PM code instead of omap specific SRAM allocator. Signed-off-by: Dave Gerlach --- arch/arm/mach-omap2/pm34xx.c | 82 +++++++++++++++++++++++++++++++++++++++++++- 1 file changed, 81 insertions(+), 1 deletion(-) diff --git a/arch/arm/mach-omap2/pm34xx.c b/arch/arm/mach-omap2/pm34xx.c index d44e0e2f1106..5ebbf5c30c6e 100644 --- a/arch/arm/mach-omap2/pm34xx.c +++ b/arch/arm/mach-omap2/pm34xx.c @@ -24,17 +24,21 @@ #include #include #include +#include #include #include #include #include +#include #include #include #include +#include #include #include +#include #include #include @@ -68,6 +72,9 @@ static LIST_HEAD(pwrst_list); static int (*_omap_save_secure_sram)(u32 *addr); void (*omap3_do_wfi_sram)(void); +static struct gen_pool *sram_pool; +static phys_addr_t ocmcram_location; +static phys_addr_t secure_ocmcram_location; static struct powerdomain *mpu_pwrdm, *neon_pwrdm; static struct powerdomain *core_pwrdm, *per_pwrdm; @@ -179,6 +186,71 @@ static void omap34xx_save_context(u32 *save) *save++ = val; } +/* + * Push functions to SRAM + * + * The minimum set of functions is pushed to SRAM for execution: + * - omap3_do_wfi for erratum i581 WA, + * - save_secure_ram_context for security extensions. + */ +static int omap3_prepare_push_sram_idle(void) +{ + struct device_node *np; + + np = of_find_compatible_node(NULL, NULL, "ti,omap3-mpu"); + if (!np) { + pr_warn("PM: %s: Unable to find device node for mpu\n", + __func__); + return -ENODEV; + } + + sram_pool = of_gen_pool_get(np, "sram", 0); + + if (!sram_pool) { + pr_warn("PM: %s: Unable to get sram pool for ocmcram\n", + __func__); + return -ENODEV; + } + + ocmcram_location = gen_pool_alloc(sram_pool, omap3_do_wfi_sz); + if (!ocmcram_location) { + pr_warn("PM: %s: Unable to allocate memory from ocmcram for omap3_do_wfi_sz.\n", + __func__); + return -EINVAL; + } + + if (omap_type() != OMAP2_DEVICE_TYPE_GP) { + secure_ocmcram_location = + gen_pool_alloc(sram_pool, + save_secure_ram_context_sz); + if (!secure_ocmcram_location) { + pr_warn("PM: %s: Unable to allocate memory from ocmcram for save_secure_ram_context.\n", + __func__); + return -EINVAL; + } + } + + return 0; +} + +static int omap3_push_sram_idle(void) +{ + omap3_do_wfi_sram = fncpy((void *)ocmcram_location, + &omap3_do_wfi, + omap3_do_wfi_sz); + + return 0; +} + +static int omap3_push_sram_secure_idle(void) +{ + if (omap_type() != OMAP2_DEVICE_TYPE_GP) + _omap_save_secure_sram = fncpy((void *)secure_ocmcram_location, + &save_secure_ram_context, + save_secure_ram_context_sz); + return 0; +} + static int omap34xx_do_sram_idle(unsigned long save_state) { omap34xx_cpu_suspend(save_state); @@ -281,7 +353,8 @@ void omap_sram_idle(void) pwrdm_read_prev_pwrst(core_pwrdm) == PWRDM_POWER_OFF) { omap3_core_restore_context(); omap3_cm_restore_context(); - omap3_sram_restore_context(); + omap3_push_sram_idle(); + omap3_push_sram_secure_idle(); omap2_sms_restore_context(); } else { /* @@ -517,6 +590,13 @@ int __init omap3_pm_init(void) per_clkdm = clkdm_lookup("per_clkdm"); wkup_clkdm = clkdm_lookup("wkup_clkdm"); + ret = omap3_prepare_push_sram_idle(); + if (ret) + goto err3; + + omap3_push_sram_idle(); + omap3_push_sram_secure_idle(); + omap_common_suspend_init(omap3_pm_suspend); arm_pm_idle = omap3_pm_idle; -- 2.7.3