init android origin source code

1 files changed, 68 insertions, 0 deletions

diff --git a/ANDROID_3.4.5/arch/arm/mach-shmobile/cpuidle.c b/ANDROID_3.4.5/arch/arm/mach-shmobile/cpuidle.c
new file mode 100644
index 00000000..7e655910
--- /dev/null
+++ b/ANDROID_3.4.5/arch/arm/mach-shmobile/cpuidle.c
@@ -0,0 +1,68 @@
+/*
+ * CPUIdle support code for SH-Mobile ARM
+ *
+ *  Copyright (C) 2011 Magnus Damm
+ *
+ * This file is subject to the terms and conditions of the GNU General Public
+ * License.  See the file "COPYING" in the main directory of this archive
+ * for more details.
+ */
+
+#include <linux/pm.h>
+#include <linux/cpuidle.h>
+#include <linux/suspend.h>
+#include <linux/module.h>
+#include <linux/err.h>
+#include <asm/cpuidle.h>
+#include <asm/io.h>
+
+static void shmobile_enter_wfi(void)
+{
+	cpu_do_idle();
+}
+
+void (*shmobile_cpuidle_modes[CPUIDLE_STATE_MAX])(void) = {
+	shmobile_enter_wfi, /* regular sleep mode */
+};
+
+static int shmobile_cpuidle_enter(struct cpuidle_device *dev,
+				  struct cpuidle_driver *drv,
+				  int index)
+{
+	shmobile_cpuidle_modes[index]();
+
+	return index;
+}
+
+static struct cpuidle_device shmobile_cpuidle_dev;
+static struct cpuidle_driver shmobile_cpuidle_driver = {
+	.name			= "shmobile_cpuidle",
+	.owner			= THIS_MODULE,
+	.en_core_tk_irqen	= 1,
+	.states[0]		= ARM_CPUIDLE_WFI_STATE,
+	.safe_state_index	= 0, /* C1 */
+	.state_count		= 1,
+};
+
+void (*shmobile_cpuidle_setup)(struct cpuidle_driver *drv);
+
+static int shmobile_cpuidle_init(void)
+{
+	struct cpuidle_device *dev = &shmobile_cpuidle_dev;
+	struct cpuidle_driver *drv = &shmobile_cpuidle_driver;
+	int i;
+
+	for (i = 0; i < CPUIDLE_STATE_MAX; i++)
+		drv->states[i].enter = shmobile_cpuidle_enter;
+
+	if (shmobile_cpuidle_setup)
+		shmobile_cpuidle_setup(drv);
+
+	cpuidle_register_driver(drv);
+
+	dev->state_count = drv->state_count;
+	cpuidle_register_device(dev);
+
+	return 0;
+}
+late_initcall(shmobile_cpuidle_init);