cpuidle: mvebu: add Armada 370 support

This commit adds the list of cpuidle states supported by the Armada
370 SoC in the cpuidle-mvebu-v7 driver, as well as the necessary logic
around it to support this SoC.

Signed-off-by: Thomas Petazzoni <thomas.petazzoni@free-electrons.com>
Acked-by: Daniel Lezcano <daniel.lezcano@linaro.org>
Link: https://lkml.kernel.org/r/1406120453-29291-13-git-send-email-thomas.petazzoni@free-electrons.com
Signed-off-by: Jason Cooper <jason@lakedaemon.net>

diff --git a/drivers/cpuidle/cpuidle-mvebu-v7.c b/drivers/cpuidle/cpuidle-mvebu-v7.c
index 7252fd8e4ef3e8956d7ab104c9c2165e0d31f95f..d23597f25093740c706ff1eb43cf5980b1d23026 100644 (file)
--- a/drivers/cpuidle/cpuidle-mvebu-v7.c
+++ b/drivers/cpuidle/cpuidle-mvebu-v7.c
@@ -70,11 +70,32 @@ static struct cpuidle_driver armadaxp_idle_driver = {
        .state_count = 3,
 };
 
+static struct cpuidle_driver armada370_idle_driver = {
+       .name                   = "armada_370_idle",
+       .states[0]              = ARM_CPUIDLE_WFI_STATE,
+       .states[1]              = {
+               .enter                  = mvebu_v7_enter_idle,
+               .exit_latency           = 100,
+               .power_usage            = 5,
+               .target_residency       = 1000,
+               .flags                  = (CPUIDLE_FLAG_TIME_VALID |
+                                          MVEBU_V7_FLAG_DEEP_IDLE),
+               .name                   = "Deep Idle",
+               .desc                   = "CPU and L2 Fabric power down",
+       },
+       .state_count = 2,
+};
+
 static int mvebu_v7_cpuidle_probe(struct platform_device *pdev)
 {
-
        mvebu_v7_cpu_suspend = pdev->dev.platform_data;
-       return cpuidle_register(&armadaxp_idle_driver, NULL);
+
+       if (!strcmp(pdev->dev.driver->name, "cpuidle-armada-xp"))
+               return cpuidle_register(&armadaxp_idle_driver, NULL);
+       else if (!strcmp(pdev->dev.driver->name, "cpuidle-armada-370"))
+               return cpuidle_register(&armada370_idle_driver, NULL);
+       else
+               return -EINVAL;
 }
 
 static struct platform_driver armadaxp_cpuidle_plat_driver = {
@@ -87,6 +108,16 @@ static struct platform_driver armadaxp_cpuidle_plat_driver = {
 
 module_platform_driver(armadaxp_cpuidle_plat_driver);
 
+static struct platform_driver armada370_cpuidle_plat_driver = {
+       .driver = {
+               .name = "cpuidle-armada-370",
+               .owner = THIS_MODULE,
+       },
+       .probe = mvebu_v7_cpuidle_probe,
+};
+
+module_platform_driver(armada370_cpuidle_plat_driver);
+
 MODULE_AUTHOR("Gregory CLEMENT <gregory.clement@free-electrons.com>");
 MODULE_DESCRIPTION("Marvell EBU v7 cpuidle driver");
 MODULE_LICENSE("GPL");