1 /* 2 * CLPS711X CPU idle driver 3 * 4 * Copyright (C) 2014 Alexander Shiyan <shc_work@mail.ru> 5 * 6 * This program is free software; you can redistribute it and/or modify 7 * it under the terms of the GNU General Public License as published by 8 * the Free Software Foundation; either version 2 of the License, or 9 * (at your option) any later version. 10 */ 11 12 #include <linux/cpuidle.h> 13 #include <linux/err.h> 14 #include <linux/io.h> 15 #include <linux/init.h> 16 #include <linux/platform_device.h> 17 18 #define CLPS711X_CPUIDLE_NAME "clps711x-cpuidle" 19 20 static void __iomem *clps711x_halt; 21 22 static int clps711x_cpuidle_halt(struct cpuidle_device *dev, 23 struct cpuidle_driver *drv, int index) 24 { 25 writel(0xaa, clps711x_halt); 26 27 return index; 28 } 29 30 static struct cpuidle_driver clps711x_idle_driver = { 31 .name = CLPS711X_CPUIDLE_NAME, 32 .owner = THIS_MODULE, 33 .states[0] = { 34 .name = "HALT", 35 .desc = "CLPS711X HALT", 36 .enter = clps711x_cpuidle_halt, 37 .exit_latency = 1, 38 }, 39 .state_count = 1, 40 }; 41 42 static int __init clps711x_cpuidle_probe(struct platform_device *pdev) 43 { 44 struct resource *res; 45 46 res = platform_get_resource(pdev, IORESOURCE_MEM, 0); 47 clps711x_halt = devm_ioremap_resource(&pdev->dev, res); 48 if (IS_ERR(clps711x_halt)) 49 return PTR_ERR(clps711x_halt); 50 51 return cpuidle_register(&clps711x_idle_driver, NULL); 52 } 53 54 static struct platform_driver clps711x_cpuidle_driver = { 55 .driver = { 56 .name = CLPS711X_CPUIDLE_NAME, 57 }, 58 }; 59 builtin_platform_driver_probe(clps711x_cpuidle_driver, clps711x_cpuidle_probe); 60