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