| /* | |
| * 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); |