Blame view
drivers/cpuidle/cpuidle-tegra.c
9.3 KB
860fbde43 cpuidle: Refactor... |
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 |
// SPDX-License-Identifier: GPL-2.0-only /* * CPU idle driver for Tegra CPUs * * Copyright (c) 2010-2013, NVIDIA Corporation. * Copyright (c) 2011 Google, Inc. * Author: Colin Cross <ccross@android.com> * Gary King <gking@nvidia.com> * * Rework for 3.3 by Peter De Schrijver <pdeschrijver@nvidia.com> * * Tegra20/124 driver unification by Dmitry Osipenko <digetx@gmail.com> */ #define pr_fmt(fmt) "tegra-cpuidle: " fmt #include <linux/atomic.h> #include <linux/cpuidle.h> #include <linux/cpumask.h> #include <linux/cpu_pm.h> #include <linux/delay.h> #include <linux/errno.h> #include <linux/platform_device.h> #include <linux/types.h> #include <linux/clk/tegra.h> |
14e086bac cpuidle: tegra: S... |
27 |
#include <linux/firmware/trusted_foundations.h> |
860fbde43 cpuidle: Refactor... |
28 29 30 31 32 33 |
#include <soc/tegra/cpuidle.h> #include <soc/tegra/flowctrl.h> #include <soc/tegra/fuse.h> #include <soc/tegra/irq.h> #include <soc/tegra/pm.h> |
382ac8e22 cpuidle: tegra: D... |
34 |
#include <soc/tegra/pmc.h> |
860fbde43 cpuidle: Refactor... |
35 36 |
#include <asm/cpuidle.h> |
14e086bac cpuidle: tegra: S... |
37 |
#include <asm/firmware.h> |
860fbde43 cpuidle: Refactor... |
38 39 40 41 42 |
#include <asm/smp_plat.h> #include <asm/suspend.h> enum tegra_state { TEGRA_C1, |
19461a499 cpuidle: tegra: S... |
43 |
TEGRA_C7, |
860fbde43 cpuidle: Refactor... |
44 45 46 47 48 49 |
TEGRA_CC6, TEGRA_STATE_COUNT, }; static atomic_t tegra_idle_barrier; static atomic_t tegra_abort_flag; |
14e086bac cpuidle: tegra: S... |
50 51 52 53 |
static inline bool tegra_cpuidle_using_firmware(void) { return firmware_ops->prepare_idle && firmware_ops->do_idle; } |
860fbde43 cpuidle: Refactor... |
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 |
static void tegra_cpuidle_report_cpus_state(void) { unsigned long cpu, lcpu, csr; for_each_cpu(lcpu, cpu_possible_mask) { cpu = cpu_logical_map(lcpu); csr = flowctrl_read_cpu_csr(cpu); pr_err("cpu%lu: online=%d flowctrl_csr=0x%08lx ", cpu, cpu_online(lcpu), csr); } } static int tegra_cpuidle_wait_for_secondary_cpus_parking(void) { unsigned int retries = 3; while (retries--) { unsigned int delay_us = 10; unsigned int timeout_us = 500 * 1000 / delay_us; /* * The primary CPU0 core shall wait for the secondaries * shutdown in order to power-off CPU's cluster safely. * The timeout value depends on the current CPU frequency, * it takes about 40-150us in average and over 1000us in * a worst case scenario. */ do { if (tegra_cpu_rail_off_ready()) return 0; udelay(delay_us); } while (timeout_us--); pr_err("secondary CPU taking too long to park "); tegra_cpuidle_report_cpus_state(); } pr_err("timed out waiting secondaries to park "); return -ETIMEDOUT; } static void tegra_cpuidle_unpark_secondary_cpus(void) { unsigned int cpu, lcpu; for_each_cpu(lcpu, cpu_online_mask) { cpu = cpu_logical_map(lcpu); if (cpu > 0) { tegra_enable_cpu_clock(cpu); tegra_cpu_out_of_reset(cpu); flowctrl_write_cpu_halt(cpu, 0); } } } static int tegra_cpuidle_cc6_enter(unsigned int cpu) { int ret; if (cpu > 0) { ret = cpu_suspend(cpu, tegra_pm_park_secondary_cpu); } else { ret = tegra_cpuidle_wait_for_secondary_cpus_parking(); if (!ret) ret = tegra_pm_enter_lp2(); tegra_cpuidle_unpark_secondary_cpus(); } return ret; } |
19461a499 cpuidle: tegra: S... |
134 135 |
static int tegra_cpuidle_c7_enter(void) { |
14e086bac cpuidle: tegra: S... |
136 137 138 139 140 141 142 143 144 |
int err; if (tegra_cpuidle_using_firmware()) { err = call_firmware_op(prepare_idle, TF_PM_MODE_LP2_NOFLUSH_L2); if (err) return err; return call_firmware_op(do_idle, 0); } |
19461a499 cpuidle: tegra: S... |
145 146 |
return cpu_suspend(0, tegra30_pm_secondary_cpu_suspend); } |
860fbde43 cpuidle: Refactor... |
147 148 149 150 151 152 153 154 155 156 157 158 159 160 161 162 163 164 165 166 167 168 169 170 171 172 |
static int tegra_cpuidle_coupled_barrier(struct cpuidle_device *dev) { if (tegra_pending_sgi()) { /* * CPU got local interrupt that will be lost after GIC's * shutdown because GIC driver doesn't save/restore the * pending SGI state across CPU cluster PM. Abort and retry * next time. */ atomic_set(&tegra_abort_flag, 1); } cpuidle_coupled_parallel_barrier(dev, &tegra_idle_barrier); if (atomic_read(&tegra_abort_flag)) { cpuidle_coupled_parallel_barrier(dev, &tegra_idle_barrier); atomic_set(&tegra_abort_flag, 0); return -EINTR; } return 0; } static int tegra_cpuidle_state_enter(struct cpuidle_device *dev, int index, unsigned int cpu) { |
1170433e6 cpuidle: tegra: C... |
173 |
int err; |
860fbde43 cpuidle: Refactor... |
174 175 176 177 178 179 180 181 182 183 |
/* * CC6 state is the "CPU cluster power-off" state. In order to * enter this state, at first the secondary CPU cores need to be * parked into offline mode, then the last CPU should clean out * remaining dirty cache lines into DRAM and trigger Flow Controller * logic that turns off the cluster's power domain (which includes * CPU cores, GIC and L2 cache). */ if (index == TEGRA_CC6) { |
1170433e6 cpuidle: tegra: C... |
184 185 186 |
err = tegra_cpuidle_coupled_barrier(dev); if (err) return err; |
860fbde43 cpuidle: Refactor... |
187 188 189 |
} local_fiq_disable(); |
c39de538a cpuidle: tegra: A... |
190 |
RCU_NONIDLE(tegra_pm_set_cpu_in_lp2()); |
860fbde43 cpuidle: Refactor... |
191 192 193 |
cpu_pm_enter(); switch (index) { |
19461a499 cpuidle: tegra: S... |
194 |
case TEGRA_C7: |
1170433e6 cpuidle: tegra: C... |
195 |
err = tegra_cpuidle_c7_enter(); |
19461a499 cpuidle: tegra: S... |
196 |
break; |
860fbde43 cpuidle: Refactor... |
197 |
case TEGRA_CC6: |
1170433e6 cpuidle: tegra: C... |
198 |
err = tegra_cpuidle_cc6_enter(cpu); |
860fbde43 cpuidle: Refactor... |
199 200 201 |
break; default: |
1170433e6 cpuidle: tegra: C... |
202 |
err = -EINVAL; |
860fbde43 cpuidle: Refactor... |
203 204 205 206 |
break; } cpu_pm_exit(); |
c39de538a cpuidle: tegra: A... |
207 |
RCU_NONIDLE(tegra_pm_clear_cpu_in_lp2()); |
860fbde43 cpuidle: Refactor... |
208 |
local_fiq_enable(); |
1170433e6 cpuidle: tegra: C... |
209 |
return err ?: index; |
860fbde43 cpuidle: Refactor... |
210 |
} |
19461a499 cpuidle: tegra: S... |
211 212 213 214 215 216 217 218 219 220 221 222 223 224 225 226 227 |
static int tegra_cpuidle_adjust_state_index(int index, unsigned int cpu) { /* * On Tegra30 CPU0 can't be power-gated separately from secondary * cores because it gates the whole CPU cluster. */ if (cpu > 0 || index != TEGRA_C7 || tegra_get_chip_id() != TEGRA30) return index; /* put CPU0 into C1 if C7 is requested and secondaries are online */ if (!IS_ENABLED(CONFIG_PM_SLEEP) || num_online_cpus() > 1) index = TEGRA_C1; else index = TEGRA_CC6; return index; } |
860fbde43 cpuidle: Refactor... |
228 229 230 231 232 |
static int tegra_cpuidle_enter(struct cpuidle_device *dev, struct cpuidle_driver *drv, int index) { unsigned int cpu = cpu_logical_map(dev->cpu); |
1170433e6 cpuidle: tegra: C... |
233 |
int ret; |
860fbde43 cpuidle: Refactor... |
234 |
|
19461a499 cpuidle: tegra: S... |
235 236 237 238 239 |
index = tegra_cpuidle_adjust_state_index(index, cpu); if (dev->states_usage[index].disable) return -1; if (index == TEGRA_C1) |
1170433e6 cpuidle: tegra: C... |
240 |
ret = arm_cpuidle_simple_enter(dev, drv, index); |
19461a499 cpuidle: tegra: S... |
241 |
else |
1170433e6 cpuidle: tegra: C... |
242 |
ret = tegra_cpuidle_state_enter(dev, index, cpu); |
19461a499 cpuidle: tegra: S... |
243 |
|
1170433e6 cpuidle: tegra: C... |
244 245 246 247 248 249 250 251 252 |
if (ret < 0) { if (ret != -EINTR || index != TEGRA_CC6) pr_err_once("failed to enter state %d err: %d ", index, ret); index = -1; } else { index = ret; } |
860fbde43 cpuidle: Refactor... |
253 |
|
1170433e6 cpuidle: tegra: C... |
254 |
return index; |
860fbde43 cpuidle: Refactor... |
255 |
} |
efe971121 cpuidle: change e... |
256 257 258 |
static int tegra114_enter_s2idle(struct cpuidle_device *dev, struct cpuidle_driver *drv, int index) |
14e086bac cpuidle: tegra: S... |
259 260 |
{ tegra_cpuidle_enter(dev, drv, index); |
efe971121 cpuidle: change e... |
261 262 |
return 0; |
14e086bac cpuidle: tegra: S... |
263 |
} |
860fbde43 cpuidle: Refactor... |
264 265 266 267 268 269 270 271 272 273 274 275 276 277 278 279 280 281 282 283 284 |
/* * The previous versions of Tegra CPUIDLE driver used a different "legacy" * terminology for naming of the idling states, while this driver uses the * new terminology. * * Mapping of the old terms into the new ones: * * Old | New * --------- * LP3 | C1 (CPU core clock gating) * LP2 | C7 (CPU core power gating) * LP2 | CC6 (CPU cluster power gating) * * Note that that the older CPUIDLE driver versions didn't explicitly * differentiate the LP2 states because these states either used the same * code path or because CC6 wasn't supported. */ static struct cpuidle_driver tegra_idle_driver = { .name = "tegra_idle", .states = { [TEGRA_C1] = ARM_CPUIDLE_WFI_STATE_PWR(600), |
19461a499 cpuidle: tegra: S... |
285 286 287 288 289 290 291 292 293 |
[TEGRA_C7] = { .enter = tegra_cpuidle_enter, .exit_latency = 2000, .target_residency = 2200, .power_usage = 100, .flags = CPUIDLE_FLAG_TIMER_STOP, .name = "C7", .desc = "CPU core powered off", }, |
860fbde43 cpuidle: Refactor... |
294 295 296 297 298 299 300 301 302 303 304 305 306 307 308 309 310 311 312 313 314 315 316 317 318 319 320 321 322 323 324 325 326 327 328 329 330 |
[TEGRA_CC6] = { .enter = tegra_cpuidle_enter, .exit_latency = 5000, .target_residency = 10000, .power_usage = 0, .flags = CPUIDLE_FLAG_TIMER_STOP | CPUIDLE_FLAG_COUPLED, .name = "CC6", .desc = "CPU cluster powered off", }, }, .state_count = TEGRA_STATE_COUNT, .safe_state_index = TEGRA_C1, }; static inline void tegra_cpuidle_disable_state(enum tegra_state state) { cpuidle_driver_state_disabled(&tegra_idle_driver, state, true); } /* * Tegra20 HW appears to have a bug such that PCIe device interrupts, whether * they are legacy IRQs or MSI, are lost when CC6 is enabled. To work around * this, simply disable CC6 if the PCI driver and DT node are both enabled. */ void tegra_cpuidle_pcie_irqs_in_use(void) { struct cpuidle_state *state_cc6 = &tegra_idle_driver.states[TEGRA_CC6]; if ((state_cc6->flags & CPUIDLE_FLAG_UNUSABLE) || tegra_get_chip_id() != TEGRA20) return; pr_info("disabling CC6 state, since PCIe IRQs are in use "); tegra_cpuidle_disable_state(TEGRA_CC6); } |
14e086bac cpuidle: tegra: S... |
331 332 333 334 335 336 337 338 |
static void tegra_cpuidle_setup_tegra114_c7_state(void) { struct cpuidle_state *s = &tegra_idle_driver.states[TEGRA_C7]; s->enter_s2idle = tegra114_enter_s2idle; s->target_residency = 1000; s->exit_latency = 500; } |
860fbde43 cpuidle: Refactor... |
339 340 |
static int tegra_cpuidle_probe(struct platform_device *pdev) { |
382ac8e22 cpuidle: tegra: D... |
341 342 343 |
/* LP2 could be disabled in device-tree */ if (tegra_pmc_get_suspend_mode() < TEGRA_SUSPEND_LP2) tegra_cpuidle_disable_state(TEGRA_CC6); |
860fbde43 cpuidle: Refactor... |
344 345 346 347 348 |
/* * Required suspend-resume functionality, which is provided by the * Tegra-arch core and PMC driver, is unavailable if PM-sleep option * is disabled. */ |
19461a499 cpuidle: tegra: S... |
349 |
if (!IS_ENABLED(CONFIG_PM_SLEEP)) { |
14e086bac cpuidle: tegra: S... |
350 351 |
if (!tegra_cpuidle_using_firmware()) tegra_cpuidle_disable_state(TEGRA_C7); |
860fbde43 cpuidle: Refactor... |
352 |
tegra_cpuidle_disable_state(TEGRA_CC6); |
19461a499 cpuidle: tegra: S... |
353 354 355 356 357 358 359 360 361 362 363 364 365 |
} /* * Generic WFI state (also known as C1 or LP3) and the coupled CPU * cluster power-off (CC6 or LP2) states are common for all Tegra SoCs. */ switch (tegra_get_chip_id()) { case TEGRA20: /* Tegra20 isn't capable to power-off individual CPU cores */ tegra_cpuidle_disable_state(TEGRA_C7); break; case TEGRA30: |
19461a499 cpuidle: tegra: S... |
366 |
break; |
14e086bac cpuidle: tegra: S... |
367 368 369 370 371 372 373 |
case TEGRA114: case TEGRA124: tegra_cpuidle_setup_tegra114_c7_state(); /* coupled CC6 (LP2) state isn't implemented yet */ tegra_cpuidle_disable_state(TEGRA_CC6); break; |
19461a499 cpuidle: tegra: S... |
374 375 376 |
default: return -EINVAL; } |
860fbde43 cpuidle: Refactor... |
377 378 379 380 381 382 383 384 385 386 387 |
return cpuidle_register(&tegra_idle_driver, cpu_possible_mask); } static struct platform_driver tegra_cpuidle_driver = { .probe = tegra_cpuidle_probe, .driver = { .name = "tegra-cpuidle", }, }; builtin_platform_driver(tegra_cpuidle_driver); |