[PATCH 01/04] Fix cpuidle off-modes to be controlled via sysfs

[Tero Kristo]

Signed-off-by: Tero Kristo <[EMAIL PROTECTED]>
---
 arch/arm/mach-omap2/cpuidle34xx.c |   21 ++++++++++++++++++---
 arch/arm/mach-omap2/pm.c          |    4 ++--
 2 files changed, 20 insertions(+), 5 deletions(-)

diff --git a/arch/arm/mach-omap2/cpuidle34xx.c 
b/arch/arm/mach-omap2/cpuidle34xx.c
index 235976e..f97c4d8 100644
--- a/arch/arm/mach-omap2/cpuidle34xx.c
+++ b/arch/arm/mach-omap2/cpuidle34xx.c
@@ -29,6 +29,8 @@
 #include <mach/control.h>
 #include <mach/common.h>
 
+#include "pm.h"
+
 #ifdef CONFIG_CPU_IDLE
 
 #define OMAP3_MAX_STATES 7
@@ -77,6 +79,8 @@ static int omap3_enter_idle(struct cpuidle_device *dev,
 {
        struct omap3_processor_cx *cx = cpuidle_get_statedata(state);
        struct timespec ts_preidle, ts_postidle, ts_idle;
+       int mpu_next_state;
+       int core_next_state;
 
        current_cx_state = *cx;
 
@@ -89,8 +93,19 @@ static int omap3_enter_idle(struct cpuidle_device *dev,
        local_irq_disable();
        local_fiq_disable();
 
-       set_pwrdm_state(mpu_pd, cx->mpu_state);
-       set_pwrdm_state(core_pd, cx->core_state);
+       /* Dirty hack to enable / disable off-mode dynamically */
+       mpu_next_state = cx->mpu_state;
+       core_next_state = cx->core_state;
+
+       if (!enable_off_mode) {
+               if (mpu_next_state == PWRDM_POWER_OFF)
+                       mpu_next_state = PWRDM_POWER_RET;
+               if (core_next_state == PWRDM_POWER_OFF)
+                       core_next_state = PWRDM_POWER_RET;
+       }
+
+       set_pwrdm_state(mpu_pd, mpu_next_state);
+       set_pwrdm_state(core_pd, core_next_state);
 
        if (omap_irq_pending())
                goto return_sleep_time;
@@ -195,7 +210,7 @@ void omap_init_power_states(void)
                                CPUIDLE_FLAG_CHECK_BM;
 
        /* C6 . MPU OFF + Core OFF */
-       omap3_power_states[OMAP3_STATE_C6].valid = 0;
+       omap3_power_states[OMAP3_STATE_C6].valid = 1;
        omap3_power_states[OMAP3_STATE_C6].type = OMAP3_STATE_C6;
        omap3_power_states[OMAP3_STATE_C6].sleep_latency = 10000;
        omap3_power_states[OMAP3_STATE_C6].wakeup_latency = 30000;
diff --git a/arch/arm/mach-omap2/pm.c b/arch/arm/mach-omap2/pm.c
index 136683b..9dbe7e2 100644
--- a/arch/arm/mach-omap2/pm.c
+++ b/arch/arm/mach-omap2/pm.c
@@ -87,9 +87,9 @@ static ssize_t idle_store(struct kobject *kobj, struct 
kobj_attribute *attr,
        } else if (attr == &clocks_off_while_idle_attr) {
                clocks_off_while_idle = value;
        } else if (attr == &enable_off_mode_attr) {
-               int enable = (value > 0) ? 1 : 0;
+               enable_off_mode = (value > 0) ? 1 : 0;
 
-               omap3_pm_off_mode_enable(enable);
+               omap3_pm_off_mode_enable(enable_off_mode);
        } else if (attr == &voltage_off_while_idle_attr) {
                voltage_off_while_idle = value;
                if (voltage_off_while_idle)
-- 
1.5.4.3

--
To unsubscribe from this list: send the line "unsubscribe linux-omap" in
the body of a message to [EMAIL PROTECTED]
More majordomo info at  http://vger.kernel.org/majordomo-info.html