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 };
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 */
dpm_watchdog_handler(struct timer_list * t)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 */
dpm_watchdog_set(struct dpm_watchdog * wd,struct device * dev)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 */
dpm_watchdog_clear(struct dpm_watchdog * wd)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 */
dev_pm_skip_resume(struct device * dev)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
is_async(struct device * dev)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
dpm_async_fn(struct device * dev,async_func_t func)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 */
device_resume_noirq(struct device * dev,pm_message_t state,bool async)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
async_resume_noirq(void * data,async_cookie_t cookie)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
dpm_noirq_resume_devices(pm_message_t state)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 pm_transition = state;
711
712 mutex_lock(&dpm_list_mtx);
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 */
dpm_resume_noirq(pm_message_t state)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 */
device_resume_early(struct device * dev,pm_message_t state,bool async)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
async_resume_early(void * data,async_cookie_t cookie)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 */
dpm_resume_early(pm_message_t state)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 pm_transition = state;
851
852 mutex_lock(&dpm_list_mtx);
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 */
dpm_resume_start(pm_message_t state)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 */
device_resume(struct device * dev,pm_message_t state,bool async)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
async_resume(void * data,async_cookie_t cookie)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 */
dpm_resume(pm_message_t state)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 pm_transition = state;
1016 async_error = 0;
1017
1018 mutex_lock(&dpm_list_mtx);
1019
1020 /*
1021 * Trigger the resume of "async" devices upfront so they don't have to
1022 * wait for the "non-async" ones they don't depend on.
1023 */
1024 list_for_each_entry(dev, &dpm_suspended_list, power.entry)
1025 dpm_async_fn(dev, async_resume);
1026
1027 while (!list_empty(&dpm_suspended_list)) {
1028 dev = to_device(dpm_suspended_list.next);
1029 list_move_tail(&dev->power.entry, &dpm_prepared_list);
1030
1031 if (!dev->power.async_in_progress) {
1032 get_device(dev);
1033
1034 mutex_unlock(&dpm_list_mtx);
1035
1036 device_resume(dev, state, false);
1037
1038 put_device(dev);
1039
1040 mutex_lock(&dpm_list_mtx);
1041 }
1042 }
1043 mutex_unlock(&dpm_list_mtx);
1044 async_synchronize_full();
1045 dpm_show_time(starttime, state, 0, NULL);
1046 if (async_error)
1047 dpm_save_failed_step(SUSPEND_RESUME);
1048
1049 cpufreq_resume();
1050 devfreq_resume();
1051 trace_suspend_resume(TPS("dpm_resume"), state.event, false);
1052 }
1053
1054 /**
1055 * device_complete - Complete a PM transition for given device.
1056 * @dev: Device to handle.
1057 * @state: PM transition of the system being carried out.
1058 */
device_complete(struct device * dev,pm_message_t state)1059 static void device_complete(struct device *dev, pm_message_t state)
1060 {
1061 void (*callback)(struct device *) = NULL;
1062 const char *info = NULL;
1063
1064 if (dev->power.syscore)
1065 goto out;
1066
1067 device_lock(dev);
1068
1069 if (dev->pm_domain) {
1070 info = "completing power domain ";
1071 callback = dev->pm_domain->ops.complete;
1072 } else if (dev->type && dev->type->pm) {
1073 info = "completing type ";
1074 callback = dev->type->pm->complete;
1075 } else if (dev->class && dev->class->pm) {
1076 info = "completing class ";
1077 callback = dev->class->pm->complete;
1078 } else if (dev->bus && dev->bus->pm) {
1079 info = "completing bus ";
1080 callback = dev->bus->pm->complete;
1081 }
1082
1083 if (!callback && dev->driver && dev->driver->pm) {
1084 info = "completing driver ";
1085 callback = dev->driver->pm->complete;
1086 }
1087
1088 if (callback) {
1089 pm_dev_dbg(dev, state, info);
1090 callback(dev);
1091 }
1092
1093 device_unlock(dev);
1094
1095 out:
1096 pm_runtime_put(dev);
1097 }
1098
1099 /**
1100 * dpm_complete - Complete a PM transition for all non-sysdev devices.
1101 * @state: PM transition of the system being carried out.
1102 *
1103 * Execute the ->complete() callbacks for all devices whose PM status is not
1104 * DPM_ON (this allows new devices to be registered).
1105 */
dpm_complete(pm_message_t state)1106 void dpm_complete(pm_message_t state)
1107 {
1108 struct list_head list;
1109
1110 trace_suspend_resume(TPS("dpm_complete"), state.event, true);
1111 might_sleep();
1112
1113 INIT_LIST_HEAD(&list);
1114 mutex_lock(&dpm_list_mtx);
1115 while (!list_empty(&dpm_prepared_list)) {
1116 struct device *dev = to_device(dpm_prepared_list.prev);
1117
1118 get_device(dev);
1119 dev->power.is_prepared = false;
1120 list_move(&dev->power.entry, &list);
1121
1122 mutex_unlock(&dpm_list_mtx);
1123
1124 trace_device_pm_callback_start(dev, "", state.event);
1125 device_complete(dev, state);
1126 trace_device_pm_callback_end(dev, 0);
1127
1128 put_device(dev);
1129
1130 mutex_lock(&dpm_list_mtx);
1131 }
1132 list_splice(&list, &dpm_list);
1133 mutex_unlock(&dpm_list_mtx);
1134
1135 /* Allow device probing and trigger re-probing of deferred devices */
1136 device_unblock_probing();
1137 trace_suspend_resume(TPS("dpm_complete"), state.event, false);
1138 }
1139
1140 /**
1141 * dpm_resume_end - Execute "resume" callbacks and complete system transition.
1142 * @state: PM transition of the system being carried out.
1143 *
1144 * Execute "resume" callbacks for all devices and complete the PM transition of
1145 * the system.
1146 */
dpm_resume_end(pm_message_t state)1147 void dpm_resume_end(pm_message_t state)
1148 {
1149 dpm_resume(state);
1150 dpm_complete(state);
1151 }
1152 EXPORT_SYMBOL_GPL(dpm_resume_end);
1153
1154
1155 /*------------------------- Suspend routines -------------------------*/
1156
1157 /**
1158 * resume_event - Return a "resume" message for given "suspend" sleep state.
1159 * @sleep_state: PM message representing a sleep state.
1160 *
1161 * Return a PM message representing the resume event corresponding to given
1162 * sleep state.
1163 */
resume_event(pm_message_t sleep_state)1164 static pm_message_t resume_event(pm_message_t sleep_state)
1165 {
1166 switch (sleep_state.event) {
1167 case PM_EVENT_SUSPEND:
1168 return PMSG_RESUME;
1169 case PM_EVENT_FREEZE:
1170 case PM_EVENT_QUIESCE:
1171 return PMSG_RECOVER;
1172 case PM_EVENT_HIBERNATE:
1173 return PMSG_RESTORE;
1174 }
1175 return PMSG_ON;
1176 }
1177
dpm_superior_set_must_resume(struct device * dev)1178 static void dpm_superior_set_must_resume(struct device *dev)
1179 {
1180 struct device_link *link;
1181 int idx;
1182
1183 if (dev->parent)
1184 dev->parent->power.must_resume = true;
1185
1186 idx = device_links_read_lock();
1187
1188 list_for_each_entry_rcu_locked(link, &dev->links.suppliers, c_node)
1189 link->supplier->power.must_resume = true;
1190
1191 device_links_read_unlock(idx);
1192 }
1193
1194 /**
1195 * device_suspend_noirq - Execute a "noirq suspend" callback for given device.
1196 * @dev: Device to handle.
1197 * @state: PM transition of the system being carried out.
1198 * @async: If true, the device is being suspended asynchronously.
1199 *
1200 * The driver of @dev will not receive interrupts while this function is being
1201 * executed.
1202 */
device_suspend_noirq(struct device * dev,pm_message_t state,bool async)1203 static int device_suspend_noirq(struct device *dev, pm_message_t state, bool async)
1204 {
1205 pm_callback_t callback = NULL;
1206 const char *info = NULL;
1207 int error = 0;
1208
1209 TRACE_DEVICE(dev);
1210 TRACE_SUSPEND(0);
1211
1212 dpm_wait_for_subordinate(dev, async);
1213
1214 if (async_error)
1215 goto Complete;
1216
1217 if (dev->power.syscore || dev->power.direct_complete)
1218 goto Complete;
1219
1220 if (dev->pm_domain) {
1221 info = "noirq power domain ";
1222 callback = pm_noirq_op(&dev->pm_domain->ops, state);
1223 } else if (dev->type && dev->type->pm) {
1224 info = "noirq type ";
1225 callback = pm_noirq_op(dev->type->pm, state);
1226 } else if (dev->class && dev->class->pm) {
1227 info = "noirq class ";
1228 callback = pm_noirq_op(dev->class->pm, state);
1229 } else if (dev->bus && dev->bus->pm) {
1230 info = "noirq bus ";
1231 callback = pm_noirq_op(dev->bus->pm, state);
1232 }
1233 if (callback)
1234 goto Run;
1235
1236 if (dev_pm_skip_suspend(dev))
1237 goto Skip;
1238
1239 if (dev->driver && dev->driver->pm) {
1240 info = "noirq driver ";
1241 callback = pm_noirq_op(dev->driver->pm, state);
1242 }
1243
1244 Run:
1245 error = dpm_run_callback(callback, dev, state, info);
1246 if (error) {
1247 async_error = error;
1248 dpm_save_failed_dev(dev_name(dev));
1249 pm_dev_err(dev, state, async ? " async noirq" : " noirq", error);
1250 goto Complete;
1251 }
1252
1253 Skip:
1254 dev->power.is_noirq_suspended = true;
1255
1256 /*
1257 * Skipping the resume of devices that were in use right before the
1258 * system suspend (as indicated by their PM-runtime usage counters)
1259 * would be suboptimal. Also resume them if doing that is not allowed
1260 * to be skipped.
1261 */
1262 if (atomic_read(&dev->power.usage_count) > 1 ||
1263 !(dev_pm_test_driver_flags(dev, DPM_FLAG_MAY_SKIP_RESUME) &&
1264 dev->power.may_skip_resume))
1265 dev->power.must_resume = true;
1266
1267 if (dev->power.must_resume)
1268 dpm_superior_set_must_resume(dev);
1269
1270 Complete:
1271 complete_all(&dev->power.completion);
1272 TRACE_SUSPEND(error);
1273 return error;
1274 }
1275
async_suspend_noirq(void * data,async_cookie_t cookie)1276 static void async_suspend_noirq(void *data, async_cookie_t cookie)
1277 {
1278 struct device *dev = data;
1279
1280 device_suspend_noirq(dev, pm_transition, true);
1281 put_device(dev);
1282 }
1283
dpm_noirq_suspend_devices(pm_message_t state)1284 static int dpm_noirq_suspend_devices(pm_message_t state)
1285 {
1286 ktime_t starttime = ktime_get();
1287 int error = 0;
1288
1289 trace_suspend_resume(TPS("dpm_suspend_noirq"), state.event, true);
1290
1291 pm_transition = state;
1292 async_error = 0;
1293
1294 mutex_lock(&dpm_list_mtx);
1295
1296 while (!list_empty(&dpm_late_early_list)) {
1297 struct device *dev = to_device(dpm_late_early_list.prev);
1298
1299 list_move(&dev->power.entry, &dpm_noirq_list);
1300
1301 if (dpm_async_fn(dev, async_suspend_noirq))
1302 continue;
1303
1304 get_device(dev);
1305
1306 mutex_unlock(&dpm_list_mtx);
1307
1308 error = device_suspend_noirq(dev, state, false);
1309
1310 put_device(dev);
1311
1312 mutex_lock(&dpm_list_mtx);
1313
1314 if (error || async_error)
1315 break;
1316 }
1317
1318 mutex_unlock(&dpm_list_mtx);
1319
1320 async_synchronize_full();
1321 if (!error)
1322 error = async_error;
1323
1324 if (error)
1325 dpm_save_failed_step(SUSPEND_SUSPEND_NOIRQ);
1326
1327 dpm_show_time(starttime, state, error, "noirq");
1328 trace_suspend_resume(TPS("dpm_suspend_noirq"), state.event, false);
1329 return error;
1330 }
1331
1332 /**
1333 * dpm_suspend_noirq - Execute "noirq suspend" callbacks for all devices.
1334 * @state: PM transition of the system being carried out.
1335 *
1336 * Prevent device drivers' interrupt handlers from being called and invoke
1337 * "noirq" suspend callbacks for all non-sysdev devices.
1338 */
dpm_suspend_noirq(pm_message_t state)1339 int dpm_suspend_noirq(pm_message_t state)
1340 {
1341 int ret;
1342
1343 device_wakeup_arm_wake_irqs();
1344 suspend_device_irqs();
1345
1346 ret = dpm_noirq_suspend_devices(state);
1347 if (ret)
1348 dpm_resume_noirq(resume_event(state));
1349
1350 return ret;
1351 }
1352
dpm_propagate_wakeup_to_parent(struct device * dev)1353 static void dpm_propagate_wakeup_to_parent(struct device *dev)
1354 {
1355 struct device *parent = dev->parent;
1356
1357 if (!parent)
1358 return;
1359
1360 spin_lock_irq(&parent->power.lock);
1361
1362 if (device_wakeup_path(dev) && !parent->power.ignore_children)
1363 parent->power.wakeup_path = true;
1364
1365 spin_unlock_irq(&parent->power.lock);
1366 }
1367
1368 /**
1369 * device_suspend_late - Execute a "late suspend" callback for given device.
1370 * @dev: Device to handle.
1371 * @state: PM transition of the system being carried out.
1372 * @async: If true, the device is being suspended asynchronously.
1373 *
1374 * Runtime PM is disabled for @dev while this function is being executed.
1375 */
device_suspend_late(struct device * dev,pm_message_t state,bool async)1376 static int device_suspend_late(struct device *dev, pm_message_t state, bool async)
1377 {
1378 pm_callback_t callback = NULL;
1379 const char *info = NULL;
1380 int error = 0;
1381
1382 TRACE_DEVICE(dev);
1383 TRACE_SUSPEND(0);
1384
1385 __pm_runtime_disable(dev, false);
1386
1387 dpm_wait_for_subordinate(dev, async);
1388
1389 if (async_error)
1390 goto Complete;
1391
1392 if (pm_wakeup_pending()) {
1393 async_error = -EBUSY;
1394 goto Complete;
1395 }
1396
1397 if (dev->power.syscore || dev->power.direct_complete)
1398 goto Complete;
1399
1400 if (dev->pm_domain) {
1401 info = "late power domain ";
1402 callback = pm_late_early_op(&dev->pm_domain->ops, state);
1403 } else if (dev->type && dev->type->pm) {
1404 info = "late type ";
1405 callback = pm_late_early_op(dev->type->pm, state);
1406 } else if (dev->class && dev->class->pm) {
1407 info = "late class ";
1408 callback = pm_late_early_op(dev->class->pm, state);
1409 } else if (dev->bus && dev->bus->pm) {
1410 info = "late bus ";
1411 callback = pm_late_early_op(dev->bus->pm, state);
1412 }
1413 if (callback)
1414 goto Run;
1415
1416 if (dev_pm_skip_suspend(dev))
1417 goto Skip;
1418
1419 if (dev->driver && dev->driver->pm) {
1420 info = "late driver ";
1421 callback = pm_late_early_op(dev->driver->pm, state);
1422 }
1423
1424 Run:
1425 error = dpm_run_callback(callback, dev, state, info);
1426 if (error) {
1427 async_error = error;
1428 dpm_save_failed_dev(dev_name(dev));
1429 pm_dev_err(dev, state, async ? " async late" : " late", error);
1430 goto Complete;
1431 }
1432 dpm_propagate_wakeup_to_parent(dev);
1433
1434 Skip:
1435 dev->power.is_late_suspended = true;
1436
1437 Complete:
1438 TRACE_SUSPEND(error);
1439 complete_all(&dev->power.completion);
1440 return error;
1441 }
1442
async_suspend_late(void * data,async_cookie_t cookie)1443 static void async_suspend_late(void *data, async_cookie_t cookie)
1444 {
1445 struct device *dev = data;
1446
1447 device_suspend_late(dev, pm_transition, true);
1448 put_device(dev);
1449 }
1450
1451 /**
1452 * dpm_suspend_late - Execute "late suspend" callbacks for all devices.
1453 * @state: PM transition of the system being carried out.
1454 */
dpm_suspend_late(pm_message_t state)1455 int dpm_suspend_late(pm_message_t state)
1456 {
1457 ktime_t starttime = ktime_get();
1458 int error = 0;
1459
1460 trace_suspend_resume(TPS("dpm_suspend_late"), state.event, true);
1461
1462 pm_transition = state;
1463 async_error = 0;
1464
1465 wake_up_all_idle_cpus();
1466
1467 mutex_lock(&dpm_list_mtx);
1468
1469 while (!list_empty(&dpm_suspended_list)) {
1470 struct device *dev = to_device(dpm_suspended_list.prev);
1471
1472 list_move(&dev->power.entry, &dpm_late_early_list);
1473
1474 if (dpm_async_fn(dev, async_suspend_late))
1475 continue;
1476
1477 get_device(dev);
1478
1479 mutex_unlock(&dpm_list_mtx);
1480
1481 error = device_suspend_late(dev, state, false);
1482
1483 put_device(dev);
1484
1485 mutex_lock(&dpm_list_mtx);
1486
1487 if (error || async_error)
1488 break;
1489 }
1490
1491 mutex_unlock(&dpm_list_mtx);
1492
1493 async_synchronize_full();
1494 if (!error)
1495 error = async_error;
1496
1497 if (error) {
1498 dpm_save_failed_step(SUSPEND_SUSPEND_LATE);
1499 dpm_resume_early(resume_event(state));
1500 }
1501 dpm_show_time(starttime, state, error, "late");
1502 trace_suspend_resume(TPS("dpm_suspend_late"), state.event, false);
1503 return error;
1504 }
1505
1506 /**
1507 * dpm_suspend_end - Execute "late" and "noirq" device suspend callbacks.
1508 * @state: PM transition of the system being carried out.
1509 */
dpm_suspend_end(pm_message_t state)1510 int dpm_suspend_end(pm_message_t state)
1511 {
1512 ktime_t starttime = ktime_get();
1513 int error;
1514
1515 error = dpm_suspend_late(state);
1516 if (error)
1517 goto out;
1518
1519 error = dpm_suspend_noirq(state);
1520 if (error)
1521 dpm_resume_early(resume_event(state));
1522
1523 out:
1524 dpm_show_time(starttime, state, error, "end");
1525 return error;
1526 }
1527 EXPORT_SYMBOL_GPL(dpm_suspend_end);
1528
1529 /**
1530 * legacy_suspend - Execute a legacy (bus or class) suspend callback for device.
1531 * @dev: Device to suspend.
1532 * @state: PM transition of the system being carried out.
1533 * @cb: Suspend callback to execute.
1534 * @info: string description of caller.
1535 */
legacy_suspend(struct device * dev,pm_message_t state,int (* cb)(struct device * dev,pm_message_t state),const char * info)1536 static int legacy_suspend(struct device *dev, pm_message_t state,
1537 int (*cb)(struct device *dev, pm_message_t state),
1538 const char *info)
1539 {
1540 int error;
1541 ktime_t calltime;
1542
1543 calltime = initcall_debug_start(dev, cb);
1544
1545 trace_device_pm_callback_start(dev, info, state.event);
1546 error = cb(dev, state);
1547 trace_device_pm_callback_end(dev, error);
1548 suspend_report_result(dev, cb, error);
1549
1550 initcall_debug_report(dev, calltime, cb, error);
1551
1552 return error;
1553 }
1554
dpm_clear_superiors_direct_complete(struct device * dev)1555 static void dpm_clear_superiors_direct_complete(struct device *dev)
1556 {
1557 struct device_link *link;
1558 int idx;
1559
1560 if (dev->parent) {
1561 spin_lock_irq(&dev->parent->power.lock);
1562 dev->parent->power.direct_complete = false;
1563 spin_unlock_irq(&dev->parent->power.lock);
1564 }
1565
1566 idx = device_links_read_lock();
1567
1568 list_for_each_entry_rcu_locked(link, &dev->links.suppliers, c_node) {
1569 spin_lock_irq(&link->supplier->power.lock);
1570 link->supplier->power.direct_complete = false;
1571 spin_unlock_irq(&link->supplier->power.lock);
1572 }
1573
1574 device_links_read_unlock(idx);
1575 }
1576
1577 /**
1578 * device_suspend - Execute "suspend" callbacks for given device.
1579 * @dev: Device to handle.
1580 * @state: PM transition of the system being carried out.
1581 * @async: If true, the device is being suspended asynchronously.
1582 */
device_suspend(struct device * dev,pm_message_t state,bool async)1583 static int device_suspend(struct device *dev, pm_message_t state, bool async)
1584 {
1585 pm_callback_t callback = NULL;
1586 const char *info = NULL;
1587 int error = 0;
1588 DECLARE_DPM_WATCHDOG_ON_STACK(wd);
1589
1590 TRACE_DEVICE(dev);
1591 TRACE_SUSPEND(0);
1592
1593 dpm_wait_for_subordinate(dev, async);
1594
1595 if (async_error) {
1596 dev->power.direct_complete = false;
1597 goto Complete;
1598 }
1599
1600 /*
1601 * Wait for possible runtime PM transitions of the device in progress
1602 * to complete and if there's a runtime resume request pending for it,
1603 * resume it before proceeding with invoking the system-wide suspend
1604 * callbacks for it.
1605 *
1606 * If the system-wide suspend callbacks below change the configuration
1607 * of the device, they must disable runtime PM for it or otherwise
1608 * ensure that its runtime-resume callbacks will not be confused by that
1609 * change in case they are invoked going forward.
1610 */
1611 pm_runtime_barrier(dev);
1612
1613 if (pm_wakeup_pending()) {
1614 dev->power.direct_complete = false;
1615 async_error = -EBUSY;
1616 goto Complete;
1617 }
1618
1619 if (dev->power.syscore)
1620 goto Complete;
1621
1622 /* Avoid direct_complete to let wakeup_path propagate. */
1623 if (device_may_wakeup(dev) || device_wakeup_path(dev))
1624 dev->power.direct_complete = false;
1625
1626 if (dev->power.direct_complete) {
1627 if (pm_runtime_status_suspended(dev)) {
1628 pm_runtime_disable(dev);
1629 if (pm_runtime_status_suspended(dev)) {
1630 pm_dev_dbg(dev, state, "direct-complete ");
1631 goto Complete;
1632 }
1633
1634 pm_runtime_enable(dev);
1635 }
1636 dev->power.direct_complete = false;
1637 }
1638
1639 dev->power.may_skip_resume = true;
1640 dev->power.must_resume = !dev_pm_test_driver_flags(dev, DPM_FLAG_MAY_SKIP_RESUME);
1641
1642 dpm_watchdog_set(&wd, dev);
1643 device_lock(dev);
1644
1645 if (dev->pm_domain) {
1646 info = "power domain ";
1647 callback = pm_op(&dev->pm_domain->ops, state);
1648 goto Run;
1649 }
1650
1651 if (dev->type && dev->type->pm) {
1652 info = "type ";
1653 callback = pm_op(dev->type->pm, state);
1654 goto Run;
1655 }
1656
1657 if (dev->class && dev->class->pm) {
1658 info = "class ";
1659 callback = pm_op(dev->class->pm, state);
1660 goto Run;
1661 }
1662
1663 if (dev->bus) {
1664 if (dev->bus->pm) {
1665 info = "bus ";
1666 callback = pm_op(dev->bus->pm, state);
1667 } else if (dev->bus->suspend) {
1668 pm_dev_dbg(dev, state, "legacy bus ");
1669 error = legacy_suspend(dev, state, dev->bus->suspend,
1670 "legacy bus ");
1671 goto End;
1672 }
1673 }
1674
1675 Run:
1676 if (!callback && dev->driver && dev->driver->pm) {
1677 info = "driver ";
1678 callback = pm_op(dev->driver->pm, state);
1679 }
1680
1681 error = dpm_run_callback(callback, dev, state, info);
1682
1683 End:
1684 if (!error) {
1685 dev->power.is_suspended = true;
1686 if (device_may_wakeup(dev))
1687 dev->power.wakeup_path = true;
1688
1689 dpm_propagate_wakeup_to_parent(dev);
1690 dpm_clear_superiors_direct_complete(dev);
1691 }
1692
1693 device_unlock(dev);
1694 dpm_watchdog_clear(&wd);
1695
1696 Complete:
1697 if (error) {
1698 async_error = error;
1699 dpm_save_failed_dev(dev_name(dev));
1700 pm_dev_err(dev, state, async ? " async" : "", error);
1701 }
1702
1703 complete_all(&dev->power.completion);
1704 TRACE_SUSPEND(error);
1705 return error;
1706 }
1707
async_suspend(void * data,async_cookie_t cookie)1708 static void async_suspend(void *data, async_cookie_t cookie)
1709 {
1710 struct device *dev = data;
1711
1712 device_suspend(dev, pm_transition, true);
1713 put_device(dev);
1714 }
1715
1716 /**
1717 * dpm_suspend - Execute "suspend" callbacks for all non-sysdev devices.
1718 * @state: PM transition of the system being carried out.
1719 */
dpm_suspend(pm_message_t state)1720 int dpm_suspend(pm_message_t state)
1721 {
1722 ktime_t starttime = ktime_get();
1723 int error = 0;
1724
1725 trace_suspend_resume(TPS("dpm_suspend"), state.event, true);
1726 might_sleep();
1727
1728 devfreq_suspend();
1729 cpufreq_suspend();
1730
1731 pm_transition = state;
1732 async_error = 0;
1733
1734 mutex_lock(&dpm_list_mtx);
1735
1736 while (!list_empty(&dpm_prepared_list)) {
1737 struct device *dev = to_device(dpm_prepared_list.prev);
1738
1739 list_move(&dev->power.entry, &dpm_suspended_list);
1740
1741 if (dpm_async_fn(dev, async_suspend))
1742 continue;
1743
1744 get_device(dev);
1745
1746 mutex_unlock(&dpm_list_mtx);
1747
1748 error = device_suspend(dev, state, false);
1749
1750 put_device(dev);
1751
1752 mutex_lock(&dpm_list_mtx);
1753
1754 if (error || async_error)
1755 break;
1756 }
1757
1758 mutex_unlock(&dpm_list_mtx);
1759
1760 async_synchronize_full();
1761 if (!error)
1762 error = async_error;
1763
1764 if (error)
1765 dpm_save_failed_step(SUSPEND_SUSPEND);
1766
1767 dpm_show_time(starttime, state, error, NULL);
1768 trace_suspend_resume(TPS("dpm_suspend"), state.event, false);
1769 return error;
1770 }
1771
1772 /**
1773 * device_prepare - Prepare a device for system power transition.
1774 * @dev: Device to handle.
1775 * @state: PM transition of the system being carried out.
1776 *
1777 * Execute the ->prepare() callback(s) for given device. No new children of the
1778 * device may be registered after this function has returned.
1779 */
device_prepare(struct device * dev,pm_message_t state)1780 static int device_prepare(struct device *dev, pm_message_t state)
1781 {
1782 int (*callback)(struct device *) = NULL;
1783 int ret = 0;
1784
1785 /*
1786 * If a device's parent goes into runtime suspend at the wrong time,
1787 * it won't be possible to resume the device. To prevent this we
1788 * block runtime suspend here, during the prepare phase, and allow
1789 * it again during the complete phase.
1790 */
1791 pm_runtime_get_noresume(dev);
1792
1793 if (dev->power.syscore)
1794 return 0;
1795
1796 device_lock(dev);
1797
1798 dev->power.wakeup_path = false;
1799
1800 if (dev->power.no_pm_callbacks)
1801 goto unlock;
1802
1803 if (dev->pm_domain)
1804 callback = dev->pm_domain->ops.prepare;
1805 else if (dev->type && dev->type->pm)
1806 callback = dev->type->pm->prepare;
1807 else if (dev->class && dev->class->pm)
1808 callback = dev->class->pm->prepare;
1809 else if (dev->bus && dev->bus->pm)
1810 callback = dev->bus->pm->prepare;
1811
1812 if (!callback && dev->driver && dev->driver->pm)
1813 callback = dev->driver->pm->prepare;
1814
1815 if (callback)
1816 ret = callback(dev);
1817
1818 unlock:
1819 device_unlock(dev);
1820
1821 if (ret < 0) {
1822 suspend_report_result(dev, callback, ret);
1823 pm_runtime_put(dev);
1824 return ret;
1825 }
1826 /*
1827 * A positive return value from ->prepare() means "this device appears
1828 * to be runtime-suspended and its state is fine, so if it really is
1829 * runtime-suspended, you can leave it in that state provided that you
1830 * will do the same thing with all of its descendants". This only
1831 * applies to suspend transitions, however.
1832 */
1833 spin_lock_irq(&dev->power.lock);
1834 dev->power.direct_complete = state.event == PM_EVENT_SUSPEND &&
1835 (ret > 0 || dev->power.no_pm_callbacks) &&
1836 !dev_pm_test_driver_flags(dev, DPM_FLAG_NO_DIRECT_COMPLETE);
1837 spin_unlock_irq(&dev->power.lock);
1838 return 0;
1839 }
1840
1841 /**
1842 * dpm_prepare - Prepare all non-sysdev devices for a system PM transition.
1843 * @state: PM transition of the system being carried out.
1844 *
1845 * Execute the ->prepare() callback(s) for all devices.
1846 */
dpm_prepare(pm_message_t state)1847 int dpm_prepare(pm_message_t state)
1848 {
1849 int error = 0;
1850
1851 trace_suspend_resume(TPS("dpm_prepare"), state.event, true);
1852 might_sleep();
1853
1854 /*
1855 * Give a chance for the known devices to complete their probes, before
1856 * disable probing of devices. This sync point is important at least
1857 * at boot time + hibernation restore.
1858 */
1859 wait_for_device_probe();
1860 /*
1861 * It is unsafe if probing of devices will happen during suspend or
1862 * hibernation and system behavior will be unpredictable in this case.
1863 * So, let's prohibit device's probing here and defer their probes
1864 * instead. The normal behavior will be restored in dpm_complete().
1865 */
1866 device_block_probing();
1867
1868 mutex_lock(&dpm_list_mtx);
1869 while (!list_empty(&dpm_list) && !error) {
1870 struct device *dev = to_device(dpm_list.next);
1871
1872 get_device(dev);
1873
1874 mutex_unlock(&dpm_list_mtx);
1875
1876 trace_device_pm_callback_start(dev, "", state.event);
1877 error = device_prepare(dev, state);
1878 trace_device_pm_callback_end(dev, error);
1879
1880 mutex_lock(&dpm_list_mtx);
1881
1882 if (!error) {
1883 dev->power.is_prepared = true;
1884 if (!list_empty(&dev->power.entry))
1885 list_move_tail(&dev->power.entry, &dpm_prepared_list);
1886 } else if (error == -EAGAIN) {
1887 error = 0;
1888 } else {
1889 dev_info(dev, "not prepared for power transition: code %d\n",
1890 error);
1891 }
1892
1893 mutex_unlock(&dpm_list_mtx);
1894
1895 put_device(dev);
1896
1897 mutex_lock(&dpm_list_mtx);
1898 }
1899 mutex_unlock(&dpm_list_mtx);
1900 trace_suspend_resume(TPS("dpm_prepare"), state.event, false);
1901 return error;
1902 }
1903
1904 /**
1905 * dpm_suspend_start - Prepare devices for PM transition and suspend them.
1906 * @state: PM transition of the system being carried out.
1907 *
1908 * Prepare all non-sysdev devices for system PM transition and execute "suspend"
1909 * callbacks for them.
1910 */
dpm_suspend_start(pm_message_t state)1911 int dpm_suspend_start(pm_message_t state)
1912 {
1913 ktime_t starttime = ktime_get();
1914 int error;
1915
1916 error = dpm_prepare(state);
1917 if (error)
1918 dpm_save_failed_step(SUSPEND_PREPARE);
1919 else
1920 error = dpm_suspend(state);
1921
1922 dpm_show_time(starttime, state, error, "start");
1923 return error;
1924 }
1925 EXPORT_SYMBOL_GPL(dpm_suspend_start);
1926
__suspend_report_result(const char * function,struct device * dev,void * fn,int ret)1927 void __suspend_report_result(const char *function, struct device *dev, void *fn, int ret)
1928 {
1929 if (ret)
1930 dev_err(dev, "%s(): %ps returns %d\n", function, fn, ret);
1931 }
1932 EXPORT_SYMBOL_GPL(__suspend_report_result);
1933
1934 /**
1935 * device_pm_wait_for_dev - Wait for suspend/resume of a device to complete.
1936 * @subordinate: Device that needs to wait for @dev.
1937 * @dev: Device to wait for.
1938 */
device_pm_wait_for_dev(struct device * subordinate,struct device * dev)1939 int device_pm_wait_for_dev(struct device *subordinate, struct device *dev)
1940 {
1941 dpm_wait(dev, subordinate->power.async_suspend);
1942 return async_error;
1943 }
1944 EXPORT_SYMBOL_GPL(device_pm_wait_for_dev);
1945
1946 /**
1947 * dpm_for_each_dev - device iterator.
1948 * @data: data for the callback.
1949 * @fn: function to be called for each device.
1950 *
1951 * Iterate over devices in dpm_list, and call @fn for each device,
1952 * passing it @data.
1953 */
dpm_for_each_dev(void * data,void (* fn)(struct device *,void *))1954 void dpm_for_each_dev(void *data, void (*fn)(struct device *, void *))
1955 {
1956 struct device *dev;
1957
1958 if (!fn)
1959 return;
1960
1961 device_pm_lock();
1962 list_for_each_entry(dev, &dpm_list, power.entry)
1963 fn(dev, data);
1964 device_pm_unlock();
1965 }
1966 EXPORT_SYMBOL_GPL(dpm_for_each_dev);
1967
pm_ops_is_empty(const struct dev_pm_ops * ops)1968 static bool pm_ops_is_empty(const struct dev_pm_ops *ops)
1969 {
1970 if (!ops)
1971 return true;
1972
1973 return !ops->prepare &&
1974 !ops->suspend &&
1975 !ops->suspend_late &&
1976 !ops->suspend_noirq &&
1977 !ops->resume_noirq &&
1978 !ops->resume_early &&
1979 !ops->resume &&
1980 !ops->complete;
1981 }
1982
device_pm_check_callbacks(struct device * dev)1983 void device_pm_check_callbacks(struct device *dev)
1984 {
1985 unsigned long flags;
1986
1987 spin_lock_irqsave(&dev->power.lock, flags);
1988 dev->power.no_pm_callbacks =
1989 (!dev->bus || (pm_ops_is_empty(dev->bus->pm) &&
1990 !dev->bus->suspend && !dev->bus->resume)) &&
1991 (!dev->class || pm_ops_is_empty(dev->class->pm)) &&
1992 (!dev->type || pm_ops_is_empty(dev->type->pm)) &&
1993 (!dev->pm_domain || pm_ops_is_empty(&dev->pm_domain->ops)) &&
1994 (!dev->driver || (pm_ops_is_empty(dev->driver->pm) &&
1995 !dev->driver->suspend && !dev->driver->resume));
1996 spin_unlock_irqrestore(&dev->power.lock, flags);
1997 }
1998
dev_pm_skip_suspend(struct device * dev)1999 bool dev_pm_skip_suspend(struct device *dev)
2000 {
2001 return dev_pm_test_driver_flags(dev, DPM_FLAG_SMART_SUSPEND) &&
2002 pm_runtime_status_suspended(dev);
2003 }
2004