1 /*
2  * Marvell Armada 370, 38x and XP SoC cpuidle driver
3  *
4  * Copyright (C) 2014 Marvell
5  *
6  * Nadav Haklai <nadavh@marvell.com>
7  * Gregory CLEMENT <gregory.clement@free-electrons.com>
8  *
9  * This file is licensed under the terms of the GNU General Public
10  * License version 2.  This program is licensed "as is" without any
11  * warranty of any kind, whether express or implied.
12  *
13  * Maintainer: Gregory CLEMENT <gregory.clement@free-electrons.com>
14  */
15 
16 #include <linux/cpu_pm.h>
17 #include <linux/cpuidle.h>
18 #include <linux/module.h>
19 #include <linux/of.h>
20 #include <linux/suspend.h>
21 #include <linux/platform_device.h>
22 #include <asm/cpuidle.h>
23 
24 #define MVEBU_V7_FLAG_DEEP_IDLE	0x10000
25 
26 static int (*mvebu_v7_cpu_suspend)(int);
27 
28 static int mvebu_v7_enter_idle(struct cpuidle_device *dev,
29 				struct cpuidle_driver *drv,
30 				int index)
31 {
32 	int ret;
33 	bool deepidle = false;
34 	cpu_pm_enter();
35 
36 	if (drv->states[index].flags & MVEBU_V7_FLAG_DEEP_IDLE)
37 		deepidle = true;
38 
39 	ret = mvebu_v7_cpu_suspend(deepidle);
40 	if (ret)
41 		return ret;
42 
43 	cpu_pm_exit();
44 
45 	return index;
46 }
47 
48 static struct cpuidle_driver armadaxp_idle_driver = {
49 	.name			= "armada_xp_idle",
50 	.states[0]		= ARM_CPUIDLE_WFI_STATE,
51 	.states[1]		= {
52 		.enter			= mvebu_v7_enter_idle,
53 		.exit_latency		= 10,
54 		.power_usage		= 50,
55 		.target_residency	= 100,
56 		.name			= "MV CPU IDLE",
57 		.desc			= "CPU power down",
58 	},
59 	.states[2]		= {
60 		.enter			= mvebu_v7_enter_idle,
61 		.exit_latency		= 100,
62 		.power_usage		= 5,
63 		.target_residency	= 1000,
64 		.flags			= MVEBU_V7_FLAG_DEEP_IDLE,
65 		.name			= "MV CPU DEEP IDLE",
66 		.desc			= "CPU and L2 Fabric power down",
67 	},
68 	.state_count = 3,
69 };
70 
71 static struct cpuidle_driver armada370_idle_driver = {
72 	.name			= "armada_370_idle",
73 	.states[0]		= ARM_CPUIDLE_WFI_STATE,
74 	.states[1]		= {
75 		.enter			= mvebu_v7_enter_idle,
76 		.exit_latency		= 100,
77 		.power_usage		= 5,
78 		.target_residency	= 1000,
79 		.flags			= MVEBU_V7_FLAG_DEEP_IDLE,
80 		.name			= "Deep Idle",
81 		.desc			= "CPU and L2 Fabric power down",
82 	},
83 	.state_count = 2,
84 };
85 
86 static struct cpuidle_driver armada38x_idle_driver = {
87 	.name			= "armada_38x_idle",
88 	.states[0]		= ARM_CPUIDLE_WFI_STATE,
89 	.states[1]		= {
90 		.enter			= mvebu_v7_enter_idle,
91 		.exit_latency		= 10,
92 		.power_usage		= 5,
93 		.target_residency	= 100,
94 		.name			= "Idle",
95 		.desc			= "CPU and SCU power down",
96 	},
97 	.state_count = 2,
98 };
99 
100 static int mvebu_v7_cpuidle_probe(struct platform_device *pdev)
101 {
102 	mvebu_v7_cpu_suspend = pdev->dev.platform_data;
103 
104 	if (!strcmp(pdev->dev.driver->name, "cpuidle-armada-xp"))
105 		return cpuidle_register(&armadaxp_idle_driver, NULL);
106 	else if (!strcmp(pdev->dev.driver->name, "cpuidle-armada-370"))
107 		return cpuidle_register(&armada370_idle_driver, NULL);
108 	else if (!strcmp(pdev->dev.driver->name, "cpuidle-armada-38x"))
109 		return cpuidle_register(&armada38x_idle_driver, NULL);
110 	else
111 		return -EINVAL;
112 }
113 
114 static struct platform_driver armadaxp_cpuidle_plat_driver = {
115 	.driver = {
116 		.name = "cpuidle-armada-xp",
117 	},
118 	.probe = mvebu_v7_cpuidle_probe,
119 };
120 
121 module_platform_driver(armadaxp_cpuidle_plat_driver);
122 
123 static struct platform_driver armada370_cpuidle_plat_driver = {
124 	.driver = {
125 		.name = "cpuidle-armada-370",
126 	},
127 	.probe = mvebu_v7_cpuidle_probe,
128 };
129 
130 module_platform_driver(armada370_cpuidle_plat_driver);
131 
132 static struct platform_driver armada38x_cpuidle_plat_driver = {
133 	.driver = {
134 		.name = "cpuidle-armada-38x",
135 	},
136 	.probe = mvebu_v7_cpuidle_probe,
137 };
138 
139 module_platform_driver(armada38x_cpuidle_plat_driver);
140 
141 MODULE_AUTHOR("Gregory CLEMENT <gregory.clement@free-electrons.com>");
142 MODULE_DESCRIPTION("Marvell EBU v7 cpuidle driver");
143 MODULE_LICENSE("GPL");
144