1 // SPDX-License-Identifier: GPL-2.0 2 /* 3 * drivers/base/power/main.c - Where the driver meets power management. 4 * 5 * Copyright (c) 2003 Patrick Mochel 6 * Copyright (c) 2003 Open Source Development Lab 7 * 8 * The driver model core calls device_pm_add() when a device is registered. 9 * This will initialize the embedded device_pm_info object in the device 10 * and add it to the list of power-controlled devices. sysfs entries for 11 * controlling device power management will also be added. 12 * 13 * A separate list is used for keeping track of power info, because the power 14 * domain dependencies may differ from the ancestral dependencies that the 15 * subsystem list maintains. 16 */ 17 18 #define pr_fmt(fmt) "PM: " fmt 19 #define dev_fmt pr_fmt 20 21 #include <linux/device.h> 22 #include <linux/export.h> 23 #include <linux/mutex.h> 24 #include <linux/pm.h> 25 #include <linux/pm_runtime.h> 26 #include <linux/pm-trace.h> 27 #include <linux/pm_wakeirq.h> 28 #include <linux/interrupt.h> 29 #include <linux/sched.h> 30 #include <linux/sched/debug.h> 31 #include <linux/async.h> 32 #include <linux/suspend.h> 33 #include <trace/events/power.h> 34 #include <linux/cpufreq.h> 35 #include <linux/devfreq.h> 36 #include <linux/timer.h> 37 38 #include "../base.h" 39 #include "power.h" 40 41 typedef int (*pm_callback_t)(struct device *); 42 43 #define list_for_each_entry_rcu_locked(pos, head, member) \ 44 list_for_each_entry_rcu(pos, head, member, \ 45 device_links_read_lock_held()) 46 47 /* 48 * The entries in the dpm_list list are in a depth first order, simply 49 * because children are guaranteed to be discovered after parents, and 50 * are inserted at the back of the list on discovery. 51 * 52 * Since device_pm_add() may be called with a device lock held, 53 * we must never try to acquire a device lock while holding 54 * dpm_list_mutex. 55 */ 56 57 LIST_HEAD(dpm_list); 58 static LIST_HEAD(dpm_prepared_list); 59 static LIST_HEAD(dpm_suspended_list); 60 static LIST_HEAD(dpm_late_early_list); 61 static LIST_HEAD(dpm_noirq_list); 62 63 static DEFINE_MUTEX(dpm_list_mtx); 64 static pm_message_t pm_transition; 65 66 static int async_error; 67 68 static const char *pm_verb(int event) 69 { 70 switch (event) { 71 case PM_EVENT_SUSPEND: 72 return "suspend"; 73 case PM_EVENT_RESUME: 74 return "resume"; 75 case PM_EVENT_FREEZE: 76 return "freeze"; 77 case PM_EVENT_QUIESCE: 78 return "quiesce"; 79 case PM_EVENT_HIBERNATE: 80 return "hibernate"; 81 case PM_EVENT_THAW: 82 return "thaw"; 83 case PM_EVENT_RESTORE: 84 return "restore"; 85 case PM_EVENT_RECOVER: 86 return "recover"; 87 default: 88 return "(unknown PM event)"; 89 } 90 } 91 92 /** 93 * device_pm_sleep_init - Initialize system suspend-related device fields. 94 * @dev: Device object being initialized. 95 */ 96 void device_pm_sleep_init(struct device *dev) 97 { 98 dev->power.is_prepared = false; 99 dev->power.is_suspended = false; 100 dev->power.is_noirq_suspended = false; 101 dev->power.is_late_suspended = false; 102 init_completion(&dev->power.completion); 103 complete_all(&dev->power.completion); 104 dev->power.wakeup = NULL; 105 INIT_LIST_HEAD(&dev->power.entry); 106 } 107 108 /** 109 * device_pm_lock - Lock the list of active devices used by the PM core. 110 */ 111 void device_pm_lock(void) 112 { 113 mutex_lock(&dpm_list_mtx); 114 } 115 116 /** 117 * device_pm_unlock - Unlock the list of active devices used by the PM core. 118 */ 119 void device_pm_unlock(void) 120 { 121 mutex_unlock(&dpm_list_mtx); 122 } 123 124 /** 125 * device_pm_add - Add a device to the PM core's list of active devices. 126 * @dev: Device to add to the list. 127 */ 128 void device_pm_add(struct device *dev) 129 { 130 /* Skip PM setup/initialization. */ 131 if (device_pm_not_required(dev)) 132 return; 133 134 pr_debug("Adding info for %s:%s\n", 135 dev->bus ? dev->bus->name : "No Bus", dev_name(dev)); 136 device_pm_check_callbacks(dev); 137 mutex_lock(&dpm_list_mtx); 138 if (dev->parent && dev->parent->power.is_prepared) 139 dev_warn(dev, "parent %s should not be sleeping\n", 140 dev_name(dev->parent)); 141 list_add_tail(&dev->power.entry, &dpm_list); 142 dev->power.in_dpm_list = true; 143 mutex_unlock(&dpm_list_mtx); 144 } 145 146 /** 147 * device_pm_remove - Remove a device from the PM core's list of active devices. 148 * @dev: Device to be removed from the list. 149 */ 150 void device_pm_remove(struct device *dev) 151 { 152 if (device_pm_not_required(dev)) 153 return; 154 155 pr_debug("Removing info for %s:%s\n", 156 dev->bus ? dev->bus->name : "No Bus", dev_name(dev)); 157 complete_all(&dev->power.completion); 158 mutex_lock(&dpm_list_mtx); 159 list_del_init(&dev->power.entry); 160 dev->power.in_dpm_list = false; 161 mutex_unlock(&dpm_list_mtx); 162 device_wakeup_disable(dev); 163 pm_runtime_remove(dev); 164 device_pm_check_callbacks(dev); 165 } 166 167 /** 168 * device_pm_move_before - Move device in the PM core's list of active devices. 169 * @deva: Device to move in dpm_list. 170 * @devb: Device @deva should come before. 171 */ 172 void device_pm_move_before(struct device *deva, struct device *devb) 173 { 174 pr_debug("Moving %s:%s before %s:%s\n", 175 deva->bus ? deva->bus->name : "No Bus", dev_name(deva), 176 devb->bus ? devb->bus->name : "No Bus", dev_name(devb)); 177 /* Delete deva from dpm_list and reinsert before devb. */ 178 list_move_tail(&deva->power.entry, &devb->power.entry); 179 } 180 181 /** 182 * device_pm_move_after - Move device in the PM core's list of active devices. 183 * @deva: Device to move in dpm_list. 184 * @devb: Device @deva should come after. 185 */ 186 void device_pm_move_after(struct device *deva, struct device *devb) 187 { 188 pr_debug("Moving %s:%s after %s:%s\n", 189 deva->bus ? deva->bus->name : "No Bus", dev_name(deva), 190 devb->bus ? devb->bus->name : "No Bus", dev_name(devb)); 191 /* Delete deva from dpm_list and reinsert after devb. */ 192 list_move(&deva->power.entry, &devb->power.entry); 193 } 194 195 /** 196 * device_pm_move_last - Move device to end of the PM core's list of devices. 197 * @dev: Device to move in dpm_list. 198 */ 199 void device_pm_move_last(struct device *dev) 200 { 201 pr_debug("Moving %s:%s to end of list\n", 202 dev->bus ? dev->bus->name : "No Bus", dev_name(dev)); 203 list_move_tail(&dev->power.entry, &dpm_list); 204 } 205 206 static ktime_t initcall_debug_start(struct device *dev, void *cb) 207 { 208 if (!pm_print_times_enabled) 209 return 0; 210 211 dev_info(dev, "calling %pS @ %i, parent: %s\n", cb, 212 task_pid_nr(current), 213 dev->parent ? dev_name(dev->parent) : "none"); 214 return ktime_get(); 215 } 216 217 static void initcall_debug_report(struct device *dev, ktime_t calltime, 218 void *cb, int error) 219 { 220 ktime_t rettime; 221 222 if (!pm_print_times_enabled) 223 return; 224 225 rettime = ktime_get(); 226 dev_info(dev, "%pS returned %d after %Ld usecs\n", cb, error, 227 (unsigned long long)ktime_us_delta(rettime, calltime)); 228 } 229 230 /** 231 * dpm_wait - Wait for a PM operation to complete. 232 * @dev: Device to wait for. 233 * @async: If unset, wait only if the device's power.async_suspend flag is set. 234 */ 235 static void dpm_wait(struct device *dev, bool async) 236 { 237 if (!dev) 238 return; 239 240 if (async || (pm_async_enabled && dev->power.async_suspend)) 241 wait_for_completion(&dev->power.completion); 242 } 243 244 static int dpm_wait_fn(struct device *dev, void *async_ptr) 245 { 246 dpm_wait(dev, *((bool *)async_ptr)); 247 return 0; 248 } 249 250 static void dpm_wait_for_children(struct device *dev, bool async) 251 { 252 device_for_each_child(dev, &async, dpm_wait_fn); 253 } 254 255 static void dpm_wait_for_suppliers(struct device *dev, bool async) 256 { 257 struct device_link *link; 258 int idx; 259 260 idx = device_links_read_lock(); 261 262 /* 263 * If the supplier goes away right after we've checked the link to it, 264 * we'll wait for its completion to change the state, but that's fine, 265 * because the only things that will block as a result are the SRCU 266 * callbacks freeing the link objects for the links in the list we're 267 * walking. 268 */ 269 list_for_each_entry_rcu_locked(link, &dev->links.suppliers, c_node) 270 if (READ_ONCE(link->status) != DL_STATE_DORMANT) 271 dpm_wait(link->supplier, async); 272 273 device_links_read_unlock(idx); 274 } 275 276 static bool dpm_wait_for_superior(struct device *dev, bool async) 277 { 278 struct device *parent; 279 280 /* 281 * If the device is resumed asynchronously and the parent's callback 282 * deletes both the device and the parent itself, the parent object may 283 * be freed while this function is running, so avoid that by reference 284 * counting the parent once more unless the device has been deleted 285 * already (in which case return right away). 286 */ 287 mutex_lock(&dpm_list_mtx); 288 289 if (!device_pm_initialized(dev)) { 290 mutex_unlock(&dpm_list_mtx); 291 return false; 292 } 293 294 parent = get_device(dev->parent); 295 296 mutex_unlock(&dpm_list_mtx); 297 298 dpm_wait(parent, async); 299 put_device(parent); 300 301 dpm_wait_for_suppliers(dev, async); 302 303 /* 304 * If the parent's callback has deleted the device, attempting to resume 305 * it would be invalid, so avoid doing that then. 306 */ 307 return device_pm_initialized(dev); 308 } 309 310 static void dpm_wait_for_consumers(struct device *dev, bool async) 311 { 312 struct device_link *link; 313 int idx; 314 315 idx = device_links_read_lock(); 316 317 /* 318 * The status of a device link can only be changed from "dormant" by a 319 * probe, but that cannot happen during system suspend/resume. In 320 * theory it can change to "dormant" at that time, but then it is 321 * reasonable to wait for the target device anyway (eg. if it goes 322 * away, it's better to wait for it to go away completely and then 323 * continue instead of trying to continue in parallel with its 324 * unregistration). 325 */ 326 list_for_each_entry_rcu_locked(link, &dev->links.consumers, s_node) 327 if (READ_ONCE(link->status) != DL_STATE_DORMANT) 328 dpm_wait(link->consumer, async); 329 330 device_links_read_unlock(idx); 331 } 332 333 static void dpm_wait_for_subordinate(struct device *dev, bool async) 334 { 335 dpm_wait_for_children(dev, async); 336 dpm_wait_for_consumers(dev, async); 337 } 338 339 /** 340 * pm_op - Return the PM operation appropriate for given PM event. 341 * @ops: PM operations to choose from. 342 * @state: PM transition of the system being carried out. 343 */ 344 static pm_callback_t pm_op(const struct dev_pm_ops *ops, pm_message_t state) 345 { 346 switch (state.event) { 347 #ifdef CONFIG_SUSPEND 348 case PM_EVENT_SUSPEND: 349 return ops->suspend; 350 case PM_EVENT_RESUME: 351 return ops->resume; 352 #endif /* CONFIG_SUSPEND */ 353 #ifdef CONFIG_HIBERNATE_CALLBACKS 354 case PM_EVENT_FREEZE: 355 case PM_EVENT_QUIESCE: 356 return ops->freeze; 357 case PM_EVENT_HIBERNATE: 358 return ops->poweroff; 359 case PM_EVENT_THAW: 360 case PM_EVENT_RECOVER: 361 return ops->thaw; 362 case PM_EVENT_RESTORE: 363 return ops->restore; 364 #endif /* CONFIG_HIBERNATE_CALLBACKS */ 365 } 366 367 return NULL; 368 } 369 370 /** 371 * pm_late_early_op - Return the PM operation appropriate for given PM event. 372 * @ops: PM operations to choose from. 373 * @state: PM transition of the system being carried out. 374 * 375 * Runtime PM is disabled for @dev while this function is being executed. 376 */ 377 static pm_callback_t pm_late_early_op(const struct dev_pm_ops *ops, 378 pm_message_t state) 379 { 380 switch (state.event) { 381 #ifdef CONFIG_SUSPEND 382 case PM_EVENT_SUSPEND: 383 return ops->suspend_late; 384 case PM_EVENT_RESUME: 385 return ops->resume_early; 386 #endif /* CONFIG_SUSPEND */ 387 #ifdef CONFIG_HIBERNATE_CALLBACKS 388 case PM_EVENT_FREEZE: 389 case PM_EVENT_QUIESCE: 390 return ops->freeze_late; 391 case PM_EVENT_HIBERNATE: 392 return ops->poweroff_late; 393 case PM_EVENT_THAW: 394 case PM_EVENT_RECOVER: 395 return ops->thaw_early; 396 case PM_EVENT_RESTORE: 397 return ops->restore_early; 398 #endif /* CONFIG_HIBERNATE_CALLBACKS */ 399 } 400 401 return NULL; 402 } 403 404 /** 405 * pm_noirq_op - Return the PM operation appropriate for given PM event. 406 * @ops: PM operations to choose from. 407 * @state: PM transition of the system being carried out. 408 * 409 * The driver of @dev will not receive interrupts while this function is being 410 * executed. 411 */ 412 static pm_callback_t pm_noirq_op(const struct dev_pm_ops *ops, pm_message_t state) 413 { 414 switch (state.event) { 415 #ifdef CONFIG_SUSPEND 416 case PM_EVENT_SUSPEND: 417 return ops->suspend_noirq; 418 case PM_EVENT_RESUME: 419 return ops->resume_noirq; 420 #endif /* CONFIG_SUSPEND */ 421 #ifdef CONFIG_HIBERNATE_CALLBACKS 422 case PM_EVENT_FREEZE: 423 case PM_EVENT_QUIESCE: 424 return ops->freeze_noirq; 425 case PM_EVENT_HIBERNATE: 426 return ops->poweroff_noirq; 427 case PM_EVENT_THAW: 428 case PM_EVENT_RECOVER: 429 return ops->thaw_noirq; 430 case PM_EVENT_RESTORE: 431 return ops->restore_noirq; 432 #endif /* CONFIG_HIBERNATE_CALLBACKS */ 433 } 434 435 return NULL; 436 } 437 438 static void pm_dev_dbg(struct device *dev, pm_message_t state, const char *info) 439 { 440 dev_dbg(dev, "%s%s%s driver flags: %x\n", info, pm_verb(state.event), 441 ((state.event & PM_EVENT_SLEEP) && device_may_wakeup(dev)) ? 442 ", may wakeup" : "", dev->power.driver_flags); 443 } 444 445 static void pm_dev_err(struct device *dev, pm_message_t state, const char *info, 446 int error) 447 { 448 dev_err(dev, "failed to %s%s: error %d\n", pm_verb(state.event), info, 449 error); 450 } 451 452 static void dpm_show_time(ktime_t starttime, pm_message_t state, int error, 453 const char *info) 454 { 455 ktime_t calltime; 456 u64 usecs64; 457 int usecs; 458 459 calltime = ktime_get(); 460 usecs64 = ktime_to_ns(ktime_sub(calltime, starttime)); 461 do_div(usecs64, NSEC_PER_USEC); 462 usecs = usecs64; 463 if (usecs == 0) 464 usecs = 1; 465 466 pm_pr_dbg("%s%s%s of devices %s after %ld.%03ld msecs\n", 467 info ?: "", info ? " " : "", pm_verb(state.event), 468 error ? "aborted" : "complete", 469 usecs / USEC_PER_MSEC, usecs % USEC_PER_MSEC); 470 } 471 472 static int dpm_run_callback(pm_callback_t cb, struct device *dev, 473 pm_message_t state, const char *info) 474 { 475 ktime_t calltime; 476 int error; 477 478 if (!cb) 479 return 0; 480 481 calltime = initcall_debug_start(dev, cb); 482 483 pm_dev_dbg(dev, state, info); 484 trace_device_pm_callback_start(dev, info, state.event); 485 error = cb(dev); 486 trace_device_pm_callback_end(dev, error); 487 suspend_report_result(dev, cb, error); 488 489 initcall_debug_report(dev, calltime, cb, error); 490 491 return error; 492 } 493 494 #ifdef CONFIG_DPM_WATCHDOG 495 struct dpm_watchdog { 496 struct device *dev; 497 struct task_struct *tsk; 498 struct timer_list timer; 499 }; 500 501 #define DECLARE_DPM_WATCHDOG_ON_STACK(wd) \ 502 struct dpm_watchdog wd 503 504 /** 505 * dpm_watchdog_handler - Driver suspend / resume watchdog handler. 506 * @t: The timer that PM watchdog depends on. 507 * 508 * Called when a driver has timed out suspending or resuming. 509 * There's not much we can do here to recover so panic() to 510 * capture a crash-dump in pstore. 511 */ 512 static void dpm_watchdog_handler(struct timer_list *t) 513 { 514 struct dpm_watchdog *wd = from_timer(wd, t, timer); 515 516 dev_emerg(wd->dev, "**** DPM device timeout ****\n"); 517 show_stack(wd->tsk, NULL, KERN_EMERG); 518 panic("%s %s: unrecoverable failure\n", 519 dev_driver_string(wd->dev), dev_name(wd->dev)); 520 } 521 522 /** 523 * dpm_watchdog_set - Enable pm watchdog for given device. 524 * @wd: Watchdog. Must be allocated on the stack. 525 * @dev: Device to handle. 526 */ 527 static void dpm_watchdog_set(struct dpm_watchdog *wd, struct device *dev) 528 { 529 struct timer_list *timer = &wd->timer; 530 531 wd->dev = dev; 532 wd->tsk = current; 533 534 timer_setup_on_stack(timer, dpm_watchdog_handler, 0); 535 /* use same timeout value for both suspend and resume */ 536 timer->expires = jiffies + HZ * CONFIG_DPM_WATCHDOG_TIMEOUT; 537 add_timer(timer); 538 } 539 540 /** 541 * dpm_watchdog_clear - Disable suspend/resume watchdog. 542 * @wd: Watchdog to disable. 543 */ 544 static void dpm_watchdog_clear(struct dpm_watchdog *wd) 545 { 546 struct timer_list *timer = &wd->timer; 547 548 del_timer_sync(timer); 549 destroy_timer_on_stack(timer); 550 } 551 #else 552 #define DECLARE_DPM_WATCHDOG_ON_STACK(wd) 553 #define dpm_watchdog_set(x, y) 554 #define dpm_watchdog_clear(x) 555 #endif 556 557 /*------------------------- Resume routines -------------------------*/ 558 559 /** 560 * dev_pm_skip_resume - System-wide device resume optimization check. 561 * @dev: Target device. 562 * 563 * Return: 564 * - %false if the transition under way is RESTORE. 565 * - Return value of dev_pm_skip_suspend() if the transition under way is THAW. 566 * - The logical negation of %power.must_resume otherwise (that is, when the 567 * transition under way is RESUME). 568 */ 569 bool dev_pm_skip_resume(struct device *dev) 570 { 571 if (pm_transition.event == PM_EVENT_RESTORE) 572 return false; 573 574 if (pm_transition.event == PM_EVENT_THAW) 575 return dev_pm_skip_suspend(dev); 576 577 return !dev->power.must_resume; 578 } 579 580 static bool is_async(struct device *dev) 581 { 582 return dev->power.async_suspend && pm_async_enabled 583 && !pm_trace_is_enabled(); 584 } 585 586 static bool dpm_async_fn(struct device *dev, async_func_t func) 587 { 588 reinit_completion(&dev->power.completion); 589 590 if (is_async(dev)) { 591 dev->power.async_in_progress = true; 592 593 get_device(dev); 594 595 if (async_schedule_dev_nocall(func, dev)) 596 return true; 597 598 put_device(dev); 599 } 600 /* 601 * Because async_schedule_dev_nocall() above has returned false or it 602 * has not been called at all, func() is not running and it is safe to 603 * update the async_in_progress flag without extra synchronization. 604 */ 605 dev->power.async_in_progress = false; 606 return false; 607 } 608 609 /** 610 * device_resume_noirq - Execute a "noirq resume" callback for given device. 611 * @dev: Device to handle. 612 * @state: PM transition of the system being carried out. 613 * @async: If true, the device is being resumed asynchronously. 614 * 615 * The driver of @dev will not receive interrupts while this function is being 616 * executed. 617 */ 618 static void device_resume_noirq(struct device *dev, pm_message_t state, bool async) 619 { 620 pm_callback_t callback = NULL; 621 const char *info = NULL; 622 bool skip_resume; 623 int error = 0; 624 625 TRACE_DEVICE(dev); 626 TRACE_RESUME(0); 627 628 if (dev->power.syscore || dev->power.direct_complete) 629 goto Out; 630 631 if (!dev->power.is_noirq_suspended) 632 goto Out; 633 634 if (!dpm_wait_for_superior(dev, async)) 635 goto Out; 636 637 skip_resume = dev_pm_skip_resume(dev); 638 /* 639 * If the driver callback is skipped below or by the middle layer 640 * callback and device_resume_early() also skips the driver callback for 641 * this device later, it needs to appear as "suspended" to PM-runtime, 642 * so change its status accordingly. 643 * 644 * Otherwise, the device is going to be resumed, so set its PM-runtime 645 * status to "active", but do that only if DPM_FLAG_SMART_SUSPEND is set 646 * to avoid confusing drivers that don't use it. 647 */ 648 if (skip_resume) 649 pm_runtime_set_suspended(dev); 650 else if (dev_pm_skip_suspend(dev)) 651 pm_runtime_set_active(dev); 652 653 if (dev->pm_domain) { 654 info = "noirq power domain "; 655 callback = pm_noirq_op(&dev->pm_domain->ops, state); 656 } else if (dev->type && dev->type->pm) { 657 info = "noirq type "; 658 callback = pm_noirq_op(dev->type->pm, state); 659 } else if (dev->class && dev->class->pm) { 660 info = "noirq class "; 661 callback = pm_noirq_op(dev->class->pm, state); 662 } else if (dev->bus && dev->bus->pm) { 663 info = "noirq bus "; 664 callback = pm_noirq_op(dev->bus->pm, state); 665 } 666 if (callback) 667 goto Run; 668 669 if (skip_resume) 670 goto Skip; 671 672 if (dev->driver && dev->driver->pm) { 673 info = "noirq driver "; 674 callback = pm_noirq_op(dev->driver->pm, state); 675 } 676 677 Run: 678 error = dpm_run_callback(callback, dev, state, info); 679 680 Skip: 681 dev->power.is_noirq_suspended = false; 682 683 Out: 684 complete_all(&dev->power.completion); 685 TRACE_RESUME(error); 686 687 if (error) { 688 async_error = error; 689 dpm_save_failed_dev(dev_name(dev)); 690 pm_dev_err(dev, state, async ? " async noirq" : " noirq", error); 691 } 692 } 693 694 static void async_resume_noirq(void *data, async_cookie_t cookie) 695 { 696 struct device *dev = data; 697 698 device_resume_noirq(dev, pm_transition, true); 699 put_device(dev); 700 } 701 702 static void dpm_noirq_resume_devices(pm_message_t state) 703 { 704 struct device *dev; 705 ktime_t starttime = ktime_get(); 706 707 trace_suspend_resume(TPS("dpm_resume_noirq"), state.event, true); 708 709 async_error = 0; 710 711 mutex_lock(&dpm_list_mtx); 712 pm_transition = state; 713 714 /* 715 * Trigger the resume of "async" devices upfront so they don't have to 716 * wait for the "non-async" ones they don't depend on. 717 */ 718 list_for_each_entry(dev, &dpm_noirq_list, power.entry) 719 dpm_async_fn(dev, async_resume_noirq); 720 721 while (!list_empty(&dpm_noirq_list)) { 722 dev = to_device(dpm_noirq_list.next); 723 list_move_tail(&dev->power.entry, &dpm_late_early_list); 724 725 if (!dev->power.async_in_progress) { 726 get_device(dev); 727 728 mutex_unlock(&dpm_list_mtx); 729 730 device_resume_noirq(dev, state, false); 731 732 put_device(dev); 733 734 mutex_lock(&dpm_list_mtx); 735 } 736 } 737 mutex_unlock(&dpm_list_mtx); 738 async_synchronize_full(); 739 dpm_show_time(starttime, state, 0, "noirq"); 740 if (async_error) 741 dpm_save_failed_step(SUSPEND_RESUME_NOIRQ); 742 743 trace_suspend_resume(TPS("dpm_resume_noirq"), state.event, false); 744 } 745 746 /** 747 * dpm_resume_noirq - Execute "noirq resume" callbacks for all devices. 748 * @state: PM transition of the system being carried out. 749 * 750 * Invoke the "noirq" resume callbacks for all devices in dpm_noirq_list and 751 * allow device drivers' interrupt handlers to be called. 752 */ 753 void dpm_resume_noirq(pm_message_t state) 754 { 755 dpm_noirq_resume_devices(state); 756 757 resume_device_irqs(); 758 device_wakeup_disarm_wake_irqs(); 759 } 760 761 /** 762 * device_resume_early - Execute an "early resume" callback for given device. 763 * @dev: Device to handle. 764 * @state: PM transition of the system being carried out. 765 * @async: If true, the device is being resumed asynchronously. 766 * 767 * Runtime PM is disabled for @dev while this function is being executed. 768 */ 769 static void device_resume_early(struct device *dev, pm_message_t state, bool async) 770 { 771 pm_callback_t callback = NULL; 772 const char *info = NULL; 773 int error = 0; 774 775 TRACE_DEVICE(dev); 776 TRACE_RESUME(0); 777 778 if (dev->power.syscore || dev->power.direct_complete) 779 goto Out; 780 781 if (!dev->power.is_late_suspended) 782 goto Out; 783 784 if (!dpm_wait_for_superior(dev, async)) 785 goto Out; 786 787 if (dev->pm_domain) { 788 info = "early power domain "; 789 callback = pm_late_early_op(&dev->pm_domain->ops, state); 790 } else if (dev->type && dev->type->pm) { 791 info = "early type "; 792 callback = pm_late_early_op(dev->type->pm, state); 793 } else if (dev->class && dev->class->pm) { 794 info = "early class "; 795 callback = pm_late_early_op(dev->class->pm, state); 796 } else if (dev->bus && dev->bus->pm) { 797 info = "early bus "; 798 callback = pm_late_early_op(dev->bus->pm, state); 799 } 800 if (callback) 801 goto Run; 802 803 if (dev_pm_skip_resume(dev)) 804 goto Skip; 805 806 if (dev->driver && dev->driver->pm) { 807 info = "early driver "; 808 callback = pm_late_early_op(dev->driver->pm, state); 809 } 810 811 Run: 812 error = dpm_run_callback(callback, dev, state, info); 813 814 Skip: 815 dev->power.is_late_suspended = false; 816 817 Out: 818 TRACE_RESUME(error); 819 820 pm_runtime_enable(dev); 821 complete_all(&dev->power.completion); 822 823 if (error) { 824 async_error = error; 825 dpm_save_failed_dev(dev_name(dev)); 826 pm_dev_err(dev, state, async ? " async early" : " early", error); 827 } 828 } 829 830 static void async_resume_early(void *data, async_cookie_t cookie) 831 { 832 struct device *dev = data; 833 834 device_resume_early(dev, pm_transition, true); 835 put_device(dev); 836 } 837 838 /** 839 * dpm_resume_early - Execute "early resume" callbacks for all devices. 840 * @state: PM transition of the system being carried out. 841 */ 842 void dpm_resume_early(pm_message_t state) 843 { 844 struct device *dev; 845 ktime_t starttime = ktime_get(); 846 847 trace_suspend_resume(TPS("dpm_resume_early"), state.event, true); 848 849 async_error = 0; 850 851 mutex_lock(&dpm_list_mtx); 852 pm_transition = state; 853 854 /* 855 * Trigger the resume of "async" devices upfront so they don't have to 856 * wait for the "non-async" ones they don't depend on. 857 */ 858 list_for_each_entry(dev, &dpm_late_early_list, power.entry) 859 dpm_async_fn(dev, async_resume_early); 860 861 while (!list_empty(&dpm_late_early_list)) { 862 dev = to_device(dpm_late_early_list.next); 863 list_move_tail(&dev->power.entry, &dpm_suspended_list); 864 865 if (!dev->power.async_in_progress) { 866 get_device(dev); 867 868 mutex_unlock(&dpm_list_mtx); 869 870 device_resume_early(dev, state, false); 871 872 put_device(dev); 873 874 mutex_lock(&dpm_list_mtx); 875 } 876 } 877 mutex_unlock(&dpm_list_mtx); 878 async_synchronize_full(); 879 dpm_show_time(starttime, state, 0, "early"); 880 if (async_error) 881 dpm_save_failed_step(SUSPEND_RESUME_EARLY); 882 883 trace_suspend_resume(TPS("dpm_resume_early"), state.event, false); 884 } 885 886 /** 887 * dpm_resume_start - Execute "noirq" and "early" device callbacks. 888 * @state: PM transition of the system being carried out. 889 */ 890 void dpm_resume_start(pm_message_t state) 891 { 892 dpm_resume_noirq(state); 893 dpm_resume_early(state); 894 } 895 EXPORT_SYMBOL_GPL(dpm_resume_start); 896 897 /** 898 * device_resume - Execute "resume" callbacks for given device. 899 * @dev: Device to handle. 900 * @state: PM transition of the system being carried out. 901 * @async: If true, the device is being resumed asynchronously. 902 */ 903 static void device_resume(struct device *dev, pm_message_t state, bool async) 904 { 905 pm_callback_t callback = NULL; 906 const char *info = NULL; 907 int error = 0; 908 DECLARE_DPM_WATCHDOG_ON_STACK(wd); 909 910 TRACE_DEVICE(dev); 911 TRACE_RESUME(0); 912 913 if (dev->power.syscore) 914 goto Complete; 915 916 if (dev->power.direct_complete) { 917 /* Match the pm_runtime_disable() in __device_suspend(). */ 918 pm_runtime_enable(dev); 919 goto Complete; 920 } 921 922 if (!dpm_wait_for_superior(dev, async)) 923 goto Complete; 924 925 dpm_watchdog_set(&wd, dev); 926 device_lock(dev); 927 928 /* 929 * This is a fib. But we'll allow new children to be added below 930 * a resumed device, even if the device hasn't been completed yet. 931 */ 932 dev->power.is_prepared = false; 933 934 if (!dev->power.is_suspended) 935 goto Unlock; 936 937 if (dev->pm_domain) { 938 info = "power domain "; 939 callback = pm_op(&dev->pm_domain->ops, state); 940 goto Driver; 941 } 942 943 if (dev->type && dev->type->pm) { 944 info = "type "; 945 callback = pm_op(dev->type->pm, state); 946 goto Driver; 947 } 948 949 if (dev->class && dev->class->pm) { 950 info = "class "; 951 callback = pm_op(dev->class->pm, state); 952 goto Driver; 953 } 954 955 if (dev->bus) { 956 if (dev->bus->pm) { 957 info = "bus "; 958 callback = pm_op(dev->bus->pm, state); 959 } else if (dev->bus->resume) { 960 info = "legacy bus "; 961 callback = dev->bus->resume; 962 goto End; 963 } 964 } 965 966 Driver: 967 if (!callback && dev->driver && dev->driver->pm) { 968 info = "driver "; 969 callback = pm_op(dev->driver->pm, state); 970 } 971 972 End: 973 error = dpm_run_callback(callback, dev, state, info); 974 dev->power.is_suspended = false; 975 976 Unlock: 977 device_unlock(dev); 978 dpm_watchdog_clear(&wd); 979 980 Complete: 981 complete_all(&dev->power.completion); 982 983 TRACE_RESUME(error); 984 985 if (error) { 986 async_error = error; 987 dpm_save_failed_dev(dev_name(dev)); 988 pm_dev_err(dev, state, async ? " async" : "", error); 989 } 990 } 991 992 static void async_resume(void *data, async_cookie_t cookie) 993 { 994 struct device *dev = data; 995 996 device_resume(dev, pm_transition, true); 997 put_device(dev); 998 } 999 1000 /** 1001 * dpm_resume - Execute "resume" callbacks for non-sysdev devices. 1002 * @state: PM transition of the system being carried out. 1003 * 1004 * Execute the appropriate "resume" callback for all devices whose status 1005 * indicates that they are suspended. 1006 */ 1007 void dpm_resume(pm_message_t state) 1008 { 1009 struct device *dev; 1010 ktime_t starttime = ktime_get(); 1011 1012 trace_suspend_resume(TPS("dpm_resume"), state.event, true); 1013 might_sleep(); 1014 1015 mutex_lock(&dpm_list_mtx); 1016 pm_transition = state; 1017 async_error = 0; 1018 1019 /* 1020 * Trigger the resume of "async" devices upfront so they don't have to 1021 * wait for the "non-async" ones they don't depend on. 1022 */ 1023 list_for_each_entry(dev, &dpm_suspended_list, power.entry) 1024 dpm_async_fn(dev, async_resume); 1025 1026 while (!list_empty(&dpm_suspended_list)) { 1027 dev = to_device(dpm_suspended_list.next); 1028 list_move_tail(&dev->power.entry, &dpm_prepared_list); 1029 1030 if (!dev->power.async_in_progress) { 1031 get_device(dev); 1032 1033 mutex_unlock(&dpm_list_mtx); 1034 1035 device_resume(dev, state, false); 1036 1037 put_device(dev); 1038 1039 mutex_lock(&dpm_list_mtx); 1040 } 1041 } 1042 mutex_unlock(&dpm_list_mtx); 1043 async_synchronize_full(); 1044 dpm_show_time(starttime, state, 0, NULL); 1045 if (async_error) 1046 dpm_save_failed_step(SUSPEND_RESUME); 1047 1048 cpufreq_resume(); 1049 devfreq_resume(); 1050 trace_suspend_resume(TPS("dpm_resume"), state.event, false); 1051 } 1052 1053 /** 1054 * device_complete - Complete a PM transition for given device. 1055 * @dev: Device to handle. 1056 * @state: PM transition of the system being carried out. 1057 */ 1058 static void device_complete(struct device *dev, pm_message_t state) 1059 { 1060 void (*callback)(struct device *) = NULL; 1061 const char *info = NULL; 1062 1063 if (dev->power.syscore) 1064 goto out; 1065 1066 device_lock(dev); 1067 1068 if (dev->pm_domain) { 1069 info = "completing power domain "; 1070 callback = dev->pm_domain->ops.complete; 1071 } else if (dev->type && dev->type->pm) { 1072 info = "completing type "; 1073 callback = dev->type->pm->complete; 1074 } else if (dev->class && dev->class->pm) { 1075 info = "completing class "; 1076 callback = dev->class->pm->complete; 1077 } else if (dev->bus && dev->bus->pm) { 1078 info = "completing bus "; 1079 callback = dev->bus->pm->complete; 1080 } 1081 1082 if (!callback && dev->driver && dev->driver->pm) { 1083 info = "completing driver "; 1084 callback = dev->driver->pm->complete; 1085 } 1086 1087 if (callback) { 1088 pm_dev_dbg(dev, state, info); 1089 callback(dev); 1090 } 1091 1092 device_unlock(dev); 1093 1094 out: 1095 pm_runtime_put(dev); 1096 } 1097 1098 /** 1099 * dpm_complete - Complete a PM transition for all non-sysdev devices. 1100 * @state: PM transition of the system being carried out. 1101 * 1102 * Execute the ->complete() callbacks for all devices whose PM status is not 1103 * DPM_ON (this allows new devices to be registered). 1104 */ 1105 void dpm_complete(pm_message_t state) 1106 { 1107 struct list_head list; 1108 1109 trace_suspend_resume(TPS("dpm_complete"), state.event, true); 1110 might_sleep(); 1111 1112 INIT_LIST_HEAD(&list); 1113 mutex_lock(&dpm_list_mtx); 1114 while (!list_empty(&dpm_prepared_list)) { 1115 struct device *dev = to_device(dpm_prepared_list.prev); 1116 1117 get_device(dev); 1118 dev->power.is_prepared = false; 1119 list_move(&dev->power.entry, &list); 1120 1121 mutex_unlock(&dpm_list_mtx); 1122 1123 trace_device_pm_callback_start(dev, "", state.event); 1124 device_complete(dev, state); 1125 trace_device_pm_callback_end(dev, 0); 1126 1127 put_device(dev); 1128 1129 mutex_lock(&dpm_list_mtx); 1130 } 1131 list_splice(&list, &dpm_list); 1132 mutex_unlock(&dpm_list_mtx); 1133 1134 /* Allow device probing and trigger re-probing of deferred devices */ 1135 device_unblock_probing(); 1136 trace_suspend_resume(TPS("dpm_complete"), state.event, false); 1137 } 1138 1139 /** 1140 * dpm_resume_end - Execute "resume" callbacks and complete system transition. 1141 * @state: PM transition of the system being carried out. 1142 * 1143 * Execute "resume" callbacks for all devices and complete the PM transition of 1144 * the system. 1145 */ 1146 void dpm_resume_end(pm_message_t state) 1147 { 1148 dpm_resume(state); 1149 dpm_complete(state); 1150 } 1151 EXPORT_SYMBOL_GPL(dpm_resume_end); 1152 1153 1154 /*------------------------- Suspend routines -------------------------*/ 1155 1156 /** 1157 * resume_event - Return a "resume" message for given "suspend" sleep state. 1158 * @sleep_state: PM message representing a sleep state. 1159 * 1160 * Return a PM message representing the resume event corresponding to given 1161 * sleep state. 1162 */ 1163 static pm_message_t resume_event(pm_message_t sleep_state) 1164 { 1165 switch (sleep_state.event) { 1166 case PM_EVENT_SUSPEND: 1167 return PMSG_RESUME; 1168 case PM_EVENT_FREEZE: 1169 case PM_EVENT_QUIESCE: 1170 return PMSG_RECOVER; 1171 case PM_EVENT_HIBERNATE: 1172 return PMSG_RESTORE; 1173 } 1174 return PMSG_ON; 1175 } 1176 1177 static void dpm_superior_set_must_resume(struct device *dev) 1178 { 1179 struct device_link *link; 1180 int idx; 1181 1182 if (dev->parent) 1183 dev->parent->power.must_resume = true; 1184 1185 idx = device_links_read_lock(); 1186 1187 list_for_each_entry_rcu_locked(link, &dev->links.suppliers, c_node) 1188 link->supplier->power.must_resume = true; 1189 1190 device_links_read_unlock(idx); 1191 } 1192 1193 /** 1194 * __device_suspend_noirq - Execute a "noirq suspend" callback for given device. 1195 * @dev: Device to handle. 1196 * @state: PM transition of the system being carried out. 1197 * @async: If true, the device is being suspended asynchronously. 1198 * 1199 * The driver of @dev will not receive interrupts while this function is being 1200 * executed. 1201 */ 1202 static int __device_suspend_noirq(struct device *dev, pm_message_t state, bool async) 1203 { 1204 pm_callback_t callback = NULL; 1205 const char *info = NULL; 1206 int error = 0; 1207 1208 TRACE_DEVICE(dev); 1209 TRACE_SUSPEND(0); 1210 1211 dpm_wait_for_subordinate(dev, async); 1212 1213 if (async_error) 1214 goto Complete; 1215 1216 if (dev->power.syscore || dev->power.direct_complete) 1217 goto Complete; 1218 1219 if (dev->pm_domain) { 1220 info = "noirq power domain "; 1221 callback = pm_noirq_op(&dev->pm_domain->ops, state); 1222 } else if (dev->type && dev->type->pm) { 1223 info = "noirq type "; 1224 callback = pm_noirq_op(dev->type->pm, state); 1225 } else if (dev->class && dev->class->pm) { 1226 info = "noirq class "; 1227 callback = pm_noirq_op(dev->class->pm, state); 1228 } else if (dev->bus && dev->bus->pm) { 1229 info = "noirq bus "; 1230 callback = pm_noirq_op(dev->bus->pm, state); 1231 } 1232 if (callback) 1233 goto Run; 1234 1235 if (dev_pm_skip_suspend(dev)) 1236 goto Skip; 1237 1238 if (dev->driver && dev->driver->pm) { 1239 info = "noirq driver "; 1240 callback = pm_noirq_op(dev->driver->pm, state); 1241 } 1242 1243 Run: 1244 error = dpm_run_callback(callback, dev, state, info); 1245 if (error) { 1246 async_error = error; 1247 dpm_save_failed_dev(dev_name(dev)); 1248 pm_dev_err(dev, state, async ? " async noirq" : " noirq", error); 1249 goto Complete; 1250 } 1251 1252 Skip: 1253 dev->power.is_noirq_suspended = true; 1254 1255 /* 1256 * Skipping the resume of devices that were in use right before the 1257 * system suspend (as indicated by their PM-runtime usage counters) 1258 * would be suboptimal. Also resume them if doing that is not allowed 1259 * to be skipped. 1260 */ 1261 if (atomic_read(&dev->power.usage_count) > 1 || 1262 !(dev_pm_test_driver_flags(dev, DPM_FLAG_MAY_SKIP_RESUME) && 1263 dev->power.may_skip_resume)) 1264 dev->power.must_resume = true; 1265 1266 if (dev->power.must_resume) 1267 dpm_superior_set_must_resume(dev); 1268 1269 Complete: 1270 complete_all(&dev->power.completion); 1271 TRACE_SUSPEND(error); 1272 return error; 1273 } 1274 1275 static void async_suspend_noirq(void *data, async_cookie_t cookie) 1276 { 1277 struct device *dev = data; 1278 1279 __device_suspend_noirq(dev, pm_transition, true); 1280 put_device(dev); 1281 } 1282 1283 static int device_suspend_noirq(struct device *dev) 1284 { 1285 if (dpm_async_fn(dev, async_suspend_noirq)) 1286 return 0; 1287 1288 return __device_suspend_noirq(dev, pm_transition, false); 1289 } 1290 1291 static int dpm_noirq_suspend_devices(pm_message_t state) 1292 { 1293 ktime_t starttime = ktime_get(); 1294 int error = 0; 1295 1296 trace_suspend_resume(TPS("dpm_suspend_noirq"), state.event, true); 1297 mutex_lock(&dpm_list_mtx); 1298 pm_transition = state; 1299 async_error = 0; 1300 1301 while (!list_empty(&dpm_late_early_list)) { 1302 struct device *dev = to_device(dpm_late_early_list.prev); 1303 1304 get_device(dev); 1305 mutex_unlock(&dpm_list_mtx); 1306 1307 error = device_suspend_noirq(dev); 1308 1309 mutex_lock(&dpm_list_mtx); 1310 1311 if (!error && !list_empty(&dev->power.entry)) 1312 list_move(&dev->power.entry, &dpm_noirq_list); 1313 1314 mutex_unlock(&dpm_list_mtx); 1315 1316 put_device(dev); 1317 1318 mutex_lock(&dpm_list_mtx); 1319 1320 if (error || async_error) 1321 break; 1322 } 1323 mutex_unlock(&dpm_list_mtx); 1324 async_synchronize_full(); 1325 if (!error) 1326 error = async_error; 1327 1328 if (error) 1329 dpm_save_failed_step(SUSPEND_SUSPEND_NOIRQ); 1330 1331 dpm_show_time(starttime, state, error, "noirq"); 1332 trace_suspend_resume(TPS("dpm_suspend_noirq"), state.event, false); 1333 return error; 1334 } 1335 1336 /** 1337 * dpm_suspend_noirq - Execute "noirq suspend" callbacks for all devices. 1338 * @state: PM transition of the system being carried out. 1339 * 1340 * Prevent device drivers' interrupt handlers from being called and invoke 1341 * "noirq" suspend callbacks for all non-sysdev devices. 1342 */ 1343 int dpm_suspend_noirq(pm_message_t state) 1344 { 1345 int ret; 1346 1347 device_wakeup_arm_wake_irqs(); 1348 suspend_device_irqs(); 1349 1350 ret = dpm_noirq_suspend_devices(state); 1351 if (ret) 1352 dpm_resume_noirq(resume_event(state)); 1353 1354 return ret; 1355 } 1356 1357 static void dpm_propagate_wakeup_to_parent(struct device *dev) 1358 { 1359 struct device *parent = dev->parent; 1360 1361 if (!parent) 1362 return; 1363 1364 spin_lock_irq(&parent->power.lock); 1365 1366 if (device_wakeup_path(dev) && !parent->power.ignore_children) 1367 parent->power.wakeup_path = true; 1368 1369 spin_unlock_irq(&parent->power.lock); 1370 } 1371 1372 /** 1373 * __device_suspend_late - Execute a "late suspend" callback for given device. 1374 * @dev: Device to handle. 1375 * @state: PM transition of the system being carried out. 1376 * @async: If true, the device is being suspended asynchronously. 1377 * 1378 * Runtime PM is disabled for @dev while this function is being executed. 1379 */ 1380 static int __device_suspend_late(struct device *dev, pm_message_t state, bool async) 1381 { 1382 pm_callback_t callback = NULL; 1383 const char *info = NULL; 1384 int error = 0; 1385 1386 TRACE_DEVICE(dev); 1387 TRACE_SUSPEND(0); 1388 1389 __pm_runtime_disable(dev, false); 1390 1391 dpm_wait_for_subordinate(dev, async); 1392 1393 if (async_error) 1394 goto Complete; 1395 1396 if (pm_wakeup_pending()) { 1397 async_error = -EBUSY; 1398 goto Complete; 1399 } 1400 1401 if (dev->power.syscore || dev->power.direct_complete) 1402 goto Complete; 1403 1404 if (dev->pm_domain) { 1405 info = "late power domain "; 1406 callback = pm_late_early_op(&dev->pm_domain->ops, state); 1407 } else if (dev->type && dev->type->pm) { 1408 info = "late type "; 1409 callback = pm_late_early_op(dev->type->pm, state); 1410 } else if (dev->class && dev->class->pm) { 1411 info = "late class "; 1412 callback = pm_late_early_op(dev->class->pm, state); 1413 } else if (dev->bus && dev->bus->pm) { 1414 info = "late bus "; 1415 callback = pm_late_early_op(dev->bus->pm, state); 1416 } 1417 if (callback) 1418 goto Run; 1419 1420 if (dev_pm_skip_suspend(dev)) 1421 goto Skip; 1422 1423 if (dev->driver && dev->driver->pm) { 1424 info = "late driver "; 1425 callback = pm_late_early_op(dev->driver->pm, state); 1426 } 1427 1428 Run: 1429 error = dpm_run_callback(callback, dev, state, info); 1430 if (error) { 1431 async_error = error; 1432 dpm_save_failed_dev(dev_name(dev)); 1433 pm_dev_err(dev, state, async ? " async late" : " late", error); 1434 goto Complete; 1435 } 1436 dpm_propagate_wakeup_to_parent(dev); 1437 1438 Skip: 1439 dev->power.is_late_suspended = true; 1440 1441 Complete: 1442 TRACE_SUSPEND(error); 1443 complete_all(&dev->power.completion); 1444 return error; 1445 } 1446 1447 static void async_suspend_late(void *data, async_cookie_t cookie) 1448 { 1449 struct device *dev = data; 1450 1451 __device_suspend_late(dev, pm_transition, true); 1452 put_device(dev); 1453 } 1454 1455 static int device_suspend_late(struct device *dev) 1456 { 1457 if (dpm_async_fn(dev, async_suspend_late)) 1458 return 0; 1459 1460 return __device_suspend_late(dev, pm_transition, false); 1461 } 1462 1463 /** 1464 * dpm_suspend_late - Execute "late suspend" callbacks for all devices. 1465 * @state: PM transition of the system being carried out. 1466 */ 1467 int dpm_suspend_late(pm_message_t state) 1468 { 1469 ktime_t starttime = ktime_get(); 1470 int error = 0; 1471 1472 trace_suspend_resume(TPS("dpm_suspend_late"), state.event, true); 1473 wake_up_all_idle_cpus(); 1474 mutex_lock(&dpm_list_mtx); 1475 pm_transition = state; 1476 async_error = 0; 1477 1478 while (!list_empty(&dpm_suspended_list)) { 1479 struct device *dev = to_device(dpm_suspended_list.prev); 1480 1481 get_device(dev); 1482 1483 mutex_unlock(&dpm_list_mtx); 1484 1485 error = device_suspend_late(dev); 1486 1487 mutex_lock(&dpm_list_mtx); 1488 1489 if (!list_empty(&dev->power.entry)) 1490 list_move(&dev->power.entry, &dpm_late_early_list); 1491 1492 mutex_unlock(&dpm_list_mtx); 1493 1494 put_device(dev); 1495 1496 mutex_lock(&dpm_list_mtx); 1497 1498 if (error || async_error) 1499 break; 1500 } 1501 mutex_unlock(&dpm_list_mtx); 1502 async_synchronize_full(); 1503 if (!error) 1504 error = async_error; 1505 1506 if (error) { 1507 dpm_save_failed_step(SUSPEND_SUSPEND_LATE); 1508 dpm_resume_early(resume_event(state)); 1509 } 1510 dpm_show_time(starttime, state, error, "late"); 1511 trace_suspend_resume(TPS("dpm_suspend_late"), state.event, false); 1512 return error; 1513 } 1514 1515 /** 1516 * dpm_suspend_end - Execute "late" and "noirq" device suspend callbacks. 1517 * @state: PM transition of the system being carried out. 1518 */ 1519 int dpm_suspend_end(pm_message_t state) 1520 { 1521 ktime_t starttime = ktime_get(); 1522 int error; 1523 1524 error = dpm_suspend_late(state); 1525 if (error) 1526 goto out; 1527 1528 error = dpm_suspend_noirq(state); 1529 if (error) 1530 dpm_resume_early(resume_event(state)); 1531 1532 out: 1533 dpm_show_time(starttime, state, error, "end"); 1534 return error; 1535 } 1536 EXPORT_SYMBOL_GPL(dpm_suspend_end); 1537 1538 /** 1539 * legacy_suspend - Execute a legacy (bus or class) suspend callback for device. 1540 * @dev: Device to suspend. 1541 * @state: PM transition of the system being carried out. 1542 * @cb: Suspend callback to execute. 1543 * @info: string description of caller. 1544 */ 1545 static int legacy_suspend(struct device *dev, pm_message_t state, 1546 int (*cb)(struct device *dev, pm_message_t state), 1547 const char *info) 1548 { 1549 int error; 1550 ktime_t calltime; 1551 1552 calltime = initcall_debug_start(dev, cb); 1553 1554 trace_device_pm_callback_start(dev, info, state.event); 1555 error = cb(dev, state); 1556 trace_device_pm_callback_end(dev, error); 1557 suspend_report_result(dev, cb, error); 1558 1559 initcall_debug_report(dev, calltime, cb, error); 1560 1561 return error; 1562 } 1563 1564 static void dpm_clear_superiors_direct_complete(struct device *dev) 1565 { 1566 struct device_link *link; 1567 int idx; 1568 1569 if (dev->parent) { 1570 spin_lock_irq(&dev->parent->power.lock); 1571 dev->parent->power.direct_complete = false; 1572 spin_unlock_irq(&dev->parent->power.lock); 1573 } 1574 1575 idx = device_links_read_lock(); 1576 1577 list_for_each_entry_rcu_locked(link, &dev->links.suppliers, c_node) { 1578 spin_lock_irq(&link->supplier->power.lock); 1579 link->supplier->power.direct_complete = false; 1580 spin_unlock_irq(&link->supplier->power.lock); 1581 } 1582 1583 device_links_read_unlock(idx); 1584 } 1585 1586 /** 1587 * __device_suspend - Execute "suspend" callbacks for given device. 1588 * @dev: Device to handle. 1589 * @state: PM transition of the system being carried out. 1590 * @async: If true, the device is being suspended asynchronously. 1591 */ 1592 static int __device_suspend(struct device *dev, pm_message_t state, bool async) 1593 { 1594 pm_callback_t callback = NULL; 1595 const char *info = NULL; 1596 int error = 0; 1597 DECLARE_DPM_WATCHDOG_ON_STACK(wd); 1598 1599 TRACE_DEVICE(dev); 1600 TRACE_SUSPEND(0); 1601 1602 dpm_wait_for_subordinate(dev, async); 1603 1604 if (async_error) { 1605 dev->power.direct_complete = false; 1606 goto Complete; 1607 } 1608 1609 /* 1610 * Wait for possible runtime PM transitions of the device in progress 1611 * to complete and if there's a runtime resume request pending for it, 1612 * resume it before proceeding with invoking the system-wide suspend 1613 * callbacks for it. 1614 * 1615 * If the system-wide suspend callbacks below change the configuration 1616 * of the device, they must disable runtime PM for it or otherwise 1617 * ensure that its runtime-resume callbacks will not be confused by that 1618 * change in case they are invoked going forward. 1619 */ 1620 pm_runtime_barrier(dev); 1621 1622 if (pm_wakeup_pending()) { 1623 dev->power.direct_complete = false; 1624 async_error = -EBUSY; 1625 goto Complete; 1626 } 1627 1628 if (dev->power.syscore) 1629 goto Complete; 1630 1631 /* Avoid direct_complete to let wakeup_path propagate. */ 1632 if (device_may_wakeup(dev) || device_wakeup_path(dev)) 1633 dev->power.direct_complete = false; 1634 1635 if (dev->power.direct_complete) { 1636 if (pm_runtime_status_suspended(dev)) { 1637 pm_runtime_disable(dev); 1638 if (pm_runtime_status_suspended(dev)) { 1639 pm_dev_dbg(dev, state, "direct-complete "); 1640 goto Complete; 1641 } 1642 1643 pm_runtime_enable(dev); 1644 } 1645 dev->power.direct_complete = false; 1646 } 1647 1648 dev->power.may_skip_resume = true; 1649 dev->power.must_resume = !dev_pm_test_driver_flags(dev, DPM_FLAG_MAY_SKIP_RESUME); 1650 1651 dpm_watchdog_set(&wd, dev); 1652 device_lock(dev); 1653 1654 if (dev->pm_domain) { 1655 info = "power domain "; 1656 callback = pm_op(&dev->pm_domain->ops, state); 1657 goto Run; 1658 } 1659 1660 if (dev->type && dev->type->pm) { 1661 info = "type "; 1662 callback = pm_op(dev->type->pm, state); 1663 goto Run; 1664 } 1665 1666 if (dev->class && dev->class->pm) { 1667 info = "class "; 1668 callback = pm_op(dev->class->pm, state); 1669 goto Run; 1670 } 1671 1672 if (dev->bus) { 1673 if (dev->bus->pm) { 1674 info = "bus "; 1675 callback = pm_op(dev->bus->pm, state); 1676 } else if (dev->bus->suspend) { 1677 pm_dev_dbg(dev, state, "legacy bus "); 1678 error = legacy_suspend(dev, state, dev->bus->suspend, 1679 "legacy bus "); 1680 goto End; 1681 } 1682 } 1683 1684 Run: 1685 if (!callback && dev->driver && dev->driver->pm) { 1686 info = "driver "; 1687 callback = pm_op(dev->driver->pm, state); 1688 } 1689 1690 error = dpm_run_callback(callback, dev, state, info); 1691 1692 End: 1693 if (!error) { 1694 dev->power.is_suspended = true; 1695 if (device_may_wakeup(dev)) 1696 dev->power.wakeup_path = true; 1697 1698 dpm_propagate_wakeup_to_parent(dev); 1699 dpm_clear_superiors_direct_complete(dev); 1700 } 1701 1702 device_unlock(dev); 1703 dpm_watchdog_clear(&wd); 1704 1705 Complete: 1706 if (error) { 1707 async_error = error; 1708 dpm_save_failed_dev(dev_name(dev)); 1709 pm_dev_err(dev, state, async ? " async" : "", error); 1710 } 1711 1712 complete_all(&dev->power.completion); 1713 TRACE_SUSPEND(error); 1714 return error; 1715 } 1716 1717 static void async_suspend(void *data, async_cookie_t cookie) 1718 { 1719 struct device *dev = data; 1720 1721 __device_suspend(dev, pm_transition, true); 1722 put_device(dev); 1723 } 1724 1725 static int device_suspend(struct device *dev) 1726 { 1727 if (dpm_async_fn(dev, async_suspend)) 1728 return 0; 1729 1730 return __device_suspend(dev, pm_transition, false); 1731 } 1732 1733 /** 1734 * dpm_suspend - Execute "suspend" callbacks for all non-sysdev devices. 1735 * @state: PM transition of the system being carried out. 1736 */ 1737 int dpm_suspend(pm_message_t state) 1738 { 1739 ktime_t starttime = ktime_get(); 1740 int error = 0; 1741 1742 trace_suspend_resume(TPS("dpm_suspend"), state.event, true); 1743 might_sleep(); 1744 1745 devfreq_suspend(); 1746 cpufreq_suspend(); 1747 1748 mutex_lock(&dpm_list_mtx); 1749 pm_transition = state; 1750 async_error = 0; 1751 while (!list_empty(&dpm_prepared_list)) { 1752 struct device *dev = to_device(dpm_prepared_list.prev); 1753 1754 get_device(dev); 1755 1756 mutex_unlock(&dpm_list_mtx); 1757 1758 error = device_suspend(dev); 1759 1760 mutex_lock(&dpm_list_mtx); 1761 1762 if (!error && !list_empty(&dev->power.entry)) 1763 list_move(&dev->power.entry, &dpm_suspended_list); 1764 1765 mutex_unlock(&dpm_list_mtx); 1766 1767 put_device(dev); 1768 1769 mutex_lock(&dpm_list_mtx); 1770 1771 if (error || async_error) 1772 break; 1773 } 1774 mutex_unlock(&dpm_list_mtx); 1775 async_synchronize_full(); 1776 if (!error) 1777 error = async_error; 1778 1779 if (error) 1780 dpm_save_failed_step(SUSPEND_SUSPEND); 1781 1782 dpm_show_time(starttime, state, error, NULL); 1783 trace_suspend_resume(TPS("dpm_suspend"), state.event, false); 1784 return error; 1785 } 1786 1787 /** 1788 * device_prepare - Prepare a device for system power transition. 1789 * @dev: Device to handle. 1790 * @state: PM transition of the system being carried out. 1791 * 1792 * Execute the ->prepare() callback(s) for given device. No new children of the 1793 * device may be registered after this function has returned. 1794 */ 1795 static int device_prepare(struct device *dev, pm_message_t state) 1796 { 1797 int (*callback)(struct device *) = NULL; 1798 int ret = 0; 1799 1800 /* 1801 * If a device's parent goes into runtime suspend at the wrong time, 1802 * it won't be possible to resume the device. To prevent this we 1803 * block runtime suspend here, during the prepare phase, and allow 1804 * it again during the complete phase. 1805 */ 1806 pm_runtime_get_noresume(dev); 1807 1808 if (dev->power.syscore) 1809 return 0; 1810 1811 device_lock(dev); 1812 1813 dev->power.wakeup_path = false; 1814 1815 if (dev->power.no_pm_callbacks) 1816 goto unlock; 1817 1818 if (dev->pm_domain) 1819 callback = dev->pm_domain->ops.prepare; 1820 else if (dev->type && dev->type->pm) 1821 callback = dev->type->pm->prepare; 1822 else if (dev->class && dev->class->pm) 1823 callback = dev->class->pm->prepare; 1824 else if (dev->bus && dev->bus->pm) 1825 callback = dev->bus->pm->prepare; 1826 1827 if (!callback && dev->driver && dev->driver->pm) 1828 callback = dev->driver->pm->prepare; 1829 1830 if (callback) 1831 ret = callback(dev); 1832 1833 unlock: 1834 device_unlock(dev); 1835 1836 if (ret < 0) { 1837 suspend_report_result(dev, callback, ret); 1838 pm_runtime_put(dev); 1839 return ret; 1840 } 1841 /* 1842 * A positive return value from ->prepare() means "this device appears 1843 * to be runtime-suspended and its state is fine, so if it really is 1844 * runtime-suspended, you can leave it in that state provided that you 1845 * will do the same thing with all of its descendants". This only 1846 * applies to suspend transitions, however. 1847 */ 1848 spin_lock_irq(&dev->power.lock); 1849 dev->power.direct_complete = state.event == PM_EVENT_SUSPEND && 1850 (ret > 0 || dev->power.no_pm_callbacks) && 1851 !dev_pm_test_driver_flags(dev, DPM_FLAG_NO_DIRECT_COMPLETE); 1852 spin_unlock_irq(&dev->power.lock); 1853 return 0; 1854 } 1855 1856 /** 1857 * dpm_prepare - Prepare all non-sysdev devices for a system PM transition. 1858 * @state: PM transition of the system being carried out. 1859 * 1860 * Execute the ->prepare() callback(s) for all devices. 1861 */ 1862 int dpm_prepare(pm_message_t state) 1863 { 1864 int error = 0; 1865 1866 trace_suspend_resume(TPS("dpm_prepare"), state.event, true); 1867 might_sleep(); 1868 1869 /* 1870 * Give a chance for the known devices to complete their probes, before 1871 * disable probing of devices. This sync point is important at least 1872 * at boot time + hibernation restore. 1873 */ 1874 wait_for_device_probe(); 1875 /* 1876 * It is unsafe if probing of devices will happen during suspend or 1877 * hibernation and system behavior will be unpredictable in this case. 1878 * So, let's prohibit device's probing here and defer their probes 1879 * instead. The normal behavior will be restored in dpm_complete(). 1880 */ 1881 device_block_probing(); 1882 1883 mutex_lock(&dpm_list_mtx); 1884 while (!list_empty(&dpm_list) && !error) { 1885 struct device *dev = to_device(dpm_list.next); 1886 1887 get_device(dev); 1888 1889 mutex_unlock(&dpm_list_mtx); 1890 1891 trace_device_pm_callback_start(dev, "", state.event); 1892 error = device_prepare(dev, state); 1893 trace_device_pm_callback_end(dev, error); 1894 1895 mutex_lock(&dpm_list_mtx); 1896 1897 if (!error) { 1898 dev->power.is_prepared = true; 1899 if (!list_empty(&dev->power.entry)) 1900 list_move_tail(&dev->power.entry, &dpm_prepared_list); 1901 } else if (error == -EAGAIN) { 1902 error = 0; 1903 } else { 1904 dev_info(dev, "not prepared for power transition: code %d\n", 1905 error); 1906 } 1907 1908 mutex_unlock(&dpm_list_mtx); 1909 1910 put_device(dev); 1911 1912 mutex_lock(&dpm_list_mtx); 1913 } 1914 mutex_unlock(&dpm_list_mtx); 1915 trace_suspend_resume(TPS("dpm_prepare"), state.event, false); 1916 return error; 1917 } 1918 1919 /** 1920 * dpm_suspend_start - Prepare devices for PM transition and suspend them. 1921 * @state: PM transition of the system being carried out. 1922 * 1923 * Prepare all non-sysdev devices for system PM transition and execute "suspend" 1924 * callbacks for them. 1925 */ 1926 int dpm_suspend_start(pm_message_t state) 1927 { 1928 ktime_t starttime = ktime_get(); 1929 int error; 1930 1931 error = dpm_prepare(state); 1932 if (error) 1933 dpm_save_failed_step(SUSPEND_PREPARE); 1934 else 1935 error = dpm_suspend(state); 1936 1937 dpm_show_time(starttime, state, error, "start"); 1938 return error; 1939 } 1940 EXPORT_SYMBOL_GPL(dpm_suspend_start); 1941 1942 void __suspend_report_result(const char *function, struct device *dev, void *fn, int ret) 1943 { 1944 if (ret) 1945 dev_err(dev, "%s(): %pS returns %d\n", function, fn, ret); 1946 } 1947 EXPORT_SYMBOL_GPL(__suspend_report_result); 1948 1949 /** 1950 * device_pm_wait_for_dev - Wait for suspend/resume of a device to complete. 1951 * @subordinate: Device that needs to wait for @dev. 1952 * @dev: Device to wait for. 1953 */ 1954 int device_pm_wait_for_dev(struct device *subordinate, struct device *dev) 1955 { 1956 dpm_wait(dev, subordinate->power.async_suspend); 1957 return async_error; 1958 } 1959 EXPORT_SYMBOL_GPL(device_pm_wait_for_dev); 1960 1961 /** 1962 * dpm_for_each_dev - device iterator. 1963 * @data: data for the callback. 1964 * @fn: function to be called for each device. 1965 * 1966 * Iterate over devices in dpm_list, and call @fn for each device, 1967 * passing it @data. 1968 */ 1969 void dpm_for_each_dev(void *data, void (*fn)(struct device *, void *)) 1970 { 1971 struct device *dev; 1972 1973 if (!fn) 1974 return; 1975 1976 device_pm_lock(); 1977 list_for_each_entry(dev, &dpm_list, power.entry) 1978 fn(dev, data); 1979 device_pm_unlock(); 1980 } 1981 EXPORT_SYMBOL_GPL(dpm_for_each_dev); 1982 1983 static bool pm_ops_is_empty(const struct dev_pm_ops *ops) 1984 { 1985 if (!ops) 1986 return true; 1987 1988 return !ops->prepare && 1989 !ops->suspend && 1990 !ops->suspend_late && 1991 !ops->suspend_noirq && 1992 !ops->resume_noirq && 1993 !ops->resume_early && 1994 !ops->resume && 1995 !ops->complete; 1996 } 1997 1998 void device_pm_check_callbacks(struct device *dev) 1999 { 2000 unsigned long flags; 2001 2002 spin_lock_irqsave(&dev->power.lock, flags); 2003 dev->power.no_pm_callbacks = 2004 (!dev->bus || (pm_ops_is_empty(dev->bus->pm) && 2005 !dev->bus->suspend && !dev->bus->resume)) && 2006 (!dev->class || pm_ops_is_empty(dev->class->pm)) && 2007 (!dev->type || pm_ops_is_empty(dev->type->pm)) && 2008 (!dev->pm_domain || pm_ops_is_empty(&dev->pm_domain->ops)) && 2009 (!dev->driver || (pm_ops_is_empty(dev->driver->pm) && 2010 !dev->driver->suspend && !dev->driver->resume)); 2011 spin_unlock_irqrestore(&dev->power.lock, flags); 2012 } 2013 2014 bool dev_pm_skip_suspend(struct device *dev) 2015 { 2016 return dev_pm_test_driver_flags(dev, DPM_FLAG_SMART_SUSPEND) && 2017 pm_runtime_status_suspended(dev); 2018 } 2019