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