diff options
Diffstat (limited to 'arch/arm/mach-shmobile/pm-sh7372.c')
-rw-r--r-- | arch/arm/mach-shmobile/pm-sh7372.c | 33 |
1 files changed, 31 insertions, 2 deletions
diff --git a/arch/arm/mach-shmobile/pm-sh7372.c b/arch/arm/mach-shmobile/pm-sh7372.c index 92c374d411d5..338049eed4ad 100644 --- a/arch/arm/mach-shmobile/pm-sh7372.c +++ b/arch/arm/mach-shmobile/pm-sh7372.c @@ -10,6 +10,7 @@ #include <linux/pm.h> #include <linux/suspend.h> +#include <linux/cpuidle.h> #include <linux/module.h> #include <linux/list.h> #include <linux/err.h> @@ -24,8 +25,7 @@ #define SBAR 0xe6180020 #define APARMBAREA 0xe6f10020 -#ifdef CONFIG_SUSPEND -static void sh7372_enter_core_standby(void) +void sh7372_enter_core_standby(void) { void __iomem *smfram = (void __iomem *)SMFRAM; @@ -51,6 +51,34 @@ static void sh7372_enter_core_standby(void) __raw_writel(0, SBAR); /* disable reset vector translation */ } +#ifdef CONFIG_CPU_IDLE +static void sh7372_cpuidle_setup(struct cpuidle_device *dev) +{ + struct cpuidle_state *state; + int i = dev->state_count; + + state = &dev->states[i]; + snprintf(state->name, CPUIDLE_NAME_LEN, "C2"); + strncpy(state->desc, "Core Standby Mode", CPUIDLE_DESC_LEN); + state->exit_latency = 10; + state->target_residency = 20 + 10; + state->power_usage = 1; /* perhaps not */ + state->flags = 0; + state->flags |= CPUIDLE_FLAG_TIME_VALID; + shmobile_cpuidle_modes[i] = sh7372_enter_core_standby; + + dev->state_count = i + 1; +} + +static void sh7372_cpuidle_init(void) +{ + shmobile_cpuidle_setup = sh7372_cpuidle_setup; +} +#else +static void sh7372_cpuidle_init(void) {} +#endif + +#ifdef CONFIG_SUSPEND static int sh7372_enter_suspend(suspend_state_t suspend_state) { sh7372_enter_core_standby(); @@ -76,4 +104,5 @@ void __init sh7372_pm_init(void) __raw_writel(0x00000000, DBGREG1); sh7372_suspend_init(); + sh7372_cpuidle_init(); } |