/* * 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/init.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, }, }; builtin_platform_driver_probe(clps711x_cpuidle_driver, clps711x_cpuidle_probe);