Signed-off-by: Arve Hjønnevåg <arve@xxxxxxxxxxx>--- kernel/power/Kconfig | 12 +++ kernel/power/Makefile | 1 + kernel/power/earlysuspend.c | 178 +++++++++++++++++++++++++++++++++++++++++++ kernel/power/power.h | 6 ++ 4 files changed, 197 insertions(+), 0 deletions(-) create mode 100644 kernel/power/earlysuspend.c
diff --git a/kernel/power/Kconfig b/kernel/power/Kconfigindex dd76467..689abfe 100644--- a/kernel/power/Kconfig+++ b/kernel/power/Kconfig@@ -119,6 +119,9 @@ config SUSPEND_FREEZER config HAS_WAKELOCK bool +config HAS_EARLYSUSPEND+ bool+ config WAKELOCK bool "Wake lock" depends on PM && RTC_CLASS@@ -144,6 +147,15 @@ config DISABLE_SYS_POWER_STATE want to run user-space code that does not support wakelocks, do not enable this option since it removes the interface. +config EARLYSUSPEND+ bool "Early suspend"+ depends on WAKELOCK+ default y+ select HAS_EARLYSUSPEND+ ---help---+ Call early suspend handlers when the user requested sleep state+ changes.+ config HIBERNATION bool "Hibernation (aka 'suspend to disk')" depends on PM && SWAP && ARCH_HIBERNATION_POSSIBLEdiff --git a/kernel/power/Makefile b/kernel/power/Makefileindex 8d8672b..2f17e1d 100644--- a/kernel/power/Makefile+++ b/kernel/power/Makefile@@ -7,6 +7,7 @@ obj-y := main.o obj-$(CONFIG_PM_SLEEP) += console.o obj-$(CONFIG_FREEZER) += process.o obj-$(CONFIG_WAKELOCK) += wakelock.o+obj-$(CONFIG_EARLYSUSPEND) += earlysuspend.o obj-$(CONFIG_HIBERNATION) += swsusp.o disk.o snapshot.o swap.o user.o obj-$(CONFIG_MAGIC_SYSRQ) += poweroff.odiff --git a/kernel/power/earlysuspend.c b/kernel/power/earlysuspend.cnew file mode 100644index 0000000..4d70a7e--- /dev/null+++ b/kernel/power/earlysuspend.c@@ -0,0 +1,178 @@+/* kernel/power/earlysuspend.c+ *+ * Copyright (C) 2005-2008 Google, Inc.+ *+ * This software is licensed under the terms of the GNU General Public+ * License version 2, as published by the Free Software Foundation, and+ * may be copied, distributed, and modified under those terms.+ *+ * This program is distributed in the hope that it will be useful,+ * but WITHOUT ANY WARRANTY; without even the implied warranty of+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the+ * GNU General Public License for more details.+ *+ */++#include <linux/earlysuspend.h>+#include <linux/module.h>+#include <linux/mutex.h>+#include <linux/rtc.h>+#include <linux/syscalls.h> /* sys_sync */+#include <linux/wakelock.h>+#include <linux/workqueue.h>++#include "power.h"++enum {+ DEBUG_USER_STATE = 1U << 0,+ DEBUG_SUSPEND = 1U << 1,+};+static int debug_mask = DEBUG_USER_STATE;+module_param_named(debug_mask, debug_mask, int, S_IRUGO | S_IWUSR | S_IWGRP);++static DEFINE_MUTEX(early_suspend_lock);+static LIST_HEAD(early_suspend_handlers);+static void early_suspend(struct work_struct *work);+static void late_resume(struct work_struct *work);+static DECLARE_WORK(early_suspend_work, early_suspend);+static DECLARE_WORK(late_resume_work, late_resume);+static DEFINE_SPINLOCK(state_lock);+enum {+ SUSPEND_REQUESTED = 0x1,+ SUSPENDED = 0x2,+ SUSPEND_REQUESTED_AND_SUSPENDED = SUSPEND_REQUESTED | SUSPENDED,+};+static int state;++void register_early_suspend(struct early_suspend *handler)+{+ struct list_head *pos;++ mutex_lock(&early_suspend_lock);+ list_for_each(pos, &early_suspend_handlers) {+ struct early_suspend *e;+ e = list_entry(pos, struct early_suspend, link);+ if (e->level > handler->level)+ break;+ }+ list_add_tail(&handler->link, pos);+ if ((state & SUSPENDED) && handler->suspend)+ handler->suspend(handler);+ mutex_unlock(&early_suspend_lock);+}+EXPORT_SYMBOL(register_early_suspend);++void unregister_early_suspend(struct early_suspend *handler)+{+ mutex_lock(&early_suspend_lock);+ list_del(&handler->link);+ mutex_unlock(&early_suspend_lock);+}+EXPORT_SYMBOL(unregister_early_suspend);++static void early_suspend(struct work_struct *work)+{+ struct early_suspend *pos;+ unsigned long irqflags;+ int abort = 0;++ mutex_lock(&early_suspend_lock);+ spin_lock_irqsave(&state_lock, irqflags);+ if (state == SUSPEND_REQUESTED)+ state |= SUSPENDED;+ else+ abort = 1;+ spin_unlock_irqrestore(&state_lock, irqflags);++ if (abort) {+ if (debug_mask & DEBUG_SUSPEND)+ pr_info("early_suspend: abort, state %d\n", state);+ mutex_unlock(&early_suspend_lock);+ goto abort;+ }++ if (debug_mask & DEBUG_SUSPEND)+ pr_info("early_suspend: call handlers\n");+ list_for_each_entry(pos, &early_suspend_handlers, link) {+ if (pos->suspend)+ pos->suspend(pos);+ }+ mutex_unlock(&early_suspend_lock);++ if (debug_mask & DEBUG_SUSPEND)+ pr_info("early_suspend: sync\n");++ sys_sync();+abort:+ spin_lock_irqsave(&state_lock, irqflags);+ if (state == SUSPEND_REQUESTED_AND_SUSPENDED)+ wake_unlock(&main_wake_lock);+ spin_unlock_irqrestore(&state_lock, irqflags);+}++static void late_resume(struct work_struct *work)+{+ struct early_suspend *pos;+ unsigned long irqflags;+ int abort = 0;++ mutex_lock(&early_suspend_lock);+ spin_lock_irqsave(&state_lock, irqflags);+ if (state == SUSPENDED)+ state = 0; /* clear SUSPENDED */+ else+ abort = 1;+ spin_unlock_irqrestore(&state_lock, irqflags);++ if (abort) {+ if (debug_mask & DEBUG_SUSPEND)+ pr_info("late_resume: abort, state %d\n", state);+ goto abort;+ }+ if (debug_mask & DEBUG_SUSPEND)+ pr_info("late_resume: call handlers\n");+ list_for_each_entry_reverse(pos, &early_suspend_handlers, link)+ if (pos->resume)+ pos->resume(pos);+ if (debug_mask & DEBUG_SUSPEND)+ pr_info("late_resume: done\n");+abort:+ mutex_unlock(&early_suspend_lock);+}++void request_suspend_state(suspend_state_t new_state)+{+ unsigned long irqflags;+ int old_sleep;++ spin_lock_irqsave(&state_lock, irqflags);+ old_sleep = state & SUSPEND_REQUESTED;+ if (debug_mask & DEBUG_USER_STATE) {+ struct timespec ts;+ struct rtc_time tm;+ getnstimeofday(&ts);+ rtc_time_to_tm(ts.tv_sec, &tm);+ pr_info("request_suspend_state: %s (%d->%d) at %lld "+ "(%d-%02d-%02d %02d:%02d:%02d.%09lu UTC)\n",+ new_state != PM_SUSPEND_ON ? "sleep" : "wakeup",+ requested_suspend_state, new_state,+ ktime_to_ns(ktime_get()),+ tm.tm_year + 1900, tm.tm_mon + 1, tm.tm_mday,+ tm.tm_hour, tm.tm_min, tm.tm_sec, ts.tv_nsec);+ }+ if (!old_sleep && new_state != PM_SUSPEND_ON) {+ state |= SUSPEND_REQUESTED;+ queue_work(suspend_work_queue, &early_suspend_work);+ } else if (old_sleep && new_state == PM_SUSPEND_ON) {+ state &= ~SUSPEND_REQUESTED;+ wake_lock(&main_wake_lock);+ queue_work(suspend_work_queue, &late_resume_work);+ }+ requested_suspend_state = new_state;+ spin_unlock_irqrestore(&state_lock, irqflags);+}++suspend_state_t get_suspend_state(void)+{+ return requested_suspend_state;+}diff --git a/kernel/power/power.h b/kernel/power/power.hindex ed1b7f4..acbb13a 100644--- a/kernel/power/power.h+++ b/kernel/power/power.h@@ -231,3 +231,9 @@ extern struct wake_lock main_wake_lock; extern suspend_state_t requested_suspend_state; extern bool ignore_suspend_wakelocks; #endif++#ifdef CONFIG_EARLYSUSPEND+/* kernel/power/earlysuspend.c */+void request_suspend_state(suspend_state_t state);+suspend_state_t get_suspend_state(void);+#endif-- 1.6.1
_______________________________________________linux-pm mailing listlinux-pm@xxxxxxxxxxxxxxxxxxxxxxxxxxxxxxx://lists.linux-foundation.org/mailman/listinfo/linux-pm
