1 /*
2  * drivers/base/power/runtime.c - Helper functions for device runtime PM
3  *
4  * Copyright (c) 2009 Rafael J. Wysocki <rjw@sisk.pl>, Novell Inc.
5  * Copyright (C) 2010 Alan Stern <stern@rowland.harvard.edu>
6  *
7  * This file is released under the GPLv2.
8  */
9 
10 #include <linux/sched/mm.h>
11 #include <linux/export.h>
12 #include <linux/pm_runtime.h>
13 #include <linux/pm_wakeirq.h>
14 #include <trace/events/rpm.h>
15 
16 #include "../base.h"
17 #include "power.h"
18 
19 typedef int (*pm_callback_t)(struct device *);
20 
__rpm_get_callback(struct device * dev,size_t cb_offset)21 static pm_callback_t __rpm_get_callback(struct device *dev, size_t cb_offset)
22 {
23 	pm_callback_t cb;
24 	const struct dev_pm_ops *ops;
25 
26 	if (dev->pm_domain)
27 		ops = &dev->pm_domain->ops;
28 	else if (dev->type && dev->type->pm)
29 		ops = dev->type->pm;
30 	else if (dev->class && dev->class->pm)
31 		ops = dev->class->pm;
32 	else if (dev->bus && dev->bus->pm)
33 		ops = dev->bus->pm;
34 	else
35 		ops = NULL;
36 
37 	if (ops)
38 		cb = *(pm_callback_t *)((void *)ops + cb_offset);
39 	else
40 		cb = NULL;
41 
42 	if (!cb && dev->driver && dev->driver->pm)
43 		cb = *(pm_callback_t *)((void *)dev->driver->pm + cb_offset);
44 
45 	return cb;
46 }
47 
48 #define RPM_GET_CALLBACK(dev, callback) \
49 		__rpm_get_callback(dev, offsetof(struct dev_pm_ops, callback))
50 
51 static int rpm_resume(struct device *dev, int rpmflags);
52 static int rpm_suspend(struct device *dev, int rpmflags);
53 
54 /**
55  * update_pm_runtime_accounting - Update the time accounting of power states
56  * @dev: Device to update the accounting for
57  *
58  * In order to be able to have time accounting of the various power states
59  * (as used by programs such as PowerTOP to show the effectiveness of runtime
60  * PM), we need to track the time spent in each state.
61  * update_pm_runtime_accounting must be called each time before the
62  * runtime_status field is updated, to account the time in the old state
63  * correctly.
64  */
update_pm_runtime_accounting(struct device * dev)65 void update_pm_runtime_accounting(struct device *dev)
66 {
67 	unsigned long now = jiffies;
68 	unsigned long delta;
69 
70 	delta = now - dev->power.accounting_timestamp;
71 
72 	dev->power.accounting_timestamp = now;
73 
74 	if (dev->power.disable_depth > 0)
75 		return;
76 
77 	if (dev->power.runtime_status == RPM_SUSPENDED)
78 		dev->power.suspended_jiffies += delta;
79 	else
80 		dev->power.active_jiffies += delta;
81 }
82 
__update_runtime_status(struct device * dev,enum rpm_status status)83 static void __update_runtime_status(struct device *dev, enum rpm_status status)
84 {
85 	update_pm_runtime_accounting(dev);
86 	dev->power.runtime_status = status;
87 }
88 
89 /**
90  * pm_runtime_deactivate_timer - Deactivate given device's suspend timer.
91  * @dev: Device to handle.
92  */
pm_runtime_deactivate_timer(struct device * dev)93 static void pm_runtime_deactivate_timer(struct device *dev)
94 {
95 	if (dev->power.timer_expires > 0) {
96 		del_timer(&dev->power.suspend_timer);
97 		dev->power.timer_expires = 0;
98 	}
99 }
100 
101 /**
102  * pm_runtime_cancel_pending - Deactivate suspend timer and cancel requests.
103  * @dev: Device to handle.
104  */
pm_runtime_cancel_pending(struct device * dev)105 static void pm_runtime_cancel_pending(struct device *dev)
106 {
107 	pm_runtime_deactivate_timer(dev);
108 	/*
109 	 * In case there's a request pending, make sure its work function will
110 	 * return without doing anything.
111 	 */
112 	dev->power.request = RPM_REQ_NONE;
113 }
114 
115 /*
116  * pm_runtime_autosuspend_expiration - Get a device's autosuspend-delay expiration time.
117  * @dev: Device to handle.
118  *
119  * Compute the autosuspend-delay expiration time based on the device's
120  * power.last_busy time.  If the delay has already expired or is disabled
121  * (negative) or the power.use_autosuspend flag isn't set, return 0.
122  * Otherwise return the expiration time in jiffies (adjusted to be nonzero).
123  *
124  * This function may be called either with or without dev->power.lock held.
125  * Either way it can be racy, since power.last_busy may be updated at any time.
126  */
pm_runtime_autosuspend_expiration(struct device * dev)127 unsigned long pm_runtime_autosuspend_expiration(struct device *dev)
128 {
129 	int autosuspend_delay;
130 	long elapsed;
131 	unsigned long last_busy;
132 	unsigned long expires = 0;
133 
134 	if (!dev->power.use_autosuspend)
135 		goto out;
136 
137 	autosuspend_delay = READ_ONCE(dev->power.autosuspend_delay);
138 	if (autosuspend_delay < 0)
139 		goto out;
140 
141 	last_busy = READ_ONCE(dev->power.last_busy);
142 	elapsed = jiffies - last_busy;
143 	if (elapsed < 0)
144 		goto out;	/* jiffies has wrapped around. */
145 
146 	/*
147 	 * If the autosuspend_delay is >= 1 second, align the timer by rounding
148 	 * up to the nearest second.
149 	 */
150 	expires = last_busy + msecs_to_jiffies(autosuspend_delay);
151 	if (autosuspend_delay >= 1000)
152 		expires = round_jiffies(expires);
153 	expires += !expires;
154 	if (elapsed >= expires - last_busy)
155 		expires = 0;	/* Already expired. */
156 
157  out:
158 	return expires;
159 }
160 EXPORT_SYMBOL_GPL(pm_runtime_autosuspend_expiration);
161 
dev_memalloc_noio(struct device * dev,void * data)162 static int dev_memalloc_noio(struct device *dev, void *data)
163 {
164 	return dev->power.memalloc_noio;
165 }
166 
167 /*
168  * pm_runtime_set_memalloc_noio - Set a device's memalloc_noio flag.
169  * @dev: Device to handle.
170  * @enable: True for setting the flag and False for clearing the flag.
171  *
172  * Set the flag for all devices in the path from the device to the
173  * root device in the device tree if @enable is true, otherwise clear
174  * the flag for devices in the path whose siblings don't set the flag.
175  *
176  * The function should only be called by block device, or network
177  * device driver for solving the deadlock problem during runtime
178  * resume/suspend:
179  *
180  *     If memory allocation with GFP_KERNEL is called inside runtime
181  *     resume/suspend callback of any one of its ancestors(or the
182  *     block device itself), the deadlock may be triggered inside the
183  *     memory allocation since it might not complete until the block
184  *     device becomes active and the involed page I/O finishes. The
185  *     situation is pointed out first by Alan Stern. Network device
186  *     are involved in iSCSI kind of situation.
187  *
188  * The lock of dev_hotplug_mutex is held in the function for handling
189  * hotplug race because pm_runtime_set_memalloc_noio() may be called
190  * in async probe().
191  *
192  * The function should be called between device_add() and device_del()
193  * on the affected device(block/network device).
194  */
pm_runtime_set_memalloc_noio(struct device * dev,bool enable)195 void pm_runtime_set_memalloc_noio(struct device *dev, bool enable)
196 {
197 	static DEFINE_MUTEX(dev_hotplug_mutex);
198 
199 	mutex_lock(&dev_hotplug_mutex);
200 	for (;;) {
201 		bool enabled;
202 
203 		/* hold power lock since bitfield is not SMP-safe. */
204 		spin_lock_irq(&dev->power.lock);
205 		enabled = dev->power.memalloc_noio;
206 		dev->power.memalloc_noio = enable;
207 		spin_unlock_irq(&dev->power.lock);
208 
209 		/*
210 		 * not need to enable ancestors any more if the device
211 		 * has been enabled.
212 		 */
213 		if (enabled && enable)
214 			break;
215 
216 		dev = dev->parent;
217 
218 		/*
219 		 * clear flag of the parent device only if all the
220 		 * children don't set the flag because ancestor's
221 		 * flag was set by any one of the descendants.
222 		 */
223 		if (!dev || (!enable &&
224 			     device_for_each_child(dev, NULL,
225 						   dev_memalloc_noio)))
226 			break;
227 	}
228 	mutex_unlock(&dev_hotplug_mutex);
229 }
230 EXPORT_SYMBOL_GPL(pm_runtime_set_memalloc_noio);
231 
232 /**
233  * rpm_check_suspend_allowed - Test whether a device may be suspended.
234  * @dev: Device to test.
235  */
rpm_check_suspend_allowed(struct device * dev)236 static int rpm_check_suspend_allowed(struct device *dev)
237 {
238 	int retval = 0;
239 
240 	if (dev->power.runtime_error)
241 		retval = -EINVAL;
242 	else if (dev->power.disable_depth > 0)
243 		retval = -EACCES;
244 	else if (atomic_read(&dev->power.usage_count) > 0)
245 		retval = -EAGAIN;
246 	else if (!dev->power.ignore_children &&
247 			atomic_read(&dev->power.child_count))
248 		retval = -EBUSY;
249 
250 	/* Pending resume requests take precedence over suspends. */
251 	else if ((dev->power.deferred_resume
252 			&& dev->power.runtime_status == RPM_SUSPENDING)
253 	    || (dev->power.request_pending
254 			&& dev->power.request == RPM_REQ_RESUME))
255 		retval = -EAGAIN;
256 	else if (__dev_pm_qos_read_value(dev) == 0)
257 		retval = -EPERM;
258 	else if (dev->power.runtime_status == RPM_SUSPENDED)
259 		retval = 1;
260 
261 	return retval;
262 }
263 
rpm_get_suppliers(struct device * dev)264 static int rpm_get_suppliers(struct device *dev)
265 {
266 	struct device_link *link;
267 
268 	list_for_each_entry_rcu(link, &dev->links.suppliers, c_node) {
269 		int retval;
270 
271 		if (!(link->flags & DL_FLAG_PM_RUNTIME) ||
272 		    READ_ONCE(link->status) == DL_STATE_SUPPLIER_UNBIND)
273 			continue;
274 
275 		retval = pm_runtime_get_sync(link->supplier);
276 		/* Ignore suppliers with disabled runtime PM. */
277 		if (retval < 0 && retval != -EACCES) {
278 			pm_runtime_put_noidle(link->supplier);
279 			return retval;
280 		}
281 		refcount_inc(&link->rpm_active);
282 	}
283 	return 0;
284 }
285 
rpm_put_suppliers(struct device * dev)286 static void rpm_put_suppliers(struct device *dev)
287 {
288 	struct device_link *link;
289 
290 	list_for_each_entry_rcu(link, &dev->links.suppliers, c_node) {
291 		if (READ_ONCE(link->status) == DL_STATE_SUPPLIER_UNBIND)
292 			continue;
293 
294 		while (refcount_dec_not_one(&link->rpm_active))
295 			pm_runtime_put(link->supplier);
296 	}
297 }
298 
299 /**
300  * __rpm_callback - Run a given runtime PM callback for a given device.
301  * @cb: Runtime PM callback to run.
302  * @dev: Device to run the callback for.
303  */
__rpm_callback(int (* cb)(struct device *),struct device * dev)304 static int __rpm_callback(int (*cb)(struct device *), struct device *dev)
305 	__releases(&dev->power.lock) __acquires(&dev->power.lock)
306 {
307 	int retval, idx;
308 	bool use_links = dev->power.links_count > 0;
309 
310 	if (dev->power.irq_safe) {
311 		spin_unlock(&dev->power.lock);
312 	} else {
313 		spin_unlock_irq(&dev->power.lock);
314 
315 		/*
316 		 * Resume suppliers if necessary.
317 		 *
318 		 * The device's runtime PM status cannot change until this
319 		 * routine returns, so it is safe to read the status outside of
320 		 * the lock.
321 		 */
322 		if (use_links && dev->power.runtime_status == RPM_RESUMING) {
323 			idx = device_links_read_lock();
324 
325 			retval = rpm_get_suppliers(dev);
326 			if (retval)
327 				goto fail;
328 
329 			device_links_read_unlock(idx);
330 		}
331 	}
332 
333 	retval = cb(dev);
334 
335 	if (dev->power.irq_safe) {
336 		spin_lock(&dev->power.lock);
337 	} else {
338 		/*
339 		 * If the device is suspending and the callback has returned
340 		 * success, drop the usage counters of the suppliers that have
341 		 * been reference counted on its resume.
342 		 *
343 		 * Do that if resume fails too.
344 		 */
345 		if (use_links
346 		    && ((dev->power.runtime_status == RPM_SUSPENDING && !retval)
347 		    || (dev->power.runtime_status == RPM_RESUMING && retval))) {
348 			idx = device_links_read_lock();
349 
350  fail:
351 			rpm_put_suppliers(dev);
352 
353 			device_links_read_unlock(idx);
354 		}
355 
356 		spin_lock_irq(&dev->power.lock);
357 	}
358 
359 	return retval;
360 }
361 
362 /**
363  * rpm_idle - Notify device bus type if the device can be suspended.
364  * @dev: Device to notify the bus type about.
365  * @rpmflags: Flag bits.
366  *
367  * Check if the device's runtime PM status allows it to be suspended.  If
368  * another idle notification has been started earlier, return immediately.  If
369  * the RPM_ASYNC flag is set then queue an idle-notification request; otherwise
370  * run the ->runtime_idle() callback directly. If the ->runtime_idle callback
371  * doesn't exist or if it returns 0, call rpm_suspend with the RPM_AUTO flag.
372  *
373  * This function must be called under dev->power.lock with interrupts disabled.
374  */
rpm_idle(struct device * dev,int rpmflags)375 static int rpm_idle(struct device *dev, int rpmflags)
376 {
377 	int (*callback)(struct device *);
378 	int retval;
379 
380 	trace_rpm_idle_rcuidle(dev, rpmflags);
381 	retval = rpm_check_suspend_allowed(dev);
382 	if (retval < 0)
383 		;	/* Conditions are wrong. */
384 
385 	/* Idle notifications are allowed only in the RPM_ACTIVE state. */
386 	else if (dev->power.runtime_status != RPM_ACTIVE)
387 		retval = -EAGAIN;
388 
389 	/*
390 	 * Any pending request other than an idle notification takes
391 	 * precedence over us, except that the timer may be running.
392 	 */
393 	else if (dev->power.request_pending &&
394 	    dev->power.request > RPM_REQ_IDLE)
395 		retval = -EAGAIN;
396 
397 	/* Act as though RPM_NOWAIT is always set. */
398 	else if (dev->power.idle_notification)
399 		retval = -EINPROGRESS;
400 	if (retval)
401 		goto out;
402 
403 	/* Pending requests need to be canceled. */
404 	dev->power.request = RPM_REQ_NONE;
405 
406 	callback = RPM_GET_CALLBACK(dev, runtime_idle);
407 
408 	/* If no callback assume success. */
409 	if (!callback || dev->power.no_callbacks)
410 		goto out;
411 
412 	/* Carry out an asynchronous or a synchronous idle notification. */
413 	if (rpmflags & RPM_ASYNC) {
414 		dev->power.request = RPM_REQ_IDLE;
415 		if (!dev->power.request_pending) {
416 			dev->power.request_pending = true;
417 			queue_work(pm_wq, &dev->power.work);
418 		}
419 		trace_rpm_return_int_rcuidle(dev, _THIS_IP_, 0);
420 		return 0;
421 	}
422 
423 	dev->power.idle_notification = true;
424 
425 	if (dev->power.irq_safe)
426 		spin_unlock(&dev->power.lock);
427 	else
428 		spin_unlock_irq(&dev->power.lock);
429 
430 	retval = callback(dev);
431 
432 	if (dev->power.irq_safe)
433 		spin_lock(&dev->power.lock);
434 	else
435 		spin_lock_irq(&dev->power.lock);
436 
437 	dev->power.idle_notification = false;
438 	wake_up_all(&dev->power.wait_queue);
439 
440  out:
441 	trace_rpm_return_int_rcuidle(dev, _THIS_IP_, retval);
442 	return retval ? retval : rpm_suspend(dev, rpmflags | RPM_AUTO);
443 }
444 
445 /**
446  * rpm_callback - Run a given runtime PM callback for a given device.
447  * @cb: Runtime PM callback to run.
448  * @dev: Device to run the callback for.
449  */
rpm_callback(int (* cb)(struct device *),struct device * dev)450 static int rpm_callback(int (*cb)(struct device *), struct device *dev)
451 {
452 	int retval;
453 
454 	if (!cb)
455 		return -ENOSYS;
456 
457 	if (dev->power.memalloc_noio) {
458 		unsigned int noio_flag;
459 
460 		/*
461 		 * Deadlock might be caused if memory allocation with
462 		 * GFP_KERNEL happens inside runtime_suspend and
463 		 * runtime_resume callbacks of one block device's
464 		 * ancestor or the block device itself. Network
465 		 * device might be thought as part of iSCSI block
466 		 * device, so network device and its ancestor should
467 		 * be marked as memalloc_noio too.
468 		 */
469 		noio_flag = memalloc_noio_save();
470 		retval = __rpm_callback(cb, dev);
471 		memalloc_noio_restore(noio_flag);
472 	} else {
473 		retval = __rpm_callback(cb, dev);
474 	}
475 
476 	dev->power.runtime_error = retval;
477 	return retval != -EACCES ? retval : -EIO;
478 }
479 
480 /**
481  * rpm_suspend - Carry out runtime suspend of given device.
482  * @dev: Device to suspend.
483  * @rpmflags: Flag bits.
484  *
485  * Check if the device's runtime PM status allows it to be suspended.
486  * Cancel a pending idle notification, autosuspend or suspend. If
487  * another suspend has been started earlier, either return immediately
488  * or wait for it to finish, depending on the RPM_NOWAIT and RPM_ASYNC
489  * flags. If the RPM_ASYNC flag is set then queue a suspend request;
490  * otherwise run the ->runtime_suspend() callback directly. When
491  * ->runtime_suspend succeeded, if a deferred resume was requested while
492  * the callback was running then carry it out, otherwise send an idle
493  * notification for its parent (if the suspend succeeded and both
494  * ignore_children of parent->power and irq_safe of dev->power are not set).
495  * If ->runtime_suspend failed with -EAGAIN or -EBUSY, and if the RPM_AUTO
496  * flag is set and the next autosuspend-delay expiration time is in the
497  * future, schedule another autosuspend attempt.
498  *
499  * This function must be called under dev->power.lock with interrupts disabled.
500  */
rpm_suspend(struct device * dev,int rpmflags)501 static int rpm_suspend(struct device *dev, int rpmflags)
502 	__releases(&dev->power.lock) __acquires(&dev->power.lock)
503 {
504 	int (*callback)(struct device *);
505 	struct device *parent = NULL;
506 	int retval;
507 
508 	trace_rpm_suspend_rcuidle(dev, rpmflags);
509 
510  repeat:
511 	retval = rpm_check_suspend_allowed(dev);
512 
513 	if (retval < 0)
514 		;	/* Conditions are wrong. */
515 
516 	/* Synchronous suspends are not allowed in the RPM_RESUMING state. */
517 	else if (dev->power.runtime_status == RPM_RESUMING &&
518 	    !(rpmflags & RPM_ASYNC))
519 		retval = -EAGAIN;
520 	if (retval)
521 		goto out;
522 
523 	/* If the autosuspend_delay time hasn't expired yet, reschedule. */
524 	if ((rpmflags & RPM_AUTO)
525 	    && dev->power.runtime_status != RPM_SUSPENDING) {
526 		unsigned long expires = pm_runtime_autosuspend_expiration(dev);
527 
528 		if (expires != 0) {
529 			/* Pending requests need to be canceled. */
530 			dev->power.request = RPM_REQ_NONE;
531 
532 			/*
533 			 * Optimization: If the timer is already running and is
534 			 * set to expire at or before the autosuspend delay,
535 			 * avoid the overhead of resetting it.  Just let it
536 			 * expire; pm_suspend_timer_fn() will take care of the
537 			 * rest.
538 			 */
539 			if (!(dev->power.timer_expires && time_before_eq(
540 			    dev->power.timer_expires, expires))) {
541 				dev->power.timer_expires = expires;
542 				mod_timer(&dev->power.suspend_timer, expires);
543 			}
544 			dev->power.timer_autosuspends = 1;
545 			goto out;
546 		}
547 	}
548 
549 	/* Other scheduled or pending requests need to be canceled. */
550 	pm_runtime_cancel_pending(dev);
551 
552 	if (dev->power.runtime_status == RPM_SUSPENDING) {
553 		DEFINE_WAIT(wait);
554 
555 		if (rpmflags & (RPM_ASYNC | RPM_NOWAIT)) {
556 			retval = -EINPROGRESS;
557 			goto out;
558 		}
559 
560 		if (dev->power.irq_safe) {
561 			spin_unlock(&dev->power.lock);
562 
563 			cpu_relax();
564 
565 			spin_lock(&dev->power.lock);
566 			goto repeat;
567 		}
568 
569 		/* Wait for the other suspend running in parallel with us. */
570 		for (;;) {
571 			prepare_to_wait(&dev->power.wait_queue, &wait,
572 					TASK_UNINTERRUPTIBLE);
573 			if (dev->power.runtime_status != RPM_SUSPENDING)
574 				break;
575 
576 			spin_unlock_irq(&dev->power.lock);
577 
578 			schedule();
579 
580 			spin_lock_irq(&dev->power.lock);
581 		}
582 		finish_wait(&dev->power.wait_queue, &wait);
583 		goto repeat;
584 	}
585 
586 	if (dev->power.no_callbacks)
587 		goto no_callback;	/* Assume success. */
588 
589 	/* Carry out an asynchronous or a synchronous suspend. */
590 	if (rpmflags & RPM_ASYNC) {
591 		dev->power.request = (rpmflags & RPM_AUTO) ?
592 		    RPM_REQ_AUTOSUSPEND : RPM_REQ_SUSPEND;
593 		if (!dev->power.request_pending) {
594 			dev->power.request_pending = true;
595 			queue_work(pm_wq, &dev->power.work);
596 		}
597 		goto out;
598 	}
599 
600 	__update_runtime_status(dev, RPM_SUSPENDING);
601 
602 	callback = RPM_GET_CALLBACK(dev, runtime_suspend);
603 
604 	dev_pm_enable_wake_irq_check(dev, true);
605 	retval = rpm_callback(callback, dev);
606 	if (retval)
607 		goto fail;
608 
609 	dev_pm_enable_wake_irq_complete(dev);
610 
611  no_callback:
612 	__update_runtime_status(dev, RPM_SUSPENDED);
613 	pm_runtime_deactivate_timer(dev);
614 
615 	if (dev->parent) {
616 		parent = dev->parent;
617 		atomic_add_unless(&parent->power.child_count, -1, 0);
618 	}
619 	wake_up_all(&dev->power.wait_queue);
620 
621 	if (dev->power.deferred_resume) {
622 		dev->power.deferred_resume = false;
623 		rpm_resume(dev, 0);
624 		retval = -EAGAIN;
625 		goto out;
626 	}
627 
628 	/* Maybe the parent is now able to suspend. */
629 	if (parent && !parent->power.ignore_children && !dev->power.irq_safe) {
630 		spin_unlock(&dev->power.lock);
631 
632 		spin_lock(&parent->power.lock);
633 		rpm_idle(parent, RPM_ASYNC);
634 		spin_unlock(&parent->power.lock);
635 
636 		spin_lock(&dev->power.lock);
637 	}
638 
639  out:
640 	trace_rpm_return_int_rcuidle(dev, _THIS_IP_, retval);
641 
642 	return retval;
643 
644  fail:
645 	dev_pm_disable_wake_irq_check(dev, true);
646 	__update_runtime_status(dev, RPM_ACTIVE);
647 	dev->power.deferred_resume = false;
648 	wake_up_all(&dev->power.wait_queue);
649 
650 	if (retval == -EAGAIN || retval == -EBUSY) {
651 		dev->power.runtime_error = 0;
652 
653 		/*
654 		 * If the callback routine failed an autosuspend, and
655 		 * if the last_busy time has been updated so that there
656 		 * is a new autosuspend expiration time, automatically
657 		 * reschedule another autosuspend.
658 		 */
659 		if ((rpmflags & RPM_AUTO) &&
660 		    pm_runtime_autosuspend_expiration(dev) != 0)
661 			goto repeat;
662 	} else {
663 		pm_runtime_cancel_pending(dev);
664 	}
665 	goto out;
666 }
667 
668 /**
669  * rpm_resume - Carry out runtime resume of given device.
670  * @dev: Device to resume.
671  * @rpmflags: Flag bits.
672  *
673  * Check if the device's runtime PM status allows it to be resumed.  Cancel
674  * any scheduled or pending requests.  If another resume has been started
675  * earlier, either return immediately or wait for it to finish, depending on the
676  * RPM_NOWAIT and RPM_ASYNC flags.  Similarly, if there's a suspend running in
677  * parallel with this function, either tell the other process to resume after
678  * suspending (deferred_resume) or wait for it to finish.  If the RPM_ASYNC
679  * flag is set then queue a resume request; otherwise run the
680  * ->runtime_resume() callback directly.  Queue an idle notification for the
681  * device if the resume succeeded.
682  *
683  * This function must be called under dev->power.lock with interrupts disabled.
684  */
rpm_resume(struct device * dev,int rpmflags)685 static int rpm_resume(struct device *dev, int rpmflags)
686 	__releases(&dev->power.lock) __acquires(&dev->power.lock)
687 {
688 	int (*callback)(struct device *);
689 	struct device *parent = NULL;
690 	int retval = 0;
691 
692 	trace_rpm_resume_rcuidle(dev, rpmflags);
693 
694  repeat:
695 	if (dev->power.runtime_error)
696 		retval = -EINVAL;
697 	else if (dev->power.disable_depth == 1 && dev->power.is_suspended
698 	    && dev->power.runtime_status == RPM_ACTIVE)
699 		retval = 1;
700 	else if (dev->power.disable_depth > 0)
701 		retval = -EACCES;
702 	if (retval)
703 		goto out;
704 
705 	/*
706 	 * Other scheduled or pending requests need to be canceled.  Small
707 	 * optimization: If an autosuspend timer is running, leave it running
708 	 * rather than cancelling it now only to restart it again in the near
709 	 * future.
710 	 */
711 	dev->power.request = RPM_REQ_NONE;
712 	if (!dev->power.timer_autosuspends)
713 		pm_runtime_deactivate_timer(dev);
714 
715 	if (dev->power.runtime_status == RPM_ACTIVE) {
716 		retval = 1;
717 		goto out;
718 	}
719 
720 	if (dev->power.runtime_status == RPM_RESUMING
721 	    || dev->power.runtime_status == RPM_SUSPENDING) {
722 		DEFINE_WAIT(wait);
723 
724 		if (rpmflags & (RPM_ASYNC | RPM_NOWAIT)) {
725 			if (dev->power.runtime_status == RPM_SUSPENDING)
726 				dev->power.deferred_resume = true;
727 			else
728 				retval = -EINPROGRESS;
729 			goto out;
730 		}
731 
732 		if (dev->power.irq_safe) {
733 			spin_unlock(&dev->power.lock);
734 
735 			cpu_relax();
736 
737 			spin_lock(&dev->power.lock);
738 			goto repeat;
739 		}
740 
741 		/* Wait for the operation carried out in parallel with us. */
742 		for (;;) {
743 			prepare_to_wait(&dev->power.wait_queue, &wait,
744 					TASK_UNINTERRUPTIBLE);
745 			if (dev->power.runtime_status != RPM_RESUMING
746 			    && dev->power.runtime_status != RPM_SUSPENDING)
747 				break;
748 
749 			spin_unlock_irq(&dev->power.lock);
750 
751 			schedule();
752 
753 			spin_lock_irq(&dev->power.lock);
754 		}
755 		finish_wait(&dev->power.wait_queue, &wait);
756 		goto repeat;
757 	}
758 
759 	/*
760 	 * See if we can skip waking up the parent.  This is safe only if
761 	 * power.no_callbacks is set, because otherwise we don't know whether
762 	 * the resume will actually succeed.
763 	 */
764 	if (dev->power.no_callbacks && !parent && dev->parent) {
765 		spin_lock_nested(&dev->parent->power.lock, SINGLE_DEPTH_NESTING);
766 		if (dev->parent->power.disable_depth > 0
767 		    || dev->parent->power.ignore_children
768 		    || dev->parent->power.runtime_status == RPM_ACTIVE) {
769 			atomic_inc(&dev->parent->power.child_count);
770 			spin_unlock(&dev->parent->power.lock);
771 			retval = 1;
772 			goto no_callback;	/* Assume success. */
773 		}
774 		spin_unlock(&dev->parent->power.lock);
775 	}
776 
777 	/* Carry out an asynchronous or a synchronous resume. */
778 	if (rpmflags & RPM_ASYNC) {
779 		dev->power.request = RPM_REQ_RESUME;
780 		if (!dev->power.request_pending) {
781 			dev->power.request_pending = true;
782 			queue_work(pm_wq, &dev->power.work);
783 		}
784 		retval = 0;
785 		goto out;
786 	}
787 
788 	if (!parent && dev->parent) {
789 		/*
790 		 * Increment the parent's usage counter and resume it if
791 		 * necessary.  Not needed if dev is irq-safe; then the
792 		 * parent is permanently resumed.
793 		 */
794 		parent = dev->parent;
795 		if (dev->power.irq_safe)
796 			goto skip_parent;
797 		spin_unlock(&dev->power.lock);
798 
799 		pm_runtime_get_noresume(parent);
800 
801 		spin_lock(&parent->power.lock);
802 		/*
803 		 * Resume the parent if it has runtime PM enabled and not been
804 		 * set to ignore its children.
805 		 */
806 		if (!parent->power.disable_depth
807 		    && !parent->power.ignore_children) {
808 			rpm_resume(parent, 0);
809 			if (parent->power.runtime_status != RPM_ACTIVE)
810 				retval = -EBUSY;
811 		}
812 		spin_unlock(&parent->power.lock);
813 
814 		spin_lock(&dev->power.lock);
815 		if (retval)
816 			goto out;
817 		goto repeat;
818 	}
819  skip_parent:
820 
821 	if (dev->power.no_callbacks)
822 		goto no_callback;	/* Assume success. */
823 
824 	__update_runtime_status(dev, RPM_RESUMING);
825 
826 	callback = RPM_GET_CALLBACK(dev, runtime_resume);
827 
828 	dev_pm_disable_wake_irq_check(dev, false);
829 	retval = rpm_callback(callback, dev);
830 	if (retval) {
831 		__update_runtime_status(dev, RPM_SUSPENDED);
832 		pm_runtime_cancel_pending(dev);
833 		dev_pm_enable_wake_irq_check(dev, false);
834 	} else {
835  no_callback:
836 		__update_runtime_status(dev, RPM_ACTIVE);
837 		pm_runtime_mark_last_busy(dev);
838 		if (parent)
839 			atomic_inc(&parent->power.child_count);
840 	}
841 	wake_up_all(&dev->power.wait_queue);
842 
843 	if (retval >= 0)
844 		rpm_idle(dev, RPM_ASYNC);
845 
846  out:
847 	if (parent && !dev->power.irq_safe) {
848 		spin_unlock_irq(&dev->power.lock);
849 
850 		pm_runtime_put(parent);
851 
852 		spin_lock_irq(&dev->power.lock);
853 	}
854 
855 	trace_rpm_return_int_rcuidle(dev, _THIS_IP_, retval);
856 
857 	return retval;
858 }
859 
860 /**
861  * pm_runtime_work - Universal runtime PM work function.
862  * @work: Work structure used for scheduling the execution of this function.
863  *
864  * Use @work to get the device object the work is to be done for, determine what
865  * is to be done and execute the appropriate runtime PM function.
866  */
pm_runtime_work(struct work_struct * work)867 static void pm_runtime_work(struct work_struct *work)
868 {
869 	struct device *dev = container_of(work, struct device, power.work);
870 	enum rpm_request req;
871 
872 	spin_lock_irq(&dev->power.lock);
873 
874 	if (!dev->power.request_pending)
875 		goto out;
876 
877 	req = dev->power.request;
878 	dev->power.request = RPM_REQ_NONE;
879 	dev->power.request_pending = false;
880 
881 	switch (req) {
882 	case RPM_REQ_NONE:
883 		break;
884 	case RPM_REQ_IDLE:
885 		rpm_idle(dev, RPM_NOWAIT);
886 		break;
887 	case RPM_REQ_SUSPEND:
888 		rpm_suspend(dev, RPM_NOWAIT);
889 		break;
890 	case RPM_REQ_AUTOSUSPEND:
891 		rpm_suspend(dev, RPM_NOWAIT | RPM_AUTO);
892 		break;
893 	case RPM_REQ_RESUME:
894 		rpm_resume(dev, RPM_NOWAIT);
895 		break;
896 	}
897 
898  out:
899 	spin_unlock_irq(&dev->power.lock);
900 }
901 
902 /**
903  * pm_suspend_timer_fn - Timer function for pm_schedule_suspend().
904  * @data: Device pointer passed by pm_schedule_suspend().
905  *
906  * Check if the time is right and queue a suspend request.
907  */
pm_suspend_timer_fn(struct timer_list * t)908 static void pm_suspend_timer_fn(struct timer_list *t)
909 {
910 	struct device *dev = from_timer(dev, t, power.suspend_timer);
911 	unsigned long flags;
912 	unsigned long expires;
913 
914 	spin_lock_irqsave(&dev->power.lock, flags);
915 
916 	expires = dev->power.timer_expires;
917 	/* If 'expire' is after 'jiffies' we've been called too early. */
918 	if (expires > 0 && !time_after(expires, jiffies)) {
919 		dev->power.timer_expires = 0;
920 		rpm_suspend(dev, dev->power.timer_autosuspends ?
921 		    (RPM_ASYNC | RPM_AUTO) : RPM_ASYNC);
922 	}
923 
924 	spin_unlock_irqrestore(&dev->power.lock, flags);
925 }
926 
927 /**
928  * pm_schedule_suspend - Set up a timer to submit a suspend request in future.
929  * @dev: Device to suspend.
930  * @delay: Time to wait before submitting a suspend request, in milliseconds.
931  */
pm_schedule_suspend(struct device * dev,unsigned int delay)932 int pm_schedule_suspend(struct device *dev, unsigned int delay)
933 {
934 	unsigned long flags;
935 	int retval;
936 
937 	spin_lock_irqsave(&dev->power.lock, flags);
938 
939 	if (!delay) {
940 		retval = rpm_suspend(dev, RPM_ASYNC);
941 		goto out;
942 	}
943 
944 	retval = rpm_check_suspend_allowed(dev);
945 	if (retval)
946 		goto out;
947 
948 	/* Other scheduled or pending requests need to be canceled. */
949 	pm_runtime_cancel_pending(dev);
950 
951 	dev->power.timer_expires = jiffies + msecs_to_jiffies(delay);
952 	dev->power.timer_expires += !dev->power.timer_expires;
953 	dev->power.timer_autosuspends = 0;
954 	mod_timer(&dev->power.suspend_timer, dev->power.timer_expires);
955 
956  out:
957 	spin_unlock_irqrestore(&dev->power.lock, flags);
958 
959 	return retval;
960 }
961 EXPORT_SYMBOL_GPL(pm_schedule_suspend);
962 
963 /**
964  * __pm_runtime_idle - Entry point for runtime idle operations.
965  * @dev: Device to send idle notification for.
966  * @rpmflags: Flag bits.
967  *
968  * If the RPM_GET_PUT flag is set, decrement the device's usage count and
969  * return immediately if it is larger than zero.  Then carry out an idle
970  * notification, either synchronous or asynchronous.
971  *
972  * This routine may be called in atomic context if the RPM_ASYNC flag is set,
973  * or if pm_runtime_irq_safe() has been called.
974  */
__pm_runtime_idle(struct device * dev,int rpmflags)975 int __pm_runtime_idle(struct device *dev, int rpmflags)
976 {
977 	unsigned long flags;
978 	int retval;
979 
980 	if (rpmflags & RPM_GET_PUT) {
981 		if (!atomic_dec_and_test(&dev->power.usage_count))
982 			return 0;
983 	}
984 
985 	might_sleep_if(!(rpmflags & RPM_ASYNC) && !dev->power.irq_safe);
986 
987 	spin_lock_irqsave(&dev->power.lock, flags);
988 	retval = rpm_idle(dev, rpmflags);
989 	spin_unlock_irqrestore(&dev->power.lock, flags);
990 
991 	return retval;
992 }
993 EXPORT_SYMBOL_GPL(__pm_runtime_idle);
994 
995 /**
996  * __pm_runtime_suspend - Entry point for runtime put/suspend operations.
997  * @dev: Device to suspend.
998  * @rpmflags: Flag bits.
999  *
1000  * If the RPM_GET_PUT flag is set, decrement the device's usage count and
1001  * return immediately if it is larger than zero.  Then carry out a suspend,
1002  * either synchronous or asynchronous.
1003  *
1004  * This routine may be called in atomic context if the RPM_ASYNC flag is set,
1005  * or if pm_runtime_irq_safe() has been called.
1006  */
__pm_runtime_suspend(struct device * dev,int rpmflags)1007 int __pm_runtime_suspend(struct device *dev, int rpmflags)
1008 {
1009 	unsigned long flags;
1010 	int retval;
1011 
1012 	if (rpmflags & RPM_GET_PUT) {
1013 		if (!atomic_dec_and_test(&dev->power.usage_count))
1014 			return 0;
1015 	}
1016 
1017 	might_sleep_if(!(rpmflags & RPM_ASYNC) && !dev->power.irq_safe);
1018 
1019 	spin_lock_irqsave(&dev->power.lock, flags);
1020 	retval = rpm_suspend(dev, rpmflags);
1021 	spin_unlock_irqrestore(&dev->power.lock, flags);
1022 
1023 	return retval;
1024 }
1025 EXPORT_SYMBOL_GPL(__pm_runtime_suspend);
1026 
1027 /**
1028  * __pm_runtime_resume - Entry point for runtime resume operations.
1029  * @dev: Device to resume.
1030  * @rpmflags: Flag bits.
1031  *
1032  * If the RPM_GET_PUT flag is set, increment the device's usage count.  Then
1033  * carry out a resume, either synchronous or asynchronous.
1034  *
1035  * This routine may be called in atomic context if the RPM_ASYNC flag is set,
1036  * or if pm_runtime_irq_safe() has been called.
1037  */
__pm_runtime_resume(struct device * dev,int rpmflags)1038 int __pm_runtime_resume(struct device *dev, int rpmflags)
1039 {
1040 	unsigned long flags;
1041 	int retval;
1042 
1043 	might_sleep_if(!(rpmflags & RPM_ASYNC) && !dev->power.irq_safe &&
1044 			dev->power.runtime_status != RPM_ACTIVE);
1045 
1046 	if (rpmflags & RPM_GET_PUT)
1047 		atomic_inc(&dev->power.usage_count);
1048 
1049 	spin_lock_irqsave(&dev->power.lock, flags);
1050 	retval = rpm_resume(dev, rpmflags);
1051 	spin_unlock_irqrestore(&dev->power.lock, flags);
1052 
1053 	return retval;
1054 }
1055 EXPORT_SYMBOL_GPL(__pm_runtime_resume);
1056 
1057 /**
1058  * pm_runtime_get_if_in_use - Conditionally bump up the device's usage counter.
1059  * @dev: Device to handle.
1060  *
1061  * Return -EINVAL if runtime PM is disabled for the device.
1062  *
1063  * If that's not the case and if the device's runtime PM status is RPM_ACTIVE
1064  * and the runtime PM usage counter is nonzero, increment the counter and
1065  * return 1.  Otherwise return 0 without changing the counter.
1066  */
pm_runtime_get_if_in_use(struct device * dev)1067 int pm_runtime_get_if_in_use(struct device *dev)
1068 {
1069 	unsigned long flags;
1070 	int retval;
1071 
1072 	spin_lock_irqsave(&dev->power.lock, flags);
1073 	retval = dev->power.disable_depth > 0 ? -EINVAL :
1074 		dev->power.runtime_status == RPM_ACTIVE
1075 			&& atomic_inc_not_zero(&dev->power.usage_count);
1076 	spin_unlock_irqrestore(&dev->power.lock, flags);
1077 	return retval;
1078 }
1079 EXPORT_SYMBOL_GPL(pm_runtime_get_if_in_use);
1080 
1081 /**
1082  * __pm_runtime_set_status - Set runtime PM status of a device.
1083  * @dev: Device to handle.
1084  * @status: New runtime PM status of the device.
1085  *
1086  * If runtime PM of the device is disabled or its power.runtime_error field is
1087  * different from zero, the status may be changed either to RPM_ACTIVE, or to
1088  * RPM_SUSPENDED, as long as that reflects the actual state of the device.
1089  * However, if the device has a parent and the parent is not active, and the
1090  * parent's power.ignore_children flag is unset, the device's status cannot be
1091  * set to RPM_ACTIVE, so -EBUSY is returned in that case.
1092  *
1093  * If successful, __pm_runtime_set_status() clears the power.runtime_error field
1094  * and the device parent's counter of unsuspended children is modified to
1095  * reflect the new status.  If the new status is RPM_SUSPENDED, an idle
1096  * notification request for the parent is submitted.
1097  */
__pm_runtime_set_status(struct device * dev,unsigned int status)1098 int __pm_runtime_set_status(struct device *dev, unsigned int status)
1099 {
1100 	struct device *parent = dev->parent;
1101 	unsigned long flags;
1102 	bool notify_parent = false;
1103 	int error = 0;
1104 
1105 	if (status != RPM_ACTIVE && status != RPM_SUSPENDED)
1106 		return -EINVAL;
1107 
1108 	spin_lock_irqsave(&dev->power.lock, flags);
1109 
1110 	if (!dev->power.runtime_error && !dev->power.disable_depth) {
1111 		error = -EAGAIN;
1112 		goto out;
1113 	}
1114 
1115 	if (dev->power.runtime_status == status || !parent)
1116 		goto out_set;
1117 
1118 	if (status == RPM_SUSPENDED) {
1119 		atomic_add_unless(&parent->power.child_count, -1, 0);
1120 		notify_parent = !parent->power.ignore_children;
1121 	} else {
1122 		spin_lock_nested(&parent->power.lock, SINGLE_DEPTH_NESTING);
1123 
1124 		/*
1125 		 * It is invalid to put an active child under a parent that is
1126 		 * not active, has runtime PM enabled and the
1127 		 * 'power.ignore_children' flag unset.
1128 		 */
1129 		if (!parent->power.disable_depth
1130 		    && !parent->power.ignore_children
1131 		    && parent->power.runtime_status != RPM_ACTIVE) {
1132 			dev_err(dev, "runtime PM trying to activate child device %s but parent (%s) is not active\n",
1133 				dev_name(dev),
1134 				dev_name(parent));
1135 			error = -EBUSY;
1136 		} else if (dev->power.runtime_status == RPM_SUSPENDED) {
1137 			atomic_inc(&parent->power.child_count);
1138 		}
1139 
1140 		spin_unlock(&parent->power.lock);
1141 
1142 		if (error)
1143 			goto out;
1144 	}
1145 
1146  out_set:
1147 	__update_runtime_status(dev, status);
1148 	dev->power.runtime_error = 0;
1149  out:
1150 	spin_unlock_irqrestore(&dev->power.lock, flags);
1151 
1152 	if (notify_parent)
1153 		pm_request_idle(parent);
1154 
1155 	return error;
1156 }
1157 EXPORT_SYMBOL_GPL(__pm_runtime_set_status);
1158 
1159 /**
1160  * __pm_runtime_barrier - Cancel pending requests and wait for completions.
1161  * @dev: Device to handle.
1162  *
1163  * Flush all pending requests for the device from pm_wq and wait for all
1164  * runtime PM operations involving the device in progress to complete.
1165  *
1166  * Should be called under dev->power.lock with interrupts disabled.
1167  */
__pm_runtime_barrier(struct device * dev)1168 static void __pm_runtime_barrier(struct device *dev)
1169 {
1170 	pm_runtime_deactivate_timer(dev);
1171 
1172 	if (dev->power.request_pending) {
1173 		dev->power.request = RPM_REQ_NONE;
1174 		spin_unlock_irq(&dev->power.lock);
1175 
1176 		cancel_work_sync(&dev->power.work);
1177 
1178 		spin_lock_irq(&dev->power.lock);
1179 		dev->power.request_pending = false;
1180 	}
1181 
1182 	if (dev->power.runtime_status == RPM_SUSPENDING
1183 	    || dev->power.runtime_status == RPM_RESUMING
1184 	    || dev->power.idle_notification) {
1185 		DEFINE_WAIT(wait);
1186 
1187 		/* Suspend, wake-up or idle notification in progress. */
1188 		for (;;) {
1189 			prepare_to_wait(&dev->power.wait_queue, &wait,
1190 					TASK_UNINTERRUPTIBLE);
1191 			if (dev->power.runtime_status != RPM_SUSPENDING
1192 			    && dev->power.runtime_status != RPM_RESUMING
1193 			    && !dev->power.idle_notification)
1194 				break;
1195 			spin_unlock_irq(&dev->power.lock);
1196 
1197 			schedule();
1198 
1199 			spin_lock_irq(&dev->power.lock);
1200 		}
1201 		finish_wait(&dev->power.wait_queue, &wait);
1202 	}
1203 }
1204 
1205 /**
1206  * pm_runtime_barrier - Flush pending requests and wait for completions.
1207  * @dev: Device to handle.
1208  *
1209  * Prevent the device from being suspended by incrementing its usage counter and
1210  * if there's a pending resume request for the device, wake the device up.
1211  * Next, make sure that all pending requests for the device have been flushed
1212  * from pm_wq and wait for all runtime PM operations involving the device in
1213  * progress to complete.
1214  *
1215  * Return value:
1216  * 1, if there was a resume request pending and the device had to be woken up,
1217  * 0, otherwise
1218  */
pm_runtime_barrier(struct device * dev)1219 int pm_runtime_barrier(struct device *dev)
1220 {
1221 	int retval = 0;
1222 
1223 	pm_runtime_get_noresume(dev);
1224 	spin_lock_irq(&dev->power.lock);
1225 
1226 	if (dev->power.request_pending
1227 	    && dev->power.request == RPM_REQ_RESUME) {
1228 		rpm_resume(dev, 0);
1229 		retval = 1;
1230 	}
1231 
1232 	__pm_runtime_barrier(dev);
1233 
1234 	spin_unlock_irq(&dev->power.lock);
1235 	pm_runtime_put_noidle(dev);
1236 
1237 	return retval;
1238 }
1239 EXPORT_SYMBOL_GPL(pm_runtime_barrier);
1240 
1241 /**
1242  * __pm_runtime_disable - Disable runtime PM of a device.
1243  * @dev: Device to handle.
1244  * @check_resume: If set, check if there's a resume request for the device.
1245  *
1246  * Increment power.disable_depth for the device and if it was zero previously,
1247  * cancel all pending runtime PM requests for the device and wait for all
1248  * operations in progress to complete.  The device can be either active or
1249  * suspended after its runtime PM has been disabled.
1250  *
1251  * If @check_resume is set and there's a resume request pending when
1252  * __pm_runtime_disable() is called and power.disable_depth is zero, the
1253  * function will wake up the device before disabling its runtime PM.
1254  */
__pm_runtime_disable(struct device * dev,bool check_resume)1255 void __pm_runtime_disable(struct device *dev, bool check_resume)
1256 {
1257 	spin_lock_irq(&dev->power.lock);
1258 
1259 	if (dev->power.disable_depth > 0) {
1260 		dev->power.disable_depth++;
1261 		goto out;
1262 	}
1263 
1264 	/*
1265 	 * Wake up the device if there's a resume request pending, because that
1266 	 * means there probably is some I/O to process and disabling runtime PM
1267 	 * shouldn't prevent the device from processing the I/O.
1268 	 */
1269 	if (check_resume && dev->power.request_pending
1270 	    && dev->power.request == RPM_REQ_RESUME) {
1271 		/*
1272 		 * Prevent suspends and idle notifications from being carried
1273 		 * out after we have woken up the device.
1274 		 */
1275 		pm_runtime_get_noresume(dev);
1276 
1277 		rpm_resume(dev, 0);
1278 
1279 		pm_runtime_put_noidle(dev);
1280 	}
1281 
1282 	if (!dev->power.disable_depth++)
1283 		__pm_runtime_barrier(dev);
1284 
1285  out:
1286 	spin_unlock_irq(&dev->power.lock);
1287 }
1288 EXPORT_SYMBOL_GPL(__pm_runtime_disable);
1289 
1290 /**
1291  * pm_runtime_enable - Enable runtime PM of a device.
1292  * @dev: Device to handle.
1293  */
pm_runtime_enable(struct device * dev)1294 void pm_runtime_enable(struct device *dev)
1295 {
1296 	unsigned long flags;
1297 
1298 	spin_lock_irqsave(&dev->power.lock, flags);
1299 
1300 	if (dev->power.disable_depth > 0)
1301 		dev->power.disable_depth--;
1302 	else
1303 		dev_warn(dev, "Unbalanced %s!\n", __func__);
1304 
1305 	WARN(!dev->power.disable_depth &&
1306 	     dev->power.runtime_status == RPM_SUSPENDED &&
1307 	     !dev->power.ignore_children &&
1308 	     atomic_read(&dev->power.child_count) > 0,
1309 	     "Enabling runtime PM for inactive device (%s) with active children\n",
1310 	     dev_name(dev));
1311 
1312 	spin_unlock_irqrestore(&dev->power.lock, flags);
1313 }
1314 EXPORT_SYMBOL_GPL(pm_runtime_enable);
1315 
1316 /**
1317  * pm_runtime_forbid - Block runtime PM of a device.
1318  * @dev: Device to handle.
1319  *
1320  * Increase the device's usage count and clear its power.runtime_auto flag,
1321  * so that it cannot be suspended at run time until pm_runtime_allow() is called
1322  * for it.
1323  */
pm_runtime_forbid(struct device * dev)1324 void pm_runtime_forbid(struct device *dev)
1325 {
1326 	spin_lock_irq(&dev->power.lock);
1327 	if (!dev->power.runtime_auto)
1328 		goto out;
1329 
1330 	dev->power.runtime_auto = false;
1331 	atomic_inc(&dev->power.usage_count);
1332 	rpm_resume(dev, 0);
1333 
1334  out:
1335 	spin_unlock_irq(&dev->power.lock);
1336 }
1337 EXPORT_SYMBOL_GPL(pm_runtime_forbid);
1338 
1339 /**
1340  * pm_runtime_allow - Unblock runtime PM of a device.
1341  * @dev: Device to handle.
1342  *
1343  * Decrease the device's usage count and set its power.runtime_auto flag.
1344  */
pm_runtime_allow(struct device * dev)1345 void pm_runtime_allow(struct device *dev)
1346 {
1347 	spin_lock_irq(&dev->power.lock);
1348 	if (dev->power.runtime_auto)
1349 		goto out;
1350 
1351 	dev->power.runtime_auto = true;
1352 	if (atomic_dec_and_test(&dev->power.usage_count))
1353 		rpm_idle(dev, RPM_AUTO | RPM_ASYNC);
1354 
1355  out:
1356 	spin_unlock_irq(&dev->power.lock);
1357 }
1358 EXPORT_SYMBOL_GPL(pm_runtime_allow);
1359 
1360 /**
1361  * pm_runtime_no_callbacks - Ignore runtime PM callbacks for a device.
1362  * @dev: Device to handle.
1363  *
1364  * Set the power.no_callbacks flag, which tells the PM core that this
1365  * device is power-managed through its parent and has no runtime PM
1366  * callbacks of its own.  The runtime sysfs attributes will be removed.
1367  */
pm_runtime_no_callbacks(struct device * dev)1368 void pm_runtime_no_callbacks(struct device *dev)
1369 {
1370 	spin_lock_irq(&dev->power.lock);
1371 	dev->power.no_callbacks = 1;
1372 	spin_unlock_irq(&dev->power.lock);
1373 	if (device_is_registered(dev))
1374 		rpm_sysfs_remove(dev);
1375 }
1376 EXPORT_SYMBOL_GPL(pm_runtime_no_callbacks);
1377 
1378 /**
1379  * pm_runtime_irq_safe - Leave interrupts disabled during callbacks.
1380  * @dev: Device to handle
1381  *
1382  * Set the power.irq_safe flag, which tells the PM core that the
1383  * ->runtime_suspend() and ->runtime_resume() callbacks for this device should
1384  * always be invoked with the spinlock held and interrupts disabled.  It also
1385  * causes the parent's usage counter to be permanently incremented, preventing
1386  * the parent from runtime suspending -- otherwise an irq-safe child might have
1387  * to wait for a non-irq-safe parent.
1388  */
pm_runtime_irq_safe(struct device * dev)1389 void pm_runtime_irq_safe(struct device *dev)
1390 {
1391 	if (dev->parent)
1392 		pm_runtime_get_sync(dev->parent);
1393 	spin_lock_irq(&dev->power.lock);
1394 	dev->power.irq_safe = 1;
1395 	spin_unlock_irq(&dev->power.lock);
1396 }
1397 EXPORT_SYMBOL_GPL(pm_runtime_irq_safe);
1398 
1399 /**
1400  * update_autosuspend - Handle a change to a device's autosuspend settings.
1401  * @dev: Device to handle.
1402  * @old_delay: The former autosuspend_delay value.
1403  * @old_use: The former use_autosuspend value.
1404  *
1405  * Prevent runtime suspend if the new delay is negative and use_autosuspend is
1406  * set; otherwise allow it.  Send an idle notification if suspends are allowed.
1407  *
1408  * This function must be called under dev->power.lock with interrupts disabled.
1409  */
update_autosuspend(struct device * dev,int old_delay,int old_use)1410 static void update_autosuspend(struct device *dev, int old_delay, int old_use)
1411 {
1412 	int delay = dev->power.autosuspend_delay;
1413 
1414 	/* Should runtime suspend be prevented now? */
1415 	if (dev->power.use_autosuspend && delay < 0) {
1416 
1417 		/* If it used to be allowed then prevent it. */
1418 		if (!old_use || old_delay >= 0) {
1419 			atomic_inc(&dev->power.usage_count);
1420 			rpm_resume(dev, 0);
1421 		}
1422 	}
1423 
1424 	/* Runtime suspend should be allowed now. */
1425 	else {
1426 
1427 		/* If it used to be prevented then allow it. */
1428 		if (old_use && old_delay < 0)
1429 			atomic_dec(&dev->power.usage_count);
1430 
1431 		/* Maybe we can autosuspend now. */
1432 		rpm_idle(dev, RPM_AUTO);
1433 	}
1434 }
1435 
1436 /**
1437  * pm_runtime_set_autosuspend_delay - Set a device's autosuspend_delay value.
1438  * @dev: Device to handle.
1439  * @delay: Value of the new delay in milliseconds.
1440  *
1441  * Set the device's power.autosuspend_delay value.  If it changes to negative
1442  * and the power.use_autosuspend flag is set, prevent runtime suspends.  If it
1443  * changes the other way, allow runtime suspends.
1444  */
pm_runtime_set_autosuspend_delay(struct device * dev,int delay)1445 void pm_runtime_set_autosuspend_delay(struct device *dev, int delay)
1446 {
1447 	int old_delay, old_use;
1448 
1449 	spin_lock_irq(&dev->power.lock);
1450 	old_delay = dev->power.autosuspend_delay;
1451 	old_use = dev->power.use_autosuspend;
1452 	dev->power.autosuspend_delay = delay;
1453 	update_autosuspend(dev, old_delay, old_use);
1454 	spin_unlock_irq(&dev->power.lock);
1455 }
1456 EXPORT_SYMBOL_GPL(pm_runtime_set_autosuspend_delay);
1457 
1458 /**
1459  * __pm_runtime_use_autosuspend - Set a device's use_autosuspend flag.
1460  * @dev: Device to handle.
1461  * @use: New value for use_autosuspend.
1462  *
1463  * Set the device's power.use_autosuspend flag, and allow or prevent runtime
1464  * suspends as needed.
1465  */
__pm_runtime_use_autosuspend(struct device * dev,bool use)1466 void __pm_runtime_use_autosuspend(struct device *dev, bool use)
1467 {
1468 	int old_delay, old_use;
1469 
1470 	spin_lock_irq(&dev->power.lock);
1471 	old_delay = dev->power.autosuspend_delay;
1472 	old_use = dev->power.use_autosuspend;
1473 	dev->power.use_autosuspend = use;
1474 	update_autosuspend(dev, old_delay, old_use);
1475 	spin_unlock_irq(&dev->power.lock);
1476 }
1477 EXPORT_SYMBOL_GPL(__pm_runtime_use_autosuspend);
1478 
1479 /**
1480  * pm_runtime_init - Initialize runtime PM fields in given device object.
1481  * @dev: Device object to initialize.
1482  */
pm_runtime_init(struct device * dev)1483 void pm_runtime_init(struct device *dev)
1484 {
1485 	dev->power.runtime_status = RPM_SUSPENDED;
1486 	dev->power.idle_notification = false;
1487 
1488 	dev->power.disable_depth = 1;
1489 	atomic_set(&dev->power.usage_count, 0);
1490 
1491 	dev->power.runtime_error = 0;
1492 
1493 	atomic_set(&dev->power.child_count, 0);
1494 	pm_suspend_ignore_children(dev, false);
1495 	dev->power.runtime_auto = true;
1496 
1497 	dev->power.request_pending = false;
1498 	dev->power.request = RPM_REQ_NONE;
1499 	dev->power.deferred_resume = false;
1500 	dev->power.accounting_timestamp = jiffies;
1501 	INIT_WORK(&dev->power.work, pm_runtime_work);
1502 
1503 	dev->power.timer_expires = 0;
1504 	timer_setup(&dev->power.suspend_timer, pm_suspend_timer_fn, 0);
1505 
1506 	init_waitqueue_head(&dev->power.wait_queue);
1507 }
1508 
1509 /**
1510  * pm_runtime_reinit - Re-initialize runtime PM fields in given device object.
1511  * @dev: Device object to re-initialize.
1512  */
pm_runtime_reinit(struct device * dev)1513 void pm_runtime_reinit(struct device *dev)
1514 {
1515 	if (!pm_runtime_enabled(dev)) {
1516 		if (dev->power.runtime_status == RPM_ACTIVE)
1517 			pm_runtime_set_suspended(dev);
1518 		if (dev->power.irq_safe) {
1519 			spin_lock_irq(&dev->power.lock);
1520 			dev->power.irq_safe = 0;
1521 			spin_unlock_irq(&dev->power.lock);
1522 			if (dev->parent)
1523 				pm_runtime_put(dev->parent);
1524 		}
1525 	}
1526 }
1527 
1528 /**
1529  * pm_runtime_remove - Prepare for removing a device from device hierarchy.
1530  * @dev: Device object being removed from device hierarchy.
1531  */
pm_runtime_remove(struct device * dev)1532 void pm_runtime_remove(struct device *dev)
1533 {
1534 	__pm_runtime_disable(dev, false);
1535 	pm_runtime_reinit(dev);
1536 }
1537 
1538 /**
1539  * pm_runtime_clean_up_links - Prepare links to consumers for driver removal.
1540  * @dev: Device whose driver is going to be removed.
1541  *
1542  * Check links from this device to any consumers and if any of them have active
1543  * runtime PM references to the device, drop the usage counter of the device
1544  * (as many times as needed).
1545  *
1546  * Links with the DL_FLAG_MANAGED flag unset are ignored.
1547  *
1548  * Since the device is guaranteed to be runtime-active at the point this is
1549  * called, nothing else needs to be done here.
1550  *
1551  * Moreover, this is called after device_links_busy() has returned 'false', so
1552  * the status of each link is guaranteed to be DL_STATE_SUPPLIER_UNBIND and
1553  * therefore rpm_active can't be manipulated concurrently.
1554  */
pm_runtime_clean_up_links(struct device * dev)1555 void pm_runtime_clean_up_links(struct device *dev)
1556 {
1557 	struct device_link *link;
1558 	int idx;
1559 
1560 	idx = device_links_read_lock();
1561 
1562 	list_for_each_entry_rcu(link, &dev->links.consumers, s_node) {
1563 		if (!(link->flags & DL_FLAG_MANAGED))
1564 			continue;
1565 
1566 		while (refcount_dec_not_one(&link->rpm_active))
1567 			pm_runtime_put_noidle(dev);
1568 	}
1569 
1570 	device_links_read_unlock(idx);
1571 }
1572 
1573 /**
1574  * pm_runtime_get_suppliers - Resume and reference-count supplier devices.
1575  * @dev: Consumer device.
1576  */
pm_runtime_get_suppliers(struct device * dev)1577 void pm_runtime_get_suppliers(struct device *dev)
1578 {
1579 	struct device_link *link;
1580 	int idx;
1581 
1582 	idx = device_links_read_lock();
1583 
1584 	list_for_each_entry_rcu(link, &dev->links.suppliers, c_node)
1585 		if (link->flags & DL_FLAG_PM_RUNTIME) {
1586 			link->supplier_preactivated = true;
1587 			pm_runtime_get_sync(link->supplier);
1588 			refcount_inc(&link->rpm_active);
1589 		}
1590 
1591 	device_links_read_unlock(idx);
1592 }
1593 
1594 /**
1595  * pm_runtime_put_suppliers - Drop references to supplier devices.
1596  * @dev: Consumer device.
1597  */
pm_runtime_put_suppliers(struct device * dev)1598 void pm_runtime_put_suppliers(struct device *dev)
1599 {
1600 	struct device_link *link;
1601 	unsigned long flags;
1602 	bool put;
1603 	int idx;
1604 
1605 	idx = device_links_read_lock();
1606 
1607 	list_for_each_entry_rcu(link, &dev->links.suppliers, c_node)
1608 		if (link->supplier_preactivated) {
1609 			link->supplier_preactivated = false;
1610 			spin_lock_irqsave(&dev->power.lock, flags);
1611 			put = pm_runtime_status_suspended(dev) &&
1612 			      refcount_dec_not_one(&link->rpm_active);
1613 			spin_unlock_irqrestore(&dev->power.lock, flags);
1614 			if (put)
1615 				pm_runtime_put(link->supplier);
1616 		}
1617 
1618 	device_links_read_unlock(idx);
1619 }
1620 
pm_runtime_new_link(struct device * dev)1621 void pm_runtime_new_link(struct device *dev)
1622 {
1623 	spin_lock_irq(&dev->power.lock);
1624 	dev->power.links_count++;
1625 	spin_unlock_irq(&dev->power.lock);
1626 }
1627 
pm_runtime_drop_link(struct device * dev)1628 void pm_runtime_drop_link(struct device *dev)
1629 {
1630 	spin_lock_irq(&dev->power.lock);
1631 	WARN_ON(dev->power.links_count == 0);
1632 	dev->power.links_count--;
1633 	spin_unlock_irq(&dev->power.lock);
1634 }
1635 
pm_runtime_need_not_resume(struct device * dev)1636 static bool pm_runtime_need_not_resume(struct device *dev)
1637 {
1638 	return atomic_read(&dev->power.usage_count) <= 1 &&
1639 		(atomic_read(&dev->power.child_count) == 0 ||
1640 		 dev->power.ignore_children);
1641 }
1642 
1643 /**
1644  * pm_runtime_force_suspend - Force a device into suspend state if needed.
1645  * @dev: Device to suspend.
1646  *
1647  * Disable runtime PM so we safely can check the device's runtime PM status and
1648  * if it is active, invoke its ->runtime_suspend callback to suspend it and
1649  * change its runtime PM status field to RPM_SUSPENDED.  Also, if the device's
1650  * usage and children counters don't indicate that the device was in use before
1651  * the system-wide transition under way, decrement its parent's children counter
1652  * (if there is a parent).  Keep runtime PM disabled to preserve the state
1653  * unless we encounter errors.
1654  *
1655  * Typically this function may be invoked from a system suspend callback to make
1656  * sure the device is put into low power state and it should only be used during
1657  * system-wide PM transitions to sleep states.  It assumes that the analogous
1658  * pm_runtime_force_resume() will be used to resume the device.
1659  */
pm_runtime_force_suspend(struct device * dev)1660 int pm_runtime_force_suspend(struct device *dev)
1661 {
1662 	int (*callback)(struct device *);
1663 	int ret;
1664 
1665 	pm_runtime_disable(dev);
1666 	if (pm_runtime_status_suspended(dev))
1667 		return 0;
1668 
1669 	callback = RPM_GET_CALLBACK(dev, runtime_suspend);
1670 
1671 	ret = callback ? callback(dev) : 0;
1672 	if (ret)
1673 		goto err;
1674 
1675 	/*
1676 	 * If the device can stay in suspend after the system-wide transition
1677 	 * to the working state that will follow, drop the children counter of
1678 	 * its parent, but set its status to RPM_SUSPENDED anyway in case this
1679 	 * function will be called again for it in the meantime.
1680 	 */
1681 	if (pm_runtime_need_not_resume(dev))
1682 		pm_runtime_set_suspended(dev);
1683 	else
1684 		__update_runtime_status(dev, RPM_SUSPENDED);
1685 
1686 	return 0;
1687 
1688 err:
1689 	pm_runtime_enable(dev);
1690 	return ret;
1691 }
1692 EXPORT_SYMBOL_GPL(pm_runtime_force_suspend);
1693 
1694 /**
1695  * pm_runtime_force_resume - Force a device into resume state if needed.
1696  * @dev: Device to resume.
1697  *
1698  * Prior invoking this function we expect the user to have brought the device
1699  * into low power state by a call to pm_runtime_force_suspend(). Here we reverse
1700  * those actions and bring the device into full power, if it is expected to be
1701  * used on system resume.  In the other case, we defer the resume to be managed
1702  * via runtime PM.
1703  *
1704  * Typically this function may be invoked from a system resume callback.
1705  */
pm_runtime_force_resume(struct device * dev)1706 int pm_runtime_force_resume(struct device *dev)
1707 {
1708 	int (*callback)(struct device *);
1709 	int ret = 0;
1710 
1711 	if (!pm_runtime_status_suspended(dev) || pm_runtime_need_not_resume(dev))
1712 		goto out;
1713 
1714 	/*
1715 	 * The value of the parent's children counter is correct already, so
1716 	 * just update the status of the device.
1717 	 */
1718 	__update_runtime_status(dev, RPM_ACTIVE);
1719 
1720 	callback = RPM_GET_CALLBACK(dev, runtime_resume);
1721 
1722 	ret = callback ? callback(dev) : 0;
1723 	if (ret) {
1724 		pm_runtime_set_suspended(dev);
1725 		goto out;
1726 	}
1727 
1728 	pm_runtime_mark_last_busy(dev);
1729 out:
1730 	pm_runtime_enable(dev);
1731 	return ret;
1732 }
1733 EXPORT_SYMBOL_GPL(pm_runtime_force_resume);
1734