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
pm_verb(int event)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 */
device_pm_sleep_init(struct device * dev)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 */
device_pm_lock(void)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 */
device_pm_unlock(void)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 */
device_pm_add(struct device * dev)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 */
device_pm_remove(struct device * dev)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 */
device_pm_move_before(struct device * deva,struct device * devb)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 */
device_pm_move_after(struct device * deva,struct device * devb)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 */
device_pm_move_last(struct device * dev)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
initcall_debug_start(struct device * dev,void * cb)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
initcall_debug_report(struct device * dev,ktime_t calltime,void * cb,int error)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 */
dpm_wait(struct device * dev,bool async)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
dpm_wait_fn(struct device * dev,void * async_ptr)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
dpm_wait_for_children(struct device * dev,bool async)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
dpm_wait_for_suppliers(struct device * dev,bool async)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
dpm_wait_for_superior(struct device * dev,bool async)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
dpm_wait_for_consumers(struct device * dev,bool async)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
dpm_wait_for_subordinate(struct device * dev,bool async)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 */
pm_op(const struct dev_pm_ops * ops,pm_message_t state)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 */
pm_late_early_op(const struct dev_pm_ops * ops,pm_message_t state)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 */
pm_noirq_op(const struct dev_pm_ops * ops,pm_message_t state)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
pm_dev_dbg(struct device * dev,pm_message_t state,const char * info)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
pm_dev_err(struct device * dev,pm_message_t state,const char * info,int error)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
dpm_show_time(ktime_t starttime,pm_message_t state,int error,const char * info)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
dpm_run_callback(pm_callback_t cb,struct device * dev,pm_message_t state,const char * info)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 bool fatal;
500 };
501
502 #define DECLARE_DPM_WATCHDOG_ON_STACK(wd) \
503 struct dpm_watchdog wd
504
505 /**
506 * dpm_watchdog_handler - Driver suspend / resume watchdog handler.
507 * @t: The timer that PM watchdog depends on.
508 *
509 * Called when a driver has timed out suspending or resuming.
510 * There's not much we can do here to recover so panic() to
511 * capture a crash-dump in pstore.
512 */
dpm_watchdog_handler(struct timer_list * t)513 static void dpm_watchdog_handler(struct timer_list *t)
514 {
515 struct dpm_watchdog *wd = from_timer(wd, t, timer);
516 struct timer_list *timer = &wd->timer;
517 unsigned int time_left;
518
519 if (wd->fatal) {
520 dev_emerg(wd->dev, "**** DPM device timeout ****\n");
521 show_stack(wd->tsk, NULL, KERN_EMERG);
522 panic("%s %s: unrecoverable failure\n",
523 dev_driver_string(wd->dev), dev_name(wd->dev));
524 }
525
526 time_left = CONFIG_DPM_WATCHDOG_TIMEOUT - CONFIG_DPM_WATCHDOG_WARNING_TIMEOUT;
527 dev_warn(wd->dev, "**** DPM device timeout after %u seconds; %u seconds until panic ****\n",
528 CONFIG_DPM_WATCHDOG_WARNING_TIMEOUT, time_left);
529 show_stack(wd->tsk, NULL, KERN_WARNING);
530
531 wd->fatal = true;
532 mod_timer(timer, jiffies + HZ * time_left);
533 }
534
535 /**
536 * dpm_watchdog_set - Enable pm watchdog for given device.
537 * @wd: Watchdog. Must be allocated on the stack.
538 * @dev: Device to handle.
539 */
dpm_watchdog_set(struct dpm_watchdog * wd,struct device * dev)540 static void dpm_watchdog_set(struct dpm_watchdog *wd, struct device *dev)
541 {
542 struct timer_list *timer = &wd->timer;
543
544 wd->dev = dev;
545 wd->tsk = current;
546 wd->fatal = CONFIG_DPM_WATCHDOG_TIMEOUT == CONFIG_DPM_WATCHDOG_WARNING_TIMEOUT;
547
548 timer_setup_on_stack(timer, dpm_watchdog_handler, 0);
549 /* use same timeout value for both suspend and resume */
550 timer->expires = jiffies + HZ * CONFIG_DPM_WATCHDOG_WARNING_TIMEOUT;
551 add_timer(timer);
552 }
553
554 /**
555 * dpm_watchdog_clear - Disable suspend/resume watchdog.
556 * @wd: Watchdog to disable.
557 */
dpm_watchdog_clear(struct dpm_watchdog * wd)558 static void dpm_watchdog_clear(struct dpm_watchdog *wd)
559 {
560 struct timer_list *timer = &wd->timer;
561
562 del_timer_sync(timer);
563 destroy_timer_on_stack(timer);
564 }
565 #else
566 #define DECLARE_DPM_WATCHDOG_ON_STACK(wd)
567 #define dpm_watchdog_set(x, y)
568 #define dpm_watchdog_clear(x)
569 #endif
570
571 /*------------------------- Resume routines -------------------------*/
572
573 /**
574 * dev_pm_skip_resume - System-wide device resume optimization check.
575 * @dev: Target device.
576 *
577 * Return:
578 * - %false if the transition under way is RESTORE.
579 * - Return value of dev_pm_skip_suspend() if the transition under way is THAW.
580 * - The logical negation of %power.must_resume otherwise (that is, when the
581 * transition under way is RESUME).
582 */
dev_pm_skip_resume(struct device * dev)583 bool dev_pm_skip_resume(struct device *dev)
584 {
585 if (pm_transition.event == PM_EVENT_RESTORE)
586 return false;
587
588 if (pm_transition.event == PM_EVENT_THAW)
589 return dev_pm_skip_suspend(dev);
590
591 return !dev->power.must_resume;
592 }
593
is_async(struct device * dev)594 static bool is_async(struct device *dev)
595 {
596 return dev->power.async_suspend && pm_async_enabled
597 && !pm_trace_is_enabled();
598 }
599
dpm_async_fn(struct device * dev,async_func_t func)600 static bool dpm_async_fn(struct device *dev, async_func_t func)
601 {
602 reinit_completion(&dev->power.completion);
603
604 if (is_async(dev)) {
605 dev->power.async_in_progress = true;
606
607 get_device(dev);
608
609 if (async_schedule_dev_nocall(func, dev))
610 return true;
611
612 put_device(dev);
613 }
614 /*
615 * Because async_schedule_dev_nocall() above has returned false or it
616 * has not been called at all, func() is not running and it is safe to
617 * update the async_in_progress flag without extra synchronization.
618 */
619 dev->power.async_in_progress = false;
620 return false;
621 }
622
623 /**
624 * device_resume_noirq - Execute a "noirq resume" callback for given device.
625 * @dev: Device to handle.
626 * @state: PM transition of the system being carried out.
627 * @async: If true, the device is being resumed asynchronously.
628 *
629 * The driver of @dev will not receive interrupts while this function is being
630 * executed.
631 */
device_resume_noirq(struct device * dev,pm_message_t state,bool async)632 static void device_resume_noirq(struct device *dev, pm_message_t state, bool async)
633 {
634 pm_callback_t callback = NULL;
635 const char *info = NULL;
636 bool skip_resume;
637 int error = 0;
638
639 TRACE_DEVICE(dev);
640 TRACE_RESUME(0);
641
642 if (dev->power.syscore || dev->power.direct_complete)
643 goto Out;
644
645 if (!dev->power.is_noirq_suspended)
646 goto Out;
647
648 if (!dpm_wait_for_superior(dev, async))
649 goto Out;
650
651 skip_resume = dev_pm_skip_resume(dev);
652 /*
653 * If the driver callback is skipped below or by the middle layer
654 * callback and device_resume_early() also skips the driver callback for
655 * this device later, it needs to appear as "suspended" to PM-runtime,
656 * so change its status accordingly.
657 *
658 * Otherwise, the device is going to be resumed, so set its PM-runtime
659 * status to "active" unless its power.set_active flag is clear, in
660 * which case it is not necessary to update its PM-runtime status.
661 */
662 if (skip_resume) {
663 pm_runtime_set_suspended(dev);
664 } else if (dev->power.set_active) {
665 pm_runtime_set_active(dev);
666 dev->power.set_active = false;
667 }
668
669 if (dev->pm_domain) {
670 info = "noirq power domain ";
671 callback = pm_noirq_op(&dev->pm_domain->ops, state);
672 } else if (dev->type && dev->type->pm) {
673 info = "noirq type ";
674 callback = pm_noirq_op(dev->type->pm, state);
675 } else if (dev->class && dev->class->pm) {
676 info = "noirq class ";
677 callback = pm_noirq_op(dev->class->pm, state);
678 } else if (dev->bus && dev->bus->pm) {
679 info = "noirq bus ";
680 callback = pm_noirq_op(dev->bus->pm, state);
681 }
682 if (callback)
683 goto Run;
684
685 if (skip_resume)
686 goto Skip;
687
688 if (dev->driver && dev->driver->pm) {
689 info = "noirq driver ";
690 callback = pm_noirq_op(dev->driver->pm, state);
691 }
692
693 Run:
694 error = dpm_run_callback(callback, dev, state, info);
695
696 Skip:
697 dev->power.is_noirq_suspended = false;
698
699 Out:
700 complete_all(&dev->power.completion);
701 TRACE_RESUME(error);
702
703 if (error) {
704 async_error = error;
705 dpm_save_failed_dev(dev_name(dev));
706 pm_dev_err(dev, state, async ? " async noirq" : " noirq", error);
707 }
708 }
709
async_resume_noirq(void * data,async_cookie_t cookie)710 static void async_resume_noirq(void *data, async_cookie_t cookie)
711 {
712 struct device *dev = data;
713
714 device_resume_noirq(dev, pm_transition, true);
715 put_device(dev);
716 }
717
dpm_noirq_resume_devices(pm_message_t state)718 static void dpm_noirq_resume_devices(pm_message_t state)
719 {
720 struct device *dev;
721 ktime_t starttime = ktime_get();
722
723 trace_suspend_resume(TPS("dpm_resume_noirq"), state.event, true);
724
725 async_error = 0;
726 pm_transition = state;
727
728 mutex_lock(&dpm_list_mtx);
729
730 /*
731 * Trigger the resume of "async" devices upfront so they don't have to
732 * wait for the "non-async" ones they don't depend on.
733 */
734 list_for_each_entry(dev, &dpm_noirq_list, power.entry)
735 dpm_async_fn(dev, async_resume_noirq);
736
737 while (!list_empty(&dpm_noirq_list)) {
738 dev = to_device(dpm_noirq_list.next);
739 list_move_tail(&dev->power.entry, &dpm_late_early_list);
740
741 if (!dev->power.async_in_progress) {
742 get_device(dev);
743
744 mutex_unlock(&dpm_list_mtx);
745
746 device_resume_noirq(dev, state, false);
747
748 put_device(dev);
749
750 mutex_lock(&dpm_list_mtx);
751 }
752 }
753 mutex_unlock(&dpm_list_mtx);
754 async_synchronize_full();
755 dpm_show_time(starttime, state, 0, "noirq");
756 if (async_error)
757 dpm_save_failed_step(SUSPEND_RESUME_NOIRQ);
758
759 trace_suspend_resume(TPS("dpm_resume_noirq"), state.event, false);
760 }
761
762 /**
763 * dpm_resume_noirq - Execute "noirq resume" callbacks for all devices.
764 * @state: PM transition of the system being carried out.
765 *
766 * Invoke the "noirq" resume callbacks for all devices in dpm_noirq_list and
767 * allow device drivers' interrupt handlers to be called.
768 */
dpm_resume_noirq(pm_message_t state)769 void dpm_resume_noirq(pm_message_t state)
770 {
771 dpm_noirq_resume_devices(state);
772
773 resume_device_irqs();
774 device_wakeup_disarm_wake_irqs();
775 }
776
777 /**
778 * device_resume_early - Execute an "early resume" callback for given device.
779 * @dev: Device to handle.
780 * @state: PM transition of the system being carried out.
781 * @async: If true, the device is being resumed asynchronously.
782 *
783 * Runtime PM is disabled for @dev while this function is being executed.
784 */
device_resume_early(struct device * dev,pm_message_t state,bool async)785 static void device_resume_early(struct device *dev, pm_message_t state, bool async)
786 {
787 pm_callback_t callback = NULL;
788 const char *info = NULL;
789 int error = 0;
790
791 TRACE_DEVICE(dev);
792 TRACE_RESUME(0);
793
794 if (dev->power.syscore || dev->power.direct_complete)
795 goto Out;
796
797 if (!dev->power.is_late_suspended)
798 goto Out;
799
800 if (!dpm_wait_for_superior(dev, async))
801 goto Out;
802
803 if (dev->pm_domain) {
804 info = "early power domain ";
805 callback = pm_late_early_op(&dev->pm_domain->ops, state);
806 } else if (dev->type && dev->type->pm) {
807 info = "early type ";
808 callback = pm_late_early_op(dev->type->pm, state);
809 } else if (dev->class && dev->class->pm) {
810 info = "early class ";
811 callback = pm_late_early_op(dev->class->pm, state);
812 } else if (dev->bus && dev->bus->pm) {
813 info = "early bus ";
814 callback = pm_late_early_op(dev->bus->pm, state);
815 }
816 if (callback)
817 goto Run;
818
819 if (dev_pm_skip_resume(dev))
820 goto Skip;
821
822 if (dev->driver && dev->driver->pm) {
823 info = "early driver ";
824 callback = pm_late_early_op(dev->driver->pm, state);
825 }
826
827 Run:
828 error = dpm_run_callback(callback, dev, state, info);
829
830 Skip:
831 dev->power.is_late_suspended = false;
832
833 Out:
834 TRACE_RESUME(error);
835
836 pm_runtime_enable(dev);
837 complete_all(&dev->power.completion);
838
839 if (error) {
840 async_error = error;
841 dpm_save_failed_dev(dev_name(dev));
842 pm_dev_err(dev, state, async ? " async early" : " early", error);
843 }
844 }
845
async_resume_early(void * data,async_cookie_t cookie)846 static void async_resume_early(void *data, async_cookie_t cookie)
847 {
848 struct device *dev = data;
849
850 device_resume_early(dev, pm_transition, true);
851 put_device(dev);
852 }
853
854 /**
855 * dpm_resume_early - Execute "early resume" callbacks for all devices.
856 * @state: PM transition of the system being carried out.
857 */
dpm_resume_early(pm_message_t state)858 void dpm_resume_early(pm_message_t state)
859 {
860 struct device *dev;
861 ktime_t starttime = ktime_get();
862
863 trace_suspend_resume(TPS("dpm_resume_early"), state.event, true);
864
865 async_error = 0;
866 pm_transition = state;
867
868 mutex_lock(&dpm_list_mtx);
869
870 /*
871 * Trigger the resume of "async" devices upfront so they don't have to
872 * wait for the "non-async" ones they don't depend on.
873 */
874 list_for_each_entry(dev, &dpm_late_early_list, power.entry)
875 dpm_async_fn(dev, async_resume_early);
876
877 while (!list_empty(&dpm_late_early_list)) {
878 dev = to_device(dpm_late_early_list.next);
879 list_move_tail(&dev->power.entry, &dpm_suspended_list);
880
881 if (!dev->power.async_in_progress) {
882 get_device(dev);
883
884 mutex_unlock(&dpm_list_mtx);
885
886 device_resume_early(dev, state, false);
887
888 put_device(dev);
889
890 mutex_lock(&dpm_list_mtx);
891 }
892 }
893 mutex_unlock(&dpm_list_mtx);
894 async_synchronize_full();
895 dpm_show_time(starttime, state, 0, "early");
896 if (async_error)
897 dpm_save_failed_step(SUSPEND_RESUME_EARLY);
898
899 trace_suspend_resume(TPS("dpm_resume_early"), state.event, false);
900 }
901
902 /**
903 * dpm_resume_start - Execute "noirq" and "early" device callbacks.
904 * @state: PM transition of the system being carried out.
905 */
dpm_resume_start(pm_message_t state)906 void dpm_resume_start(pm_message_t state)
907 {
908 dpm_resume_noirq(state);
909 dpm_resume_early(state);
910 }
911 EXPORT_SYMBOL_GPL(dpm_resume_start);
912
913 /**
914 * device_resume - Execute "resume" callbacks for given device.
915 * @dev: Device to handle.
916 * @state: PM transition of the system being carried out.
917 * @async: If true, the device is being resumed asynchronously.
918 */
device_resume(struct device * dev,pm_message_t state,bool async)919 static void device_resume(struct device *dev, pm_message_t state, bool async)
920 {
921 pm_callback_t callback = NULL;
922 const char *info = NULL;
923 int error = 0;
924 DECLARE_DPM_WATCHDOG_ON_STACK(wd);
925
926 TRACE_DEVICE(dev);
927 TRACE_RESUME(0);
928
929 if (dev->power.syscore)
930 goto Complete;
931
932 if (!dev->power.is_suspended)
933 goto Complete;
934
935 if (dev->power.direct_complete) {
936 /* Match the pm_runtime_disable() in device_suspend(). */
937 pm_runtime_enable(dev);
938 goto Complete;
939 }
940
941 if (!dpm_wait_for_superior(dev, async))
942 goto Complete;
943
944 dpm_watchdog_set(&wd, dev);
945 device_lock(dev);
946
947 /*
948 * This is a fib. But we'll allow new children to be added below
949 * a resumed device, even if the device hasn't been completed yet.
950 */
951 dev->power.is_prepared = false;
952
953 if (dev->pm_domain) {
954 info = "power domain ";
955 callback = pm_op(&dev->pm_domain->ops, state);
956 goto Driver;
957 }
958
959 if (dev->type && dev->type->pm) {
960 info = "type ";
961 callback = pm_op(dev->type->pm, state);
962 goto Driver;
963 }
964
965 if (dev->class && dev->class->pm) {
966 info = "class ";
967 callback = pm_op(dev->class->pm, state);
968 goto Driver;
969 }
970
971 if (dev->bus) {
972 if (dev->bus->pm) {
973 info = "bus ";
974 callback = pm_op(dev->bus->pm, state);
975 } else if (dev->bus->resume) {
976 info = "legacy bus ";
977 callback = dev->bus->resume;
978 goto End;
979 }
980 }
981
982 Driver:
983 if (!callback && dev->driver && dev->driver->pm) {
984 info = "driver ";
985 callback = pm_op(dev->driver->pm, state);
986 }
987
988 End:
989 error = dpm_run_callback(callback, dev, state, info);
990 dev->power.is_suspended = false;
991
992 device_unlock(dev);
993 dpm_watchdog_clear(&wd);
994
995 Complete:
996 complete_all(&dev->power.completion);
997
998 TRACE_RESUME(error);
999
1000 if (error) {
1001 async_error = error;
1002 dpm_save_failed_dev(dev_name(dev));
1003 pm_dev_err(dev, state, async ? " async" : "", error);
1004 }
1005 }
1006
async_resume(void * data,async_cookie_t cookie)1007 static void async_resume(void *data, async_cookie_t cookie)
1008 {
1009 struct device *dev = data;
1010
1011 device_resume(dev, pm_transition, true);
1012 put_device(dev);
1013 }
1014
1015 /**
1016 * dpm_resume - Execute "resume" callbacks for non-sysdev devices.
1017 * @state: PM transition of the system being carried out.
1018 *
1019 * Execute the appropriate "resume" callback for all devices whose status
1020 * indicates that they are suspended.
1021 */
dpm_resume(pm_message_t state)1022 void dpm_resume(pm_message_t state)
1023 {
1024 struct device *dev;
1025 ktime_t starttime = ktime_get();
1026
1027 trace_suspend_resume(TPS("dpm_resume"), state.event, true);
1028 might_sleep();
1029
1030 pm_transition = state;
1031 async_error = 0;
1032
1033 mutex_lock(&dpm_list_mtx);
1034
1035 /*
1036 * Trigger the resume of "async" devices upfront so they don't have to
1037 * wait for the "non-async" ones they don't depend on.
1038 */
1039 list_for_each_entry(dev, &dpm_suspended_list, power.entry)
1040 dpm_async_fn(dev, async_resume);
1041
1042 while (!list_empty(&dpm_suspended_list)) {
1043 dev = to_device(dpm_suspended_list.next);
1044 list_move_tail(&dev->power.entry, &dpm_prepared_list);
1045
1046 if (!dev->power.async_in_progress) {
1047 get_device(dev);
1048
1049 mutex_unlock(&dpm_list_mtx);
1050
1051 device_resume(dev, state, false);
1052
1053 put_device(dev);
1054
1055 mutex_lock(&dpm_list_mtx);
1056 }
1057 }
1058 mutex_unlock(&dpm_list_mtx);
1059 async_synchronize_full();
1060 dpm_show_time(starttime, state, 0, NULL);
1061 if (async_error)
1062 dpm_save_failed_step(SUSPEND_RESUME);
1063
1064 cpufreq_resume();
1065 devfreq_resume();
1066 trace_suspend_resume(TPS("dpm_resume"), state.event, false);
1067 }
1068
1069 /**
1070 * device_complete - Complete a PM transition for given device.
1071 * @dev: Device to handle.
1072 * @state: PM transition of the system being carried out.
1073 */
device_complete(struct device * dev,pm_message_t state)1074 static void device_complete(struct device *dev, pm_message_t state)
1075 {
1076 void (*callback)(struct device *) = NULL;
1077 const char *info = NULL;
1078
1079 if (dev->power.syscore)
1080 goto out;
1081
1082 device_lock(dev);
1083
1084 if (dev->pm_domain) {
1085 info = "completing power domain ";
1086 callback = dev->pm_domain->ops.complete;
1087 } else if (dev->type && dev->type->pm) {
1088 info = "completing type ";
1089 callback = dev->type->pm->complete;
1090 } else if (dev->class && dev->class->pm) {
1091 info = "completing class ";
1092 callback = dev->class->pm->complete;
1093 } else if (dev->bus && dev->bus->pm) {
1094 info = "completing bus ";
1095 callback = dev->bus->pm->complete;
1096 }
1097
1098 if (!callback && dev->driver && dev->driver->pm) {
1099 info = "completing driver ";
1100 callback = dev->driver->pm->complete;
1101 }
1102
1103 if (callback) {
1104 pm_dev_dbg(dev, state, info);
1105 callback(dev);
1106 }
1107
1108 device_unlock(dev);
1109
1110 out:
1111 pm_runtime_put(dev);
1112 }
1113
1114 /**
1115 * dpm_complete - Complete a PM transition for all non-sysdev devices.
1116 * @state: PM transition of the system being carried out.
1117 *
1118 * Execute the ->complete() callbacks for all devices whose PM status is not
1119 * DPM_ON (this allows new devices to be registered).
1120 */
dpm_complete(pm_message_t state)1121 void dpm_complete(pm_message_t state)
1122 {
1123 struct list_head list;
1124
1125 trace_suspend_resume(TPS("dpm_complete"), state.event, true);
1126 might_sleep();
1127
1128 INIT_LIST_HEAD(&list);
1129 mutex_lock(&dpm_list_mtx);
1130 while (!list_empty(&dpm_prepared_list)) {
1131 struct device *dev = to_device(dpm_prepared_list.prev);
1132
1133 get_device(dev);
1134 dev->power.is_prepared = false;
1135 list_move(&dev->power.entry, &list);
1136
1137 mutex_unlock(&dpm_list_mtx);
1138
1139 trace_device_pm_callback_start(dev, "", state.event);
1140 device_complete(dev, state);
1141 trace_device_pm_callback_end(dev, 0);
1142
1143 put_device(dev);
1144
1145 mutex_lock(&dpm_list_mtx);
1146 }
1147 list_splice(&list, &dpm_list);
1148 mutex_unlock(&dpm_list_mtx);
1149
1150 /* Allow device probing and trigger re-probing of deferred devices */
1151 device_unblock_probing();
1152 trace_suspend_resume(TPS("dpm_complete"), state.event, false);
1153 }
1154
1155 /**
1156 * dpm_resume_end - Execute "resume" callbacks and complete system transition.
1157 * @state: PM transition of the system being carried out.
1158 *
1159 * Execute "resume" callbacks for all devices and complete the PM transition of
1160 * the system.
1161 */
dpm_resume_end(pm_message_t state)1162 void dpm_resume_end(pm_message_t state)
1163 {
1164 dpm_resume(state);
1165 dpm_complete(state);
1166 }
1167 EXPORT_SYMBOL_GPL(dpm_resume_end);
1168
1169
1170 /*------------------------- Suspend routines -------------------------*/
1171
1172 /**
1173 * resume_event - Return a "resume" message for given "suspend" sleep state.
1174 * @sleep_state: PM message representing a sleep state.
1175 *
1176 * Return a PM message representing the resume event corresponding to given
1177 * sleep state.
1178 */
resume_event(pm_message_t sleep_state)1179 static pm_message_t resume_event(pm_message_t sleep_state)
1180 {
1181 switch (sleep_state.event) {
1182 case PM_EVENT_SUSPEND:
1183 return PMSG_RESUME;
1184 case PM_EVENT_FREEZE:
1185 case PM_EVENT_QUIESCE:
1186 return PMSG_RECOVER;
1187 case PM_EVENT_HIBERNATE:
1188 return PMSG_RESTORE;
1189 }
1190 return PMSG_ON;
1191 }
1192
dpm_superior_set_must_resume(struct device * dev)1193 static void dpm_superior_set_must_resume(struct device *dev)
1194 {
1195 struct device_link *link;
1196 int idx;
1197
1198 if (dev->parent)
1199 dev->parent->power.must_resume = true;
1200
1201 idx = device_links_read_lock();
1202
1203 list_for_each_entry_rcu_locked(link, &dev->links.suppliers, c_node)
1204 link->supplier->power.must_resume = true;
1205
1206 device_links_read_unlock(idx);
1207 }
1208
1209 /**
1210 * device_suspend_noirq - Execute a "noirq suspend" callback for given device.
1211 * @dev: Device to handle.
1212 * @state: PM transition of the system being carried out.
1213 * @async: If true, the device is being suspended asynchronously.
1214 *
1215 * The driver of @dev will not receive interrupts while this function is being
1216 * executed.
1217 */
device_suspend_noirq(struct device * dev,pm_message_t state,bool async)1218 static int device_suspend_noirq(struct device *dev, pm_message_t state, bool async)
1219 {
1220 pm_callback_t callback = NULL;
1221 const char *info = NULL;
1222 int error = 0;
1223
1224 TRACE_DEVICE(dev);
1225 TRACE_SUSPEND(0);
1226
1227 dpm_wait_for_subordinate(dev, async);
1228
1229 if (async_error)
1230 goto Complete;
1231
1232 if (dev->power.syscore || dev->power.direct_complete)
1233 goto Complete;
1234
1235 if (dev->pm_domain) {
1236 info = "noirq power domain ";
1237 callback = pm_noirq_op(&dev->pm_domain->ops, state);
1238 } else if (dev->type && dev->type->pm) {
1239 info = "noirq type ";
1240 callback = pm_noirq_op(dev->type->pm, state);
1241 } else if (dev->class && dev->class->pm) {
1242 info = "noirq class ";
1243 callback = pm_noirq_op(dev->class->pm, state);
1244 } else if (dev->bus && dev->bus->pm) {
1245 info = "noirq bus ";
1246 callback = pm_noirq_op(dev->bus->pm, state);
1247 }
1248 if (callback)
1249 goto Run;
1250
1251 if (dev_pm_skip_suspend(dev))
1252 goto Skip;
1253
1254 if (dev->driver && dev->driver->pm) {
1255 info = "noirq driver ";
1256 callback = pm_noirq_op(dev->driver->pm, state);
1257 }
1258
1259 Run:
1260 error = dpm_run_callback(callback, dev, state, info);
1261 if (error) {
1262 async_error = error;
1263 dpm_save_failed_dev(dev_name(dev));
1264 pm_dev_err(dev, state, async ? " async noirq" : " noirq", error);
1265 goto Complete;
1266 }
1267
1268 Skip:
1269 dev->power.is_noirq_suspended = true;
1270
1271 /*
1272 * Devices must be resumed unless they are explicitly allowed to be left
1273 * in suspend, but even in that case skipping the resume of devices that
1274 * were in use right before the system suspend (as indicated by their
1275 * runtime PM usage counters and child counters) would be suboptimal.
1276 */
1277 if (!(dev_pm_test_driver_flags(dev, DPM_FLAG_MAY_SKIP_RESUME) &&
1278 dev->power.may_skip_resume) || !pm_runtime_need_not_resume(dev))
1279 dev->power.must_resume = true;
1280
1281 if (dev->power.must_resume) {
1282 if (dev_pm_test_driver_flags(dev, DPM_FLAG_SMART_SUSPEND)) {
1283 dev->power.set_active = true;
1284 if (dev->parent && !dev->parent->power.ignore_children)
1285 dev->parent->power.set_active = true;
1286 }
1287 dpm_superior_set_must_resume(dev);
1288 }
1289
1290 Complete:
1291 complete_all(&dev->power.completion);
1292 TRACE_SUSPEND(error);
1293 return error;
1294 }
1295
async_suspend_noirq(void * data,async_cookie_t cookie)1296 static void async_suspend_noirq(void *data, async_cookie_t cookie)
1297 {
1298 struct device *dev = data;
1299
1300 device_suspend_noirq(dev, pm_transition, true);
1301 put_device(dev);
1302 }
1303
dpm_noirq_suspend_devices(pm_message_t state)1304 static int dpm_noirq_suspend_devices(pm_message_t state)
1305 {
1306 ktime_t starttime = ktime_get();
1307 int error = 0;
1308
1309 trace_suspend_resume(TPS("dpm_suspend_noirq"), state.event, true);
1310
1311 pm_transition = state;
1312 async_error = 0;
1313
1314 mutex_lock(&dpm_list_mtx);
1315
1316 while (!list_empty(&dpm_late_early_list)) {
1317 struct device *dev = to_device(dpm_late_early_list.prev);
1318
1319 list_move(&dev->power.entry, &dpm_noirq_list);
1320
1321 if (dpm_async_fn(dev, async_suspend_noirq))
1322 continue;
1323
1324 get_device(dev);
1325
1326 mutex_unlock(&dpm_list_mtx);
1327
1328 error = device_suspend_noirq(dev, state, false);
1329
1330 put_device(dev);
1331
1332 mutex_lock(&dpm_list_mtx);
1333
1334 if (error || async_error)
1335 break;
1336 }
1337
1338 mutex_unlock(&dpm_list_mtx);
1339
1340 async_synchronize_full();
1341 if (!error)
1342 error = async_error;
1343
1344 if (error)
1345 dpm_save_failed_step(SUSPEND_SUSPEND_NOIRQ);
1346
1347 dpm_show_time(starttime, state, error, "noirq");
1348 trace_suspend_resume(TPS("dpm_suspend_noirq"), state.event, false);
1349 return error;
1350 }
1351
1352 /**
1353 * dpm_suspend_noirq - Execute "noirq suspend" callbacks for all devices.
1354 * @state: PM transition of the system being carried out.
1355 *
1356 * Prevent device drivers' interrupt handlers from being called and invoke
1357 * "noirq" suspend callbacks for all non-sysdev devices.
1358 */
dpm_suspend_noirq(pm_message_t state)1359 int dpm_suspend_noirq(pm_message_t state)
1360 {
1361 int ret;
1362
1363 device_wakeup_arm_wake_irqs();
1364 suspend_device_irqs();
1365
1366 ret = dpm_noirq_suspend_devices(state);
1367 if (ret)
1368 dpm_resume_noirq(resume_event(state));
1369
1370 return ret;
1371 }
1372
dpm_propagate_wakeup_to_parent(struct device * dev)1373 static void dpm_propagate_wakeup_to_parent(struct device *dev)
1374 {
1375 struct device *parent = dev->parent;
1376
1377 if (!parent)
1378 return;
1379
1380 spin_lock_irq(&parent->power.lock);
1381
1382 if (device_wakeup_path(dev) && !parent->power.ignore_children)
1383 parent->power.wakeup_path = true;
1384
1385 spin_unlock_irq(&parent->power.lock);
1386 }
1387
1388 /**
1389 * device_suspend_late - Execute a "late suspend" callback for given device.
1390 * @dev: Device to handle.
1391 * @state: PM transition of the system being carried out.
1392 * @async: If true, the device is being suspended asynchronously.
1393 *
1394 * Runtime PM is disabled for @dev while this function is being executed.
1395 */
device_suspend_late(struct device * dev,pm_message_t state,bool async)1396 static int device_suspend_late(struct device *dev, pm_message_t state, bool async)
1397 {
1398 pm_callback_t callback = NULL;
1399 const char *info = NULL;
1400 int error = 0;
1401
1402 TRACE_DEVICE(dev);
1403 TRACE_SUSPEND(0);
1404
1405 __pm_runtime_disable(dev, false);
1406
1407 dpm_wait_for_subordinate(dev, async);
1408
1409 if (async_error)
1410 goto Complete;
1411
1412 if (pm_wakeup_pending()) {
1413 async_error = -EBUSY;
1414 goto Complete;
1415 }
1416
1417 if (dev->power.syscore || dev->power.direct_complete)
1418 goto Complete;
1419
1420 if (dev->pm_domain) {
1421 info = "late power domain ";
1422 callback = pm_late_early_op(&dev->pm_domain->ops, state);
1423 } else if (dev->type && dev->type->pm) {
1424 info = "late type ";
1425 callback = pm_late_early_op(dev->type->pm, state);
1426 } else if (dev->class && dev->class->pm) {
1427 info = "late class ";
1428 callback = pm_late_early_op(dev->class->pm, state);
1429 } else if (dev->bus && dev->bus->pm) {
1430 info = "late bus ";
1431 callback = pm_late_early_op(dev->bus->pm, state);
1432 }
1433 if (callback)
1434 goto Run;
1435
1436 if (dev_pm_skip_suspend(dev))
1437 goto Skip;
1438
1439 if (dev->driver && dev->driver->pm) {
1440 info = "late driver ";
1441 callback = pm_late_early_op(dev->driver->pm, state);
1442 }
1443
1444 Run:
1445 error = dpm_run_callback(callback, dev, state, info);
1446 if (error) {
1447 async_error = error;
1448 dpm_save_failed_dev(dev_name(dev));
1449 pm_dev_err(dev, state, async ? " async late" : " late", error);
1450 goto Complete;
1451 }
1452 dpm_propagate_wakeup_to_parent(dev);
1453
1454 Skip:
1455 dev->power.is_late_suspended = true;
1456
1457 Complete:
1458 TRACE_SUSPEND(error);
1459 complete_all(&dev->power.completion);
1460 return error;
1461 }
1462
async_suspend_late(void * data,async_cookie_t cookie)1463 static void async_suspend_late(void *data, async_cookie_t cookie)
1464 {
1465 struct device *dev = data;
1466
1467 device_suspend_late(dev, pm_transition, true);
1468 put_device(dev);
1469 }
1470
1471 /**
1472 * dpm_suspend_late - Execute "late suspend" callbacks for all devices.
1473 * @state: PM transition of the system being carried out.
1474 */
dpm_suspend_late(pm_message_t state)1475 int dpm_suspend_late(pm_message_t state)
1476 {
1477 ktime_t starttime = ktime_get();
1478 int error = 0;
1479
1480 trace_suspend_resume(TPS("dpm_suspend_late"), state.event, true);
1481
1482 pm_transition = state;
1483 async_error = 0;
1484
1485 wake_up_all_idle_cpus();
1486
1487 mutex_lock(&dpm_list_mtx);
1488
1489 while (!list_empty(&dpm_suspended_list)) {
1490 struct device *dev = to_device(dpm_suspended_list.prev);
1491
1492 list_move(&dev->power.entry, &dpm_late_early_list);
1493
1494 if (dpm_async_fn(dev, async_suspend_late))
1495 continue;
1496
1497 get_device(dev);
1498
1499 mutex_unlock(&dpm_list_mtx);
1500
1501 error = device_suspend_late(dev, state, false);
1502
1503 put_device(dev);
1504
1505 mutex_lock(&dpm_list_mtx);
1506
1507 if (error || async_error)
1508 break;
1509 }
1510
1511 mutex_unlock(&dpm_list_mtx);
1512
1513 async_synchronize_full();
1514 if (!error)
1515 error = async_error;
1516
1517 if (error) {
1518 dpm_save_failed_step(SUSPEND_SUSPEND_LATE);
1519 dpm_resume_early(resume_event(state));
1520 }
1521 dpm_show_time(starttime, state, error, "late");
1522 trace_suspend_resume(TPS("dpm_suspend_late"), state.event, false);
1523 return error;
1524 }
1525
1526 /**
1527 * dpm_suspend_end - Execute "late" and "noirq" device suspend callbacks.
1528 * @state: PM transition of the system being carried out.
1529 */
dpm_suspend_end(pm_message_t state)1530 int dpm_suspend_end(pm_message_t state)
1531 {
1532 ktime_t starttime = ktime_get();
1533 int error;
1534
1535 error = dpm_suspend_late(state);
1536 if (error)
1537 goto out;
1538
1539 error = dpm_suspend_noirq(state);
1540 if (error)
1541 dpm_resume_early(resume_event(state));
1542
1543 out:
1544 dpm_show_time(starttime, state, error, "end");
1545 return error;
1546 }
1547 EXPORT_SYMBOL_GPL(dpm_suspend_end);
1548
1549 /**
1550 * legacy_suspend - Execute a legacy (bus or class) suspend callback for device.
1551 * @dev: Device to suspend.
1552 * @state: PM transition of the system being carried out.
1553 * @cb: Suspend callback to execute.
1554 * @info: string description of caller.
1555 */
legacy_suspend(struct device * dev,pm_message_t state,int (* cb)(struct device * dev,pm_message_t state),const char * info)1556 static int legacy_suspend(struct device *dev, pm_message_t state,
1557 int (*cb)(struct device *dev, pm_message_t state),
1558 const char *info)
1559 {
1560 int error;
1561 ktime_t calltime;
1562
1563 calltime = initcall_debug_start(dev, cb);
1564
1565 trace_device_pm_callback_start(dev, info, state.event);
1566 error = cb(dev, state);
1567 trace_device_pm_callback_end(dev, error);
1568 suspend_report_result(dev, cb, error);
1569
1570 initcall_debug_report(dev, calltime, cb, error);
1571
1572 return error;
1573 }
1574
dpm_clear_superiors_direct_complete(struct device * dev)1575 static void dpm_clear_superiors_direct_complete(struct device *dev)
1576 {
1577 struct device_link *link;
1578 int idx;
1579
1580 if (dev->parent) {
1581 spin_lock_irq(&dev->parent->power.lock);
1582 dev->parent->power.direct_complete = false;
1583 spin_unlock_irq(&dev->parent->power.lock);
1584 }
1585
1586 idx = device_links_read_lock();
1587
1588 list_for_each_entry_rcu_locked(link, &dev->links.suppliers, c_node) {
1589 spin_lock_irq(&link->supplier->power.lock);
1590 link->supplier->power.direct_complete = false;
1591 spin_unlock_irq(&link->supplier->power.lock);
1592 }
1593
1594 device_links_read_unlock(idx);
1595 }
1596
1597 /**
1598 * device_suspend - Execute "suspend" callbacks for given device.
1599 * @dev: Device to handle.
1600 * @state: PM transition of the system being carried out.
1601 * @async: If true, the device is being suspended asynchronously.
1602 */
device_suspend(struct device * dev,pm_message_t state,bool async)1603 static int device_suspend(struct device *dev, pm_message_t state, bool async)
1604 {
1605 pm_callback_t callback = NULL;
1606 const char *info = NULL;
1607 int error = 0;
1608 DECLARE_DPM_WATCHDOG_ON_STACK(wd);
1609
1610 TRACE_DEVICE(dev);
1611 TRACE_SUSPEND(0);
1612
1613 dpm_wait_for_subordinate(dev, async);
1614
1615 if (async_error) {
1616 dev->power.direct_complete = false;
1617 goto Complete;
1618 }
1619
1620 /*
1621 * Wait for possible runtime PM transitions of the device in progress
1622 * to complete and if there's a runtime resume request pending for it,
1623 * resume it before proceeding with invoking the system-wide suspend
1624 * callbacks for it.
1625 *
1626 * If the system-wide suspend callbacks below change the configuration
1627 * of the device, they must disable runtime PM for it or otherwise
1628 * ensure that its runtime-resume callbacks will not be confused by that
1629 * change in case they are invoked going forward.
1630 */
1631 pm_runtime_barrier(dev);
1632
1633 if (pm_wakeup_pending()) {
1634 dev->power.direct_complete = false;
1635 async_error = -EBUSY;
1636 goto Complete;
1637 }
1638
1639 if (dev->power.syscore)
1640 goto Complete;
1641
1642 /* Avoid direct_complete to let wakeup_path propagate. */
1643 if (device_may_wakeup(dev) || device_wakeup_path(dev))
1644 dev->power.direct_complete = false;
1645
1646 if (dev->power.direct_complete) {
1647 if (pm_runtime_status_suspended(dev)) {
1648 pm_runtime_disable(dev);
1649 if (pm_runtime_status_suspended(dev)) {
1650 pm_dev_dbg(dev, state, "direct-complete ");
1651 dev->power.is_suspended = true;
1652 goto Complete;
1653 }
1654
1655 pm_runtime_enable(dev);
1656 }
1657 dev->power.direct_complete = false;
1658 }
1659
1660 dev->power.may_skip_resume = true;
1661 dev->power.must_resume = !dev_pm_test_driver_flags(dev, DPM_FLAG_MAY_SKIP_RESUME);
1662
1663 dpm_watchdog_set(&wd, dev);
1664 device_lock(dev);
1665
1666 if (dev->pm_domain) {
1667 info = "power domain ";
1668 callback = pm_op(&dev->pm_domain->ops, state);
1669 goto Run;
1670 }
1671
1672 if (dev->type && dev->type->pm) {
1673 info = "type ";
1674 callback = pm_op(dev->type->pm, state);
1675 goto Run;
1676 }
1677
1678 if (dev->class && dev->class->pm) {
1679 info = "class ";
1680 callback = pm_op(dev->class->pm, state);
1681 goto Run;
1682 }
1683
1684 if (dev->bus) {
1685 if (dev->bus->pm) {
1686 info = "bus ";
1687 callback = pm_op(dev->bus->pm, state);
1688 } else if (dev->bus->suspend) {
1689 pm_dev_dbg(dev, state, "legacy bus ");
1690 error = legacy_suspend(dev, state, dev->bus->suspend,
1691 "legacy bus ");
1692 goto End;
1693 }
1694 }
1695
1696 Run:
1697 if (!callback && dev->driver && dev->driver->pm) {
1698 info = "driver ";
1699 callback = pm_op(dev->driver->pm, state);
1700 }
1701
1702 error = dpm_run_callback(callback, dev, state, info);
1703
1704 End:
1705 if (!error) {
1706 dev->power.is_suspended = true;
1707 if (device_may_wakeup(dev))
1708 dev->power.wakeup_path = true;
1709
1710 dpm_propagate_wakeup_to_parent(dev);
1711 dpm_clear_superiors_direct_complete(dev);
1712 }
1713
1714 device_unlock(dev);
1715 dpm_watchdog_clear(&wd);
1716
1717 Complete:
1718 if (error) {
1719 async_error = error;
1720 dpm_save_failed_dev(dev_name(dev));
1721 pm_dev_err(dev, state, async ? " async" : "", error);
1722 }
1723
1724 complete_all(&dev->power.completion);
1725 TRACE_SUSPEND(error);
1726 return error;
1727 }
1728
async_suspend(void * data,async_cookie_t cookie)1729 static void async_suspend(void *data, async_cookie_t cookie)
1730 {
1731 struct device *dev = data;
1732
1733 device_suspend(dev, pm_transition, true);
1734 put_device(dev);
1735 }
1736
1737 /**
1738 * dpm_suspend - Execute "suspend" callbacks for all non-sysdev devices.
1739 * @state: PM transition of the system being carried out.
1740 */
dpm_suspend(pm_message_t state)1741 int dpm_suspend(pm_message_t state)
1742 {
1743 ktime_t starttime = ktime_get();
1744 int error = 0;
1745
1746 trace_suspend_resume(TPS("dpm_suspend"), state.event, true);
1747 might_sleep();
1748
1749 devfreq_suspend();
1750 cpufreq_suspend();
1751
1752 pm_transition = state;
1753 async_error = 0;
1754
1755 mutex_lock(&dpm_list_mtx);
1756
1757 while (!list_empty(&dpm_prepared_list)) {
1758 struct device *dev = to_device(dpm_prepared_list.prev);
1759
1760 list_move(&dev->power.entry, &dpm_suspended_list);
1761
1762 if (dpm_async_fn(dev, async_suspend))
1763 continue;
1764
1765 get_device(dev);
1766
1767 mutex_unlock(&dpm_list_mtx);
1768
1769 error = device_suspend(dev, state, false);
1770
1771 put_device(dev);
1772
1773 mutex_lock(&dpm_list_mtx);
1774
1775 if (error || async_error)
1776 break;
1777 }
1778
1779 mutex_unlock(&dpm_list_mtx);
1780
1781 async_synchronize_full();
1782 if (!error)
1783 error = async_error;
1784
1785 if (error)
1786 dpm_save_failed_step(SUSPEND_SUSPEND);
1787
1788 dpm_show_time(starttime, state, error, NULL);
1789 trace_suspend_resume(TPS("dpm_suspend"), state.event, false);
1790 return error;
1791 }
1792
1793 /**
1794 * device_prepare - Prepare a device for system power transition.
1795 * @dev: Device to handle.
1796 * @state: PM transition of the system being carried out.
1797 *
1798 * Execute the ->prepare() callback(s) for given device. No new children of the
1799 * device may be registered after this function has returned.
1800 */
device_prepare(struct device * dev,pm_message_t state)1801 static int device_prepare(struct device *dev, pm_message_t state)
1802 {
1803 int (*callback)(struct device *) = NULL;
1804 int ret = 0;
1805
1806 /*
1807 * If a device's parent goes into runtime suspend at the wrong time,
1808 * it won't be possible to resume the device. To prevent this we
1809 * block runtime suspend here, during the prepare phase, and allow
1810 * it again during the complete phase.
1811 */
1812 pm_runtime_get_noresume(dev);
1813
1814 if (dev->power.syscore)
1815 return 0;
1816
1817 device_lock(dev);
1818
1819 dev->power.wakeup_path = false;
1820
1821 if (dev->power.no_pm_callbacks)
1822 goto unlock;
1823
1824 if (dev->pm_domain)
1825 callback = dev->pm_domain->ops.prepare;
1826 else if (dev->type && dev->type->pm)
1827 callback = dev->type->pm->prepare;
1828 else if (dev->class && dev->class->pm)
1829 callback = dev->class->pm->prepare;
1830 else if (dev->bus && dev->bus->pm)
1831 callback = dev->bus->pm->prepare;
1832
1833 if (!callback && dev->driver && dev->driver->pm)
1834 callback = dev->driver->pm->prepare;
1835
1836 if (callback)
1837 ret = callback(dev);
1838
1839 unlock:
1840 device_unlock(dev);
1841
1842 if (ret < 0) {
1843 suspend_report_result(dev, callback, ret);
1844 pm_runtime_put(dev);
1845 return ret;
1846 }
1847 /*
1848 * A positive return value from ->prepare() means "this device appears
1849 * to be runtime-suspended and its state is fine, so if it really is
1850 * runtime-suspended, you can leave it in that state provided that you
1851 * will do the same thing with all of its descendants". This only
1852 * applies to suspend transitions, however.
1853 */
1854 spin_lock_irq(&dev->power.lock);
1855 dev->power.direct_complete = state.event == PM_EVENT_SUSPEND &&
1856 (ret > 0 || dev->power.no_pm_callbacks) &&
1857 !dev_pm_test_driver_flags(dev, DPM_FLAG_NO_DIRECT_COMPLETE);
1858 spin_unlock_irq(&dev->power.lock);
1859 return 0;
1860 }
1861
1862 /**
1863 * dpm_prepare - Prepare all non-sysdev devices for a system PM transition.
1864 * @state: PM transition of the system being carried out.
1865 *
1866 * Execute the ->prepare() callback(s) for all devices.
1867 */
dpm_prepare(pm_message_t state)1868 int dpm_prepare(pm_message_t state)
1869 {
1870 int error = 0;
1871
1872 trace_suspend_resume(TPS("dpm_prepare"), state.event, true);
1873 might_sleep();
1874
1875 /*
1876 * Give a chance for the known devices to complete their probes, before
1877 * disable probing of devices. This sync point is important at least
1878 * at boot time + hibernation restore.
1879 */
1880 wait_for_device_probe();
1881 /*
1882 * It is unsafe if probing of devices will happen during suspend or
1883 * hibernation and system behavior will be unpredictable in this case.
1884 * So, let's prohibit device's probing here and defer their probes
1885 * instead. The normal behavior will be restored in dpm_complete().
1886 */
1887 device_block_probing();
1888
1889 mutex_lock(&dpm_list_mtx);
1890 while (!list_empty(&dpm_list) && !error) {
1891 struct device *dev = to_device(dpm_list.next);
1892
1893 get_device(dev);
1894
1895 mutex_unlock(&dpm_list_mtx);
1896
1897 trace_device_pm_callback_start(dev, "", state.event);
1898 error = device_prepare(dev, state);
1899 trace_device_pm_callback_end(dev, error);
1900
1901 mutex_lock(&dpm_list_mtx);
1902
1903 if (!error) {
1904 dev->power.is_prepared = true;
1905 if (!list_empty(&dev->power.entry))
1906 list_move_tail(&dev->power.entry, &dpm_prepared_list);
1907 } else if (error == -EAGAIN) {
1908 error = 0;
1909 } else {
1910 dev_info(dev, "not prepared for power transition: code %d\n",
1911 error);
1912 }
1913
1914 mutex_unlock(&dpm_list_mtx);
1915
1916 put_device(dev);
1917
1918 mutex_lock(&dpm_list_mtx);
1919 }
1920 mutex_unlock(&dpm_list_mtx);
1921 trace_suspend_resume(TPS("dpm_prepare"), state.event, false);
1922 return error;
1923 }
1924
1925 /**
1926 * dpm_suspend_start - Prepare devices for PM transition and suspend them.
1927 * @state: PM transition of the system being carried out.
1928 *
1929 * Prepare all non-sysdev devices for system PM transition and execute "suspend"
1930 * callbacks for them.
1931 */
dpm_suspend_start(pm_message_t state)1932 int dpm_suspend_start(pm_message_t state)
1933 {
1934 ktime_t starttime = ktime_get();
1935 int error;
1936
1937 error = dpm_prepare(state);
1938 if (error)
1939 dpm_save_failed_step(SUSPEND_PREPARE);
1940 else
1941 error = dpm_suspend(state);
1942
1943 dpm_show_time(starttime, state, error, "start");
1944 return error;
1945 }
1946 EXPORT_SYMBOL_GPL(dpm_suspend_start);
1947
__suspend_report_result(const char * function,struct device * dev,void * fn,int ret)1948 void __suspend_report_result(const char *function, struct device *dev, void *fn, int ret)
1949 {
1950 if (ret)
1951 dev_err(dev, "%s(): %ps returns %d\n", function, fn, ret);
1952 }
1953 EXPORT_SYMBOL_GPL(__suspend_report_result);
1954
1955 /**
1956 * device_pm_wait_for_dev - Wait for suspend/resume of a device to complete.
1957 * @subordinate: Device that needs to wait for @dev.
1958 * @dev: Device to wait for.
1959 */
device_pm_wait_for_dev(struct device * subordinate,struct device * dev)1960 int device_pm_wait_for_dev(struct device *subordinate, struct device *dev)
1961 {
1962 dpm_wait(dev, subordinate->power.async_suspend);
1963 return async_error;
1964 }
1965 EXPORT_SYMBOL_GPL(device_pm_wait_for_dev);
1966
1967 /**
1968 * dpm_for_each_dev - device iterator.
1969 * @data: data for the callback.
1970 * @fn: function to be called for each device.
1971 *
1972 * Iterate over devices in dpm_list, and call @fn for each device,
1973 * passing it @data.
1974 */
dpm_for_each_dev(void * data,void (* fn)(struct device *,void *))1975 void dpm_for_each_dev(void *data, void (*fn)(struct device *, void *))
1976 {
1977 struct device *dev;
1978
1979 if (!fn)
1980 return;
1981
1982 device_pm_lock();
1983 list_for_each_entry(dev, &dpm_list, power.entry)
1984 fn(dev, data);
1985 device_pm_unlock();
1986 }
1987 EXPORT_SYMBOL_GPL(dpm_for_each_dev);
1988
pm_ops_is_empty(const struct dev_pm_ops * ops)1989 static bool pm_ops_is_empty(const struct dev_pm_ops *ops)
1990 {
1991 if (!ops)
1992 return true;
1993
1994 return !ops->prepare &&
1995 !ops->suspend &&
1996 !ops->suspend_late &&
1997 !ops->suspend_noirq &&
1998 !ops->resume_noirq &&
1999 !ops->resume_early &&
2000 !ops->resume &&
2001 !ops->complete;
2002 }
2003
device_pm_check_callbacks(struct device * dev)2004 void device_pm_check_callbacks(struct device *dev)
2005 {
2006 unsigned long flags;
2007
2008 spin_lock_irqsave(&dev->power.lock, flags);
2009 dev->power.no_pm_callbacks =
2010 (!dev->bus || (pm_ops_is_empty(dev->bus->pm) &&
2011 !dev->bus->suspend && !dev->bus->resume)) &&
2012 (!dev->class || pm_ops_is_empty(dev->class->pm)) &&
2013 (!dev->type || pm_ops_is_empty(dev->type->pm)) &&
2014 (!dev->pm_domain || pm_ops_is_empty(&dev->pm_domain->ops)) &&
2015 (!dev->driver || (pm_ops_is_empty(dev->driver->pm) &&
2016 !dev->driver->suspend && !dev->driver->resume));
2017 spin_unlock_irqrestore(&dev->power.lock, flags);
2018 }
2019
dev_pm_skip_suspend(struct device * dev)2020 bool dev_pm_skip_suspend(struct device *dev)
2021 {
2022 return dev_pm_test_driver_flags(dev, DPM_FLAG_SMART_SUSPEND) &&
2023 pm_runtime_status_suspended(dev);
2024 }
2025