Merge tag 'pm+acpi-3.16-rc1' of git://git.kernel.org/pub/scm/linux/kernel/git/rafael...

[karo-tx-linux.git] / drivers / cpuidle / cpuidle-clps711x.c

diff --git a/drivers/cpuidle/cpuidle-clps711x.c b/drivers/cpuidle/cpuidle-clps711x.c
new file mode 100644 (file)
index 0000000..5243811
--- /dev/null
+++ b/drivers/cpuidle/cpuidle-clps711x.c
@@ -0,0 +1,64 @@
+/*
+ *  CLPS711X CPU idle driver
+ *
+ *  Copyright (C) 2014 Alexander Shiyan <shc_work@mail.ru>
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License as published by
+ * the Free Software Foundation; either version 2 of the License, or
+ * (at your option) any later version.
+ */
+
+#include <linux/cpuidle.h>
+#include <linux/err.h>
+#include <linux/io.h>
+#include <linux/module.h>
+#include <linux/platform_device.h>
+
+#define CLPS711X_CPUIDLE_NAME  "clps711x-cpuidle"
+
+static void __iomem *clps711x_halt;
+
+static int clps711x_cpuidle_halt(struct cpuidle_device *dev,
+                                struct cpuidle_driver *drv, int index)
+{
+       writel(0xaa, clps711x_halt);
+
+       return index;
+}
+
+static struct cpuidle_driver clps711x_idle_driver = {
+       .name           = CLPS711X_CPUIDLE_NAME,
+       .owner          = THIS_MODULE,
+       .states[0]      = {
+               .name           = "HALT",
+               .desc           = "CLPS711X HALT",
+               .enter          = clps711x_cpuidle_halt,
+               .exit_latency   = 1,
+       },
+       .state_count    = 1,
+};
+
+static int __init clps711x_cpuidle_probe(struct platform_device *pdev)
+{
+       struct resource *res;
+
+       res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
+       clps711x_halt = devm_ioremap_resource(&pdev->dev, res);
+       if (IS_ERR(clps711x_halt))
+               return PTR_ERR(clps711x_halt);
+
+       return cpuidle_register(&clps711x_idle_driver, NULL);
+}
+
+static struct platform_driver clps711x_cpuidle_driver = {
+       .driver = {
+               .name   = CLPS711X_CPUIDLE_NAME,
+               .owner  = THIS_MODULE,
+       },
+};
+module_platform_driver_probe(clps711x_cpuidle_driver, clps711x_cpuidle_probe);
+
+MODULE_AUTHOR("Alexander Shiyan <shc_work@mail.ru>");
+MODULE_DESCRIPTION("CLPS711X CPU idle driver");
+MODULE_LICENSE("GPL");