ARM: mach-shmobile: sh7372 Core Standby CPUIdle

This patch ties in the previously added sh7372 sleep
mode known as Core Standby together with the shared
SH-Mobile ARM CPUIdle implementation.

Signed-off-by: Magnus Damm <damm@opensource.se>
Signed-off-by: Paul Mundt <lethal@linux-sh.org>

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();
 }