diff options
| author | Anson Huang <b20788@freescale.com> | 2015-07-31 23:12:54 +0800 |
|---|---|---|
| committer | Leonard Crestez <leonard.crestez@nxp.com> | 2018-08-24 12:20:42 +0300 |
| commit | 7cf57f12981a8138e5134c2335e8f5050614494c (patch) | |
| tree | 1fc6c67e0242970f1e19be93cfad28a98a505971 /arch/arm/mach-imx/pm-imx7.c | |
| parent | e43155c510781c37d280528a3ca3846a5d9d4e06 (diff) | |
MLK-11281-8 ARM: imx: add iomuxc gpr save/restore for lpsr
Add IOMUXC GPR state retention support for i.MX7D LPSR mode.
Signed-off-by: Anson Huang <b20788@freescale.com>
Diffstat (limited to 'arch/arm/mach-imx/pm-imx7.c')
| -rw-r--r-- | arch/arm/mach-imx/pm-imx7.c | 26 |
1 files changed, 25 insertions, 1 deletions
diff --git a/arch/arm/mach-imx/pm-imx7.c b/arch/arm/mach-imx/pm-imx7.c index 9c2f0021ea1a..2ea167b5373b 100644 --- a/arch/arm/mach-imx/pm-imx7.c +++ b/arch/arm/mach-imx/pm-imx7.c @@ -58,6 +58,8 @@ #define UART_UBRC 0xac #define UART_UTS 0xb4 +#define MAX_IOMUXC_GPR 23 + extern unsigned long iram_tlb_base_addr; extern unsigned long iram_tlb_phys_addr; @@ -74,6 +76,7 @@ static void __iomem *suspend_ocram_base; static void (*imx7_suspend_in_ocram_fn)(void __iomem *ocram_vbase); struct imx7_cpu_pm_info *pm_info; static bool lpsr_enabled; +static u32 iomuxc_gpr[MAX_IOMUXC_GPR]; /* * suspend ocram space layout: * ======================== high address ====================== @@ -265,6 +268,24 @@ static const char * const low_power_ocram_match[] __initconst = { NULL }; +static void imx7_iomuxc_gpr_save(void) +{ + u32 i; + + for (i = 0; i < MAX_IOMUXC_GPR; i++) + iomuxc_gpr[i] = readl_relaxed( + pm_info->iomuxc_gpr_base.vbase + i * 4); +} + +static void imx7_iomuxc_gpr_restore(void) +{ + u32 i; + + for (i = 0; i < MAX_IOMUXC_GPR; i++) + writel_relaxed(iomuxc_gpr[i], + pm_info->iomuxc_gpr_base.vbase + i * 4); +} + static void imx7_console_save(unsigned int *regs) { if (!console_base) @@ -357,15 +378,18 @@ static int imx7_pm_enter(suspend_state_t state) imx7_pm_set_lpsr_resume_addr(pm_info->resume_addr); memcpy(lpm_ocram_saved_in_ddr, lpm_ocram_base, lpm_ocram_size); + imx7_iomuxc_gpr_save(); } } /* Zzz ... */ cpu_suspend(0, imx7_suspend_finish); - if (imx7_pm_is_resume_from_lpsr()) + if (imx7_pm_is_resume_from_lpsr()) { memcpy(lpm_ocram_base, lpm_ocram_saved_in_ddr, lpm_ocram_size); + imx7_iomuxc_gpr_restore(); + } if (imx_gpcv2_is_mf_mix_off() || imx7_pm_is_resume_from_lpsr()) { memcpy(ocram_base, ocram_saved_in_ddr, ocram_size); |