ARM: rockchip: set correct stabilization thresholds in suspend
From: Heiko Stuebner <heiko@...> Date: Wed, 22 Jul 2015 17:04:47 +0200
Commit-Message
Currently the stabilization thresholds for the oscillator and external pmu are statically set to 30ms based on a 32kHz clock rate. This leaves out the case when we don't switch to the 32kHz clock if either usb wakeup is enabled or we only enter the shallow suspend mode where the logic keeps running. So, set the correct threshold after we have determined if we switch to the 32kHz clock or stay with the 24MHz one. Signed-off-by: Heiko Stuebner <heiko@...>
Patch-Comment
arch/arm/mach-rockchip/pm.c | 16 ++++++++++++---- arch/arm/mach-rockchip/pm.h | 4 ---- 2 files changed, 12 insertions(+), 8 deletions(-)
Statistics
- 12 lines added
- 8 lines removed
Changes
------------------------- arch/arm/mach-rockchip/pm.c --------------------------
index 892bace..4539f51 100644
@@ -96,7 +96,8 @@ static bool rk3288_slp_disable_osc(void)
static void rk3288_slp_mode_set(int level)
{
u32 mode_set, mode_set1;
+ bool osc_switch_to_32k;
+ int cnt_thres;
regmap_read(sgrf_regmap, RK3288_SGRF_CPU_CON0, &rk3288_sgrf_cpu_con0);
regmap_read(sgrf_regmap, RK3288_SGRF_SOC_CON0, &rk3288_sgrf_soc_con0);
@@ -135,6 +136,8 @@ static void rk3288_slp_mode_set(int level)
mode_set1 = BIT(PMU_CLR_CORE) | BIT(PMU_CLR_CPUP);
if (level == ROCKCHIP_ARM_OFF_LOGIC_DEEP) {
+ osc_switch_to_32k = rk3288_slp_disable_osc();
+
/* arm off, logic deep sleep */
mode_set |= BIT(PMU_BUS_PD_EN) | BIT(PMU_PMU_USE_LF) |
BIT(PMU_DDR1IO_RET_EN) | BIT(PMU_DDR0IO_RET_EN) |
@@ -145,7 +148,10 @@ static void rk3288_slp_mode_set(int level)
mode_set1 |= BIT(PMU_CLR_ALIVE) | BIT(PMU_CLR_BUS) |
BIT(PMU_CLR_PERI) | BIT(PMU_CLR_DMA);
+
} else {
+ osc_switch_to_32k = false;
+
/*
* arm off, logic normal
* if pmu_clk_core_src_gate_en is not set,
@@ -154,6 +160,11 @@ static void rk3288_slp_mode_set(int level)
mode_set |= BIT(PMU_CLK_CORE_SRC_GATE_EN);
}
+ /* set correct stabilization threshold */
+ cnt_thres = (osc_switch_to_32k) ? 32 : 24000;
+ regmap_write(pmu_regmap, RK3288_PMU_OSC_CNT, cnt_thres * 30);
+ regmap_write(pmu_regmap, RK3288_PMU_STABL_CNT, cnt_thres * 30);
+
regmap_write(pmu_regmap, RK3288_PMU_PWRMODE_CON, mode_set);
regmap_write(pmu_regmap, RK3288_PMU_PWRMODE_CON1, mode_set1);
}
@@ -262,9 +273,6 @@ static int rk3288_suspend_init(struct device_node *np)
memcpy(rk3288_bootram_base, rockchip_slp_cpu_resume,
rk3288_bootram_sz);
return 0;
}
------------------------- arch/arm/mach-rockchip/pm.h --------------------------
index b6494c2..8a55ee2 100644
@@ -62,10 +62,6 @@ static inline void rockchip_suspend_init(void)
/* PMU_WAKEUP_CFG1 bits */
#define PMU_ARMINT_WAKEUP_EN BIT(0)
enum rk3288_pwr_mode_con {
PMU_PWR_MODE_EN = 0,
PMU_CLK_CORE_SRC_GATE_EN,