[PATCH/RFC,2/2] OMAP: PM: initial runtime PM support

Commit Message

Kevin Hilman Feb. 4, 2010, 12:19 a.m. UTC

None

Patch

diff --git a/arch/arm/mach-omap2/Makefile b/arch/arm/mach-omap2/Makefile
index dba44a1..16ba8fc 100644
--- a/arch/arm/mach-omap2/Makefile
+++ b/arch/arm/mach-omap2/Makefile
@@ -55,6 +55,12 @@  obj-$(CONFIG_PM_DEBUG)			+= pm-debug.o
 AFLAGS_sleep24xx.o			:=-Wa,-march=armv6
 AFLAGS_sleep34xx.o			:=-Wa,-march=armv7-a
 
+# Runtime PM support
+obj-$(CONFIG_PM_RUNTIME)		+= pm_runtime.o
+ifeq ($(CONFIG_PM_VERBOSE),y)
+CFLAGS_pm_runtime.o                     += -DDEBUG
+endif
+
 endif
 
 # PRCM
diff --git a/arch/arm/mach-omap2/pm_runtime.c b/arch/arm/mach-omap2/pm_runtime.c
new file mode 100644
index 0000000..4bd1b9a
--- /dev/null
+++ b/arch/arm/mach-omap2/pm_runtime.c
@@ -0,0 +1,119 @@ 
+/*
+ * Runtime PM support code for OMAP
+ *
+ * Author: Kevin Hilman, Deep Root Systems, LLC
+ *
+ * Copyright (C) 2010 Texas Instruments, Inc.
+ *
+ * This file is licensed under the terms of the GNU General Public
+ * License version 2. This program is licensed "as is" without any
+ * warranty of any kind, whether express or implied.
+ */
+#include <linux/init.h>
+#include <linux/kernel.h>
+#include <linux/io.h>
+#include <linux/pm_runtime.h>
+#include <linux/platform_device.h>
+#include <linux/mutex.h>
+
+#include <plat/omap_device.h>
+#include <plat/omap-pm.h>
+
+int platform_pm_runtime_suspend(struct device *dev)
+{
+	struct platform_device *pdev = to_platform_device(dev);
+	struct omap_device *odev = to_omap_device(pdev);
+	int ret = 0;
+
+	if (WARN_ON(!omap_device_is_valid(odev)))
+		return -ENODEV;
+
+	dev_dbg(dev, "%s\n", __func__);
+
+	if (dev->driver->pm && dev->driver->pm->runtime_suspend)
+		ret = dev->driver->pm->runtime_suspend(dev);
+	if (!ret)
+		omap_device_idle(pdev);
+
+	return ret;
+};
+
+int platform_pm_runtime_resume(struct device *dev)
+{
+	struct platform_device *pdev = to_platform_device(dev);
+	struct omap_device *odev = to_omap_device(pdev);
+	int ret = 0;
+
+	if (WARN_ON(!omap_device_is_valid(odev)))
+		return -ENODEV;
+
+	dev_dbg(dev, "%s\n", __func__);
+
+	omap_device_enable(pdev);
+
+	/*
+	 * TODO: only call drivers runtime_resume hook if
+	 *       device has lost context.
+	 */
+	if (dev->driver->pm && dev->driver->pm->runtime_resume)
+		if (omap_device_has_lost_context(pdev))
+			ret = dev->driver->pm->runtime_resume(dev);
+
+	return ret;
+};
+
+int platform_pm_runtime_idle(struct device *dev)
+{
+	struct platform_device *pdev = to_platform_device(dev);
+	struct omap_device *odev = to_omap_device(pdev);
+	int ret;
+
+	if (WARN_ON(!omap_device_is_valid(odev)))
+		return -ENODEV;
+
+	ret = pm_runtime_suspend(dev);
+	dev_dbg(dev, "%s [%d] \n", __func__, ret);
+
+	return 0;
+};
+
+static int platform_bus_notify(struct notifier_block *nb,
+			       unsigned long action, void *data)
+{
+	struct device *dev = data;
+	struct platform_device *pdev = to_platform_device(dev);
+	struct omap_device *odev = to_omap_device(pdev);
+
+	if (!omap_device_is_valid(odev))
+		return -ENODEV;
+
+	switch (action) {
+	case BUS_NOTIFY_ADD_DEVICE:
+		dev_dbg(dev, "BUS_NOTIFY_ADD_DEVICE");
+		break;
+	case BUS_NOTIFY_BOUND_DRIVER:
+		dev_dbg(dev, "BUS_NOTIFY_BOUND_DRIVER");
+		break;
+	case BUS_NOTIFY_UNBOUND_DRIVER:
+		dev_dbg(dev, "BUS_NOTIFY_UNBOUND_DRIVER");
+		break;
+	case BUS_NOTIFY_DEL_DEVICE:
+		dev_dbg(dev, "BUS_NOTIFY_DEL_DEVICE");
+		break;
+	default:
+		dev_dbg(dev, "Unknown");
+	}
+
+	return 0;
+}
+
+static struct notifier_block platform_bus_notifier = {
+	.notifier_call = platform_bus_notify
+};
+
+static int __init omap_pm_runtime_init(void)
+{
+	bus_register_notifier(&platform_bus_type, &platform_bus_notifier);
+	return 0;
+}
+core_initcall(omap_pm_runtime_init);