2 * drivers/base/power/domain.c - Common code related to device power domains.
4 * Copyright (C) 2011 Rafael J. Wysocki <rjw@sisk.pl>, Renesas Electronics Corp.
6 * This file is released under the GPLv2.
9 #include <linux/init.h>
10 #include <linux/kernel.h>
12 #include <linux/pm_runtime.h>
13 #include <linux/pm_domain.h>
14 #include <linux/pm_qos.h>
15 #include <linux/slab.h>
16 #include <linux/err.h>
17 #include <linux/sched.h>
18 #include <linux/suspend.h>
19 #include <linux/export.h>
21 #define GENPD_DEV_CALLBACK(genpd, type, callback, dev) \
23 type (*__routine)(struct device *__d); \
24 type __ret = (type)0; \
26 __routine = genpd->dev_ops.callback; \
28 __ret = __routine(dev); \
30 __routine = dev_gpd_data(dev)->ops.callback; \
32 __ret = __routine(dev); \
37 #define GENPD_DEV_TIMED_CALLBACK(genpd, type, callback, dev, field, name) \
39 ktime_t __start = ktime_get(); \
40 type __retval = GENPD_DEV_CALLBACK(genpd, type, callback, dev); \
41 s64 __elapsed = ktime_to_ns(ktime_sub(ktime_get(), __start)); \
42 struct gpd_timing_data *__td = &dev_gpd_data(dev)->td; \
43 if (!__retval && __elapsed > __td->field) { \
44 __td->field = __elapsed; \
45 dev_warn(dev, name " latency exceeded, new value %lld ns\n", \
47 genpd->max_off_time_changed = true; \
48 __td->constraint_changed = true; \
53 static LIST_HEAD(gpd_list
);
54 static DEFINE_MUTEX(gpd_list_lock
);
58 struct generic_pm_domain
*dev_to_genpd(struct device
*dev
)
60 if (IS_ERR_OR_NULL(dev
->pm_domain
))
61 return ERR_PTR(-EINVAL
);
63 return pd_to_genpd(dev
->pm_domain
);
66 static int genpd_stop_dev(struct generic_pm_domain
*genpd
, struct device
*dev
)
68 return GENPD_DEV_TIMED_CALLBACK(genpd
, int, stop
, dev
,
69 stop_latency_ns
, "stop");
72 static int genpd_start_dev(struct generic_pm_domain
*genpd
, struct device
*dev
)
74 return GENPD_DEV_TIMED_CALLBACK(genpd
, int, start
, dev
,
75 start_latency_ns
, "start");
78 static bool genpd_sd_counter_dec(struct generic_pm_domain
*genpd
)
82 if (!WARN_ON(atomic_read(&genpd
->sd_count
) == 0))
83 ret
= !!atomic_dec_and_test(&genpd
->sd_count
);
88 static void genpd_sd_counter_inc(struct generic_pm_domain
*genpd
)
90 atomic_inc(&genpd
->sd_count
);
91 smp_mb__after_atomic_inc();
94 static void genpd_acquire_lock(struct generic_pm_domain
*genpd
)
98 mutex_lock(&genpd
->lock
);
100 * Wait for the domain to transition into either the active,
101 * or the power off state.
104 prepare_to_wait(&genpd
->status_wait_queue
, &wait
,
105 TASK_UNINTERRUPTIBLE
);
106 if (genpd
->status
== GPD_STATE_ACTIVE
107 || genpd
->status
== GPD_STATE_POWER_OFF
)
109 mutex_unlock(&genpd
->lock
);
113 mutex_lock(&genpd
->lock
);
115 finish_wait(&genpd
->status_wait_queue
, &wait
);
118 static void genpd_release_lock(struct generic_pm_domain
*genpd
)
120 mutex_unlock(&genpd
->lock
);
123 static void genpd_set_active(struct generic_pm_domain
*genpd
)
125 if (genpd
->resume_count
== 0)
126 genpd
->status
= GPD_STATE_ACTIVE
;
129 static void genpd_recalc_cpu_exit_latency(struct generic_pm_domain
*genpd
)
133 if (!genpd
->cpu_data
)
136 usecs64
= genpd
->power_on_latency_ns
;
137 do_div(usecs64
, NSEC_PER_USEC
);
138 usecs64
+= genpd
->cpu_data
->saved_exit_latency
;
139 genpd
->cpu_data
->idle_state
->exit_latency
= usecs64
;
143 * __pm_genpd_poweron - Restore power to a given PM domain and its masters.
144 * @genpd: PM domain to power up.
146 * Restore power to @genpd and all of its masters so that it is possible to
147 * resume a device belonging to it.
149 static int __pm_genpd_poweron(struct generic_pm_domain
*genpd
)
150 __releases(&genpd
->lock
) __acquires(&genpd
->lock
)
152 struct gpd_link
*link
;
156 /* If the domain's master is being waited for, we have to wait too. */
158 prepare_to_wait(&genpd
->status_wait_queue
, &wait
,
159 TASK_UNINTERRUPTIBLE
);
160 if (genpd
->status
!= GPD_STATE_WAIT_MASTER
)
162 mutex_unlock(&genpd
->lock
);
166 mutex_lock(&genpd
->lock
);
168 finish_wait(&genpd
->status_wait_queue
, &wait
);
170 if (genpd
->status
== GPD_STATE_ACTIVE
171 || (genpd
->prepared_count
> 0 && genpd
->suspend_power_off
))
174 if (genpd
->status
!= GPD_STATE_POWER_OFF
) {
175 genpd_set_active(genpd
);
179 if (genpd
->cpu_data
) {
180 cpuidle_pause_and_lock();
181 genpd
->cpu_data
->idle_state
->disabled
= true;
182 cpuidle_resume_and_unlock();
187 * The list is guaranteed not to change while the loop below is being
188 * executed, unless one of the masters' .power_on() callbacks fiddles
191 list_for_each_entry(link
, &genpd
->slave_links
, slave_node
) {
192 genpd_sd_counter_inc(link
->master
);
193 genpd
->status
= GPD_STATE_WAIT_MASTER
;
195 mutex_unlock(&genpd
->lock
);
197 ret
= pm_genpd_poweron(link
->master
);
199 mutex_lock(&genpd
->lock
);
202 * The "wait for parent" status is guaranteed not to change
203 * while the master is powering on.
205 genpd
->status
= GPD_STATE_POWER_OFF
;
206 wake_up_all(&genpd
->status_wait_queue
);
208 genpd_sd_counter_dec(link
->master
);
213 if (genpd
->power_on
) {
214 ktime_t time_start
= ktime_get();
217 ret
= genpd
->power_on(genpd
);
221 elapsed_ns
= ktime_to_ns(ktime_sub(ktime_get(), time_start
));
222 if (elapsed_ns
> genpd
->power_on_latency_ns
) {
223 genpd
->power_on_latency_ns
= elapsed_ns
;
224 genpd
->max_off_time_changed
= true;
225 genpd_recalc_cpu_exit_latency(genpd
);
227 pr_warning("%s: Power-on latency exceeded, "
228 "new value %lld ns\n", genpd
->name
,
234 genpd_set_active(genpd
);
239 list_for_each_entry_continue_reverse(link
, &genpd
->slave_links
, slave_node
)
240 genpd_sd_counter_dec(link
->master
);
246 * pm_genpd_poweron - Restore power to a given PM domain and its masters.
247 * @genpd: PM domain to power up.
249 int pm_genpd_poweron(struct generic_pm_domain
*genpd
)
253 mutex_lock(&genpd
->lock
);
254 ret
= __pm_genpd_poweron(genpd
);
255 mutex_unlock(&genpd
->lock
);
259 #endif /* CONFIG_PM */
261 #ifdef CONFIG_PM_RUNTIME
263 static int genpd_save_dev(struct generic_pm_domain
*genpd
, struct device
*dev
)
265 return GENPD_DEV_TIMED_CALLBACK(genpd
, int, save_state
, dev
,
266 save_state_latency_ns
, "state save");
269 static int genpd_restore_dev(struct generic_pm_domain
*genpd
, struct device
*dev
)
271 return GENPD_DEV_TIMED_CALLBACK(genpd
, int, restore_state
, dev
,
272 restore_state_latency_ns
,
276 static int genpd_dev_pm_qos_notifier(struct notifier_block
*nb
,
277 unsigned long val
, void *ptr
)
279 struct generic_pm_domain_data
*gpd_data
;
282 gpd_data
= container_of(nb
, struct generic_pm_domain_data
, nb
);
284 mutex_lock(&gpd_data
->lock
);
285 dev
= gpd_data
->base
.dev
;
287 mutex_unlock(&gpd_data
->lock
);
290 mutex_unlock(&gpd_data
->lock
);
293 struct generic_pm_domain
*genpd
;
294 struct pm_domain_data
*pdd
;
296 spin_lock_irq(&dev
->power
.lock
);
298 pdd
= dev
->power
.subsys_data
?
299 dev
->power
.subsys_data
->domain_data
: NULL
;
300 if (pdd
&& pdd
->dev
) {
301 to_gpd_data(pdd
)->td
.constraint_changed
= true;
302 genpd
= dev_to_genpd(dev
);
304 genpd
= ERR_PTR(-ENODATA
);
307 spin_unlock_irq(&dev
->power
.lock
);
309 if (!IS_ERR(genpd
)) {
310 mutex_lock(&genpd
->lock
);
311 genpd
->max_off_time_changed
= true;
312 mutex_unlock(&genpd
->lock
);
316 if (!dev
|| dev
->power
.ignore_children
)
324 * __pm_genpd_save_device - Save the pre-suspend state of a device.
325 * @pdd: Domain data of the device to save the state of.
326 * @genpd: PM domain the device belongs to.
328 static int __pm_genpd_save_device(struct pm_domain_data
*pdd
,
329 struct generic_pm_domain
*genpd
)
330 __releases(&genpd
->lock
) __acquires(&genpd
->lock
)
332 struct generic_pm_domain_data
*gpd_data
= to_gpd_data(pdd
);
333 struct device
*dev
= pdd
->dev
;
336 if (gpd_data
->need_restore
)
339 mutex_unlock(&genpd
->lock
);
341 genpd_start_dev(genpd
, dev
);
342 ret
= genpd_save_dev(genpd
, dev
);
343 genpd_stop_dev(genpd
, dev
);
345 mutex_lock(&genpd
->lock
);
348 gpd_data
->need_restore
= true;
354 * __pm_genpd_restore_device - Restore the pre-suspend state of a device.
355 * @pdd: Domain data of the device to restore the state of.
356 * @genpd: PM domain the device belongs to.
358 static void __pm_genpd_restore_device(struct pm_domain_data
*pdd
,
359 struct generic_pm_domain
*genpd
)
360 __releases(&genpd
->lock
) __acquires(&genpd
->lock
)
362 struct generic_pm_domain_data
*gpd_data
= to_gpd_data(pdd
);
363 struct device
*dev
= pdd
->dev
;
364 bool need_restore
= gpd_data
->need_restore
;
366 gpd_data
->need_restore
= false;
367 mutex_unlock(&genpd
->lock
);
369 genpd_start_dev(genpd
, dev
);
371 genpd_restore_dev(genpd
, dev
);
373 mutex_lock(&genpd
->lock
);
377 * genpd_abort_poweroff - Check if a PM domain power off should be aborted.
378 * @genpd: PM domain to check.
380 * Return true if a PM domain's status changed to GPD_STATE_ACTIVE during
381 * a "power off" operation, which means that a "power on" has occured in the
382 * meantime, or if its resume_count field is different from zero, which means
383 * that one of its devices has been resumed in the meantime.
385 static bool genpd_abort_poweroff(struct generic_pm_domain
*genpd
)
387 return genpd
->status
== GPD_STATE_WAIT_MASTER
388 || genpd
->status
== GPD_STATE_ACTIVE
|| genpd
->resume_count
> 0;
392 * genpd_queue_power_off_work - Queue up the execution of pm_genpd_poweroff().
393 * @genpd: PM domait to power off.
395 * Queue up the execution of pm_genpd_poweroff() unless it's already been done
398 void genpd_queue_power_off_work(struct generic_pm_domain
*genpd
)
400 if (!work_pending(&genpd
->power_off_work
))
401 queue_work(pm_wq
, &genpd
->power_off_work
);
405 * pm_genpd_poweroff - Remove power from a given PM domain.
406 * @genpd: PM domain to power down.
408 * If all of the @genpd's devices have been suspended and all of its subdomains
409 * have been powered down, run the runtime suspend callbacks provided by all of
410 * the @genpd's devices' drivers and remove power from @genpd.
412 static int pm_genpd_poweroff(struct generic_pm_domain
*genpd
)
413 __releases(&genpd
->lock
) __acquires(&genpd
->lock
)
415 struct pm_domain_data
*pdd
;
416 struct gpd_link
*link
;
417 unsigned int not_suspended
;
422 * Do not try to power off the domain in the following situations:
423 * (1) The domain is already in the "power off" state.
424 * (2) The domain is waiting for its master to power up.
425 * (3) One of the domain's devices is being resumed right now.
426 * (4) System suspend is in progress.
428 if (genpd
->status
== GPD_STATE_POWER_OFF
429 || genpd
->status
== GPD_STATE_WAIT_MASTER
430 || genpd
->resume_count
> 0 || genpd
->prepared_count
> 0)
433 if (atomic_read(&genpd
->sd_count
) > 0)
437 list_for_each_entry(pdd
, &genpd
->dev_list
, list_node
)
438 if (pdd
->dev
->driver
&& (!pm_runtime_suspended(pdd
->dev
)
439 || pdd
->dev
->power
.irq_safe
|| to_gpd_data(pdd
)->always_on
))
442 if (not_suspended
> genpd
->in_progress
)
445 if (genpd
->poweroff_task
) {
447 * Another instance of pm_genpd_poweroff() is executing
448 * callbacks, so tell it to start over and return.
450 genpd
->status
= GPD_STATE_REPEAT
;
454 if (genpd
->gov
&& genpd
->gov
->power_down_ok
) {
455 if (!genpd
->gov
->power_down_ok(&genpd
->domain
))
459 genpd
->status
= GPD_STATE_BUSY
;
460 genpd
->poweroff_task
= current
;
462 list_for_each_entry_reverse(pdd
, &genpd
->dev_list
, list_node
) {
463 ret
= atomic_read(&genpd
->sd_count
) == 0 ?
464 __pm_genpd_save_device(pdd
, genpd
) : -EBUSY
;
466 if (genpd_abort_poweroff(genpd
))
470 genpd_set_active(genpd
);
474 if (genpd
->status
== GPD_STATE_REPEAT
) {
475 genpd
->poweroff_task
= NULL
;
480 if (genpd
->cpu_data
) {
482 * If cpu_data is set, cpuidle should turn the domain off when
483 * the CPU in it is idle. In that case we don't decrement the
484 * subdomain counts of the master domains, so that power is not
485 * removed from the current domain prematurely as a result of
486 * cutting off the masters' power.
488 genpd
->status
= GPD_STATE_POWER_OFF
;
489 cpuidle_pause_and_lock();
490 genpd
->cpu_data
->idle_state
->disabled
= false;
491 cpuidle_resume_and_unlock();
495 if (genpd
->power_off
) {
499 if (atomic_read(&genpd
->sd_count
) > 0) {
504 time_start
= ktime_get();
507 * If sd_count > 0 at this point, one of the subdomains hasn't
508 * managed to call pm_genpd_poweron() for the master yet after
509 * incrementing it. In that case pm_genpd_poweron() will wait
510 * for us to drop the lock, so we can call .power_off() and let
511 * the pm_genpd_poweron() restore power for us (this shouldn't
512 * happen very often).
514 ret
= genpd
->power_off(genpd
);
516 genpd_set_active(genpd
);
520 elapsed_ns
= ktime_to_ns(ktime_sub(ktime_get(), time_start
));
521 if (elapsed_ns
> genpd
->power_off_latency_ns
) {
522 genpd
->power_off_latency_ns
= elapsed_ns
;
523 genpd
->max_off_time_changed
= true;
525 pr_warning("%s: Power-off latency exceeded, "
526 "new value %lld ns\n", genpd
->name
,
531 genpd
->status
= GPD_STATE_POWER_OFF
;
533 list_for_each_entry(link
, &genpd
->slave_links
, slave_node
) {
534 genpd_sd_counter_dec(link
->master
);
535 genpd_queue_power_off_work(link
->master
);
539 genpd
->poweroff_task
= NULL
;
540 wake_up_all(&genpd
->status_wait_queue
);
545 * genpd_power_off_work_fn - Power off PM domain whose subdomain count is 0.
546 * @work: Work structure used for scheduling the execution of this function.
548 static void genpd_power_off_work_fn(struct work_struct
*work
)
550 struct generic_pm_domain
*genpd
;
552 genpd
= container_of(work
, struct generic_pm_domain
, power_off_work
);
554 genpd_acquire_lock(genpd
);
555 pm_genpd_poweroff(genpd
);
556 genpd_release_lock(genpd
);
560 * pm_genpd_runtime_suspend - Suspend a device belonging to I/O PM domain.
561 * @dev: Device to suspend.
563 * Carry out a runtime suspend of a device under the assumption that its
564 * pm_domain field points to the domain member of an object of type
565 * struct generic_pm_domain representing a PM domain consisting of I/O devices.
567 static int pm_genpd_runtime_suspend(struct device
*dev
)
569 struct generic_pm_domain
*genpd
;
570 bool (*stop_ok
)(struct device
*__dev
);
573 dev_dbg(dev
, "%s()\n", __func__
);
575 genpd
= dev_to_genpd(dev
);
579 might_sleep_if(!genpd
->dev_irq_safe
);
581 if (dev_gpd_data(dev
)->always_on
)
584 stop_ok
= genpd
->gov
? genpd
->gov
->stop_ok
: NULL
;
585 if (stop_ok
&& !stop_ok(dev
))
588 ret
= genpd_stop_dev(genpd
, dev
);
593 * If power.irq_safe is set, this routine will be run with interrupts
594 * off, so it can't use mutexes.
596 if (dev
->power
.irq_safe
)
599 mutex_lock(&genpd
->lock
);
600 genpd
->in_progress
++;
601 pm_genpd_poweroff(genpd
);
602 genpd
->in_progress
--;
603 mutex_unlock(&genpd
->lock
);
609 * pm_genpd_runtime_resume - Resume a device belonging to I/O PM domain.
610 * @dev: Device to resume.
612 * Carry out a runtime resume of a device under the assumption that its
613 * pm_domain field points to the domain member of an object of type
614 * struct generic_pm_domain representing a PM domain consisting of I/O devices.
616 static int pm_genpd_runtime_resume(struct device
*dev
)
618 struct generic_pm_domain
*genpd
;
622 dev_dbg(dev
, "%s()\n", __func__
);
624 genpd
= dev_to_genpd(dev
);
628 might_sleep_if(!genpd
->dev_irq_safe
);
630 /* If power.irq_safe, the PM domain is never powered off. */
631 if (dev
->power
.irq_safe
)
632 return genpd_start_dev(genpd
, dev
);
634 mutex_lock(&genpd
->lock
);
635 ret
= __pm_genpd_poweron(genpd
);
637 mutex_unlock(&genpd
->lock
);
640 genpd
->status
= GPD_STATE_BUSY
;
641 genpd
->resume_count
++;
643 prepare_to_wait(&genpd
->status_wait_queue
, &wait
,
644 TASK_UNINTERRUPTIBLE
);
646 * If current is the powering off task, we have been called
647 * reentrantly from one of the device callbacks, so we should
650 if (!genpd
->poweroff_task
|| genpd
->poweroff_task
== current
)
652 mutex_unlock(&genpd
->lock
);
656 mutex_lock(&genpd
->lock
);
658 finish_wait(&genpd
->status_wait_queue
, &wait
);
659 __pm_genpd_restore_device(dev
->power
.subsys_data
->domain_data
, genpd
);
660 genpd
->resume_count
--;
661 genpd_set_active(genpd
);
662 wake_up_all(&genpd
->status_wait_queue
);
663 mutex_unlock(&genpd
->lock
);
669 * pm_genpd_poweroff_unused - Power off all PM domains with no devices in use.
671 void pm_genpd_poweroff_unused(void)
673 struct generic_pm_domain
*genpd
;
675 mutex_lock(&gpd_list_lock
);
677 list_for_each_entry(genpd
, &gpd_list
, gpd_list_node
)
678 genpd_queue_power_off_work(genpd
);
680 mutex_unlock(&gpd_list_lock
);
685 static inline int genpd_dev_pm_qos_notifier(struct notifier_block
*nb
,
686 unsigned long val
, void *ptr
)
691 static inline void genpd_power_off_work_fn(struct work_struct
*work
) {}
693 #define pm_genpd_runtime_suspend NULL
694 #define pm_genpd_runtime_resume NULL
696 #endif /* CONFIG_PM_RUNTIME */
698 #ifdef CONFIG_PM_SLEEP
700 static bool genpd_dev_active_wakeup(struct generic_pm_domain
*genpd
,
703 return GENPD_DEV_CALLBACK(genpd
, bool, active_wakeup
, dev
);
706 static int genpd_suspend_dev(struct generic_pm_domain
*genpd
, struct device
*dev
)
708 return GENPD_DEV_CALLBACK(genpd
, int, suspend
, dev
);
711 static int genpd_suspend_late(struct generic_pm_domain
*genpd
, struct device
*dev
)
713 return GENPD_DEV_CALLBACK(genpd
, int, suspend_late
, dev
);
716 static int genpd_resume_early(struct generic_pm_domain
*genpd
, struct device
*dev
)
718 return GENPD_DEV_CALLBACK(genpd
, int, resume_early
, dev
);
721 static int genpd_resume_dev(struct generic_pm_domain
*genpd
, struct device
*dev
)
723 return GENPD_DEV_CALLBACK(genpd
, int, resume
, dev
);
726 static int genpd_freeze_dev(struct generic_pm_domain
*genpd
, struct device
*dev
)
728 return GENPD_DEV_CALLBACK(genpd
, int, freeze
, dev
);
731 static int genpd_freeze_late(struct generic_pm_domain
*genpd
, struct device
*dev
)
733 return GENPD_DEV_CALLBACK(genpd
, int, freeze_late
, dev
);
736 static int genpd_thaw_early(struct generic_pm_domain
*genpd
, struct device
*dev
)
738 return GENPD_DEV_CALLBACK(genpd
, int, thaw_early
, dev
);
741 static int genpd_thaw_dev(struct generic_pm_domain
*genpd
, struct device
*dev
)
743 return GENPD_DEV_CALLBACK(genpd
, int, thaw
, dev
);
747 * pm_genpd_sync_poweroff - Synchronously power off a PM domain and its masters.
748 * @genpd: PM domain to power off, if possible.
750 * Check if the given PM domain can be powered off (during system suspend or
751 * hibernation) and do that if so. Also, in that case propagate to its masters.
753 * This function is only called in "noirq" stages of system power transitions,
754 * so it need not acquire locks (all of the "noirq" callbacks are executed
755 * sequentially, so it is guaranteed that it will never run twice in parallel).
757 static void pm_genpd_sync_poweroff(struct generic_pm_domain
*genpd
)
759 struct gpd_link
*link
;
761 if (genpd
->status
== GPD_STATE_POWER_OFF
)
764 if (genpd
->suspended_count
!= genpd
->device_count
765 || atomic_read(&genpd
->sd_count
) > 0)
768 if (genpd
->power_off
)
769 genpd
->power_off(genpd
);
771 genpd
->status
= GPD_STATE_POWER_OFF
;
773 list_for_each_entry(link
, &genpd
->slave_links
, slave_node
) {
774 genpd_sd_counter_dec(link
->master
);
775 pm_genpd_sync_poweroff(link
->master
);
780 * resume_needed - Check whether to resume a device before system suspend.
781 * @dev: Device to check.
782 * @genpd: PM domain the device belongs to.
784 * There are two cases in which a device that can wake up the system from sleep
785 * states should be resumed by pm_genpd_prepare(): (1) if the device is enabled
786 * to wake up the system and it has to remain active for this purpose while the
787 * system is in the sleep state and (2) if the device is not enabled to wake up
788 * the system from sleep states and it generally doesn't generate wakeup signals
789 * by itself (those signals are generated on its behalf by other parts of the
790 * system). In the latter case it may be necessary to reconfigure the device's
791 * wakeup settings during system suspend, because it may have been set up to
792 * signal remote wakeup from the system's working state as needed by runtime PM.
793 * Return 'true' in either of the above cases.
795 static bool resume_needed(struct device
*dev
, struct generic_pm_domain
*genpd
)
799 if (!device_can_wakeup(dev
))
802 active_wakeup
= genpd_dev_active_wakeup(genpd
, dev
);
803 return device_may_wakeup(dev
) ? active_wakeup
: !active_wakeup
;
807 * pm_genpd_prepare - Start power transition of a device in a PM domain.
808 * @dev: Device to start the transition of.
810 * Start a power transition of a device (during a system-wide power transition)
811 * under the assumption that its pm_domain field points to the domain member of
812 * an object of type struct generic_pm_domain representing a PM domain
813 * consisting of I/O devices.
815 static int pm_genpd_prepare(struct device
*dev
)
817 struct generic_pm_domain
*genpd
;
820 dev_dbg(dev
, "%s()\n", __func__
);
822 genpd
= dev_to_genpd(dev
);
827 * If a wakeup request is pending for the device, it should be woken up
828 * at this point and a system wakeup event should be reported if it's
829 * set up to wake up the system from sleep states.
831 pm_runtime_get_noresume(dev
);
832 if (pm_runtime_barrier(dev
) && device_may_wakeup(dev
))
833 pm_wakeup_event(dev
, 0);
835 if (pm_wakeup_pending()) {
836 pm_runtime_put_sync(dev
);
840 if (resume_needed(dev
, genpd
))
841 pm_runtime_resume(dev
);
843 genpd_acquire_lock(genpd
);
845 if (genpd
->prepared_count
++ == 0) {
846 genpd
->suspended_count
= 0;
847 genpd
->suspend_power_off
= genpd
->status
== GPD_STATE_POWER_OFF
;
850 genpd_release_lock(genpd
);
852 if (genpd
->suspend_power_off
) {
853 pm_runtime_put_noidle(dev
);
858 * The PM domain must be in the GPD_STATE_ACTIVE state at this point,
859 * so pm_genpd_poweron() will return immediately, but if the device
860 * is suspended (e.g. it's been stopped by genpd_stop_dev()), we need
861 * to make it operational.
863 pm_runtime_resume(dev
);
864 __pm_runtime_disable(dev
, false);
866 ret
= pm_generic_prepare(dev
);
868 mutex_lock(&genpd
->lock
);
870 if (--genpd
->prepared_count
== 0)
871 genpd
->suspend_power_off
= false;
873 mutex_unlock(&genpd
->lock
);
874 pm_runtime_enable(dev
);
877 pm_runtime_put_sync(dev
);
882 * pm_genpd_suspend - Suspend a device belonging to an I/O PM domain.
883 * @dev: Device to suspend.
885 * Suspend a device under the assumption that its pm_domain field points to the
886 * domain member of an object of type struct generic_pm_domain representing
887 * a PM domain consisting of I/O devices.
889 static int pm_genpd_suspend(struct device
*dev
)
891 struct generic_pm_domain
*genpd
;
893 dev_dbg(dev
, "%s()\n", __func__
);
895 genpd
= dev_to_genpd(dev
);
899 return genpd
->suspend_power_off
? 0 : genpd_suspend_dev(genpd
, dev
);
903 * pm_genpd_suspend_late - Late suspend of a device from an I/O PM domain.
904 * @dev: Device to suspend.
906 * Carry out a late suspend of a device under the assumption that its
907 * pm_domain field points to the domain member of an object of type
908 * struct generic_pm_domain representing a PM domain consisting of I/O devices.
910 static int pm_genpd_suspend_late(struct device
*dev
)
912 struct generic_pm_domain
*genpd
;
914 dev_dbg(dev
, "%s()\n", __func__
);
916 genpd
= dev_to_genpd(dev
);
920 return genpd
->suspend_power_off
? 0 : genpd_suspend_late(genpd
, dev
);
924 * pm_genpd_suspend_noirq - Completion of suspend of device in an I/O PM domain.
925 * @dev: Device to suspend.
927 * Stop the device and remove power from the domain if all devices in it have
930 static int pm_genpd_suspend_noirq(struct device
*dev
)
932 struct generic_pm_domain
*genpd
;
934 dev_dbg(dev
, "%s()\n", __func__
);
936 genpd
= dev_to_genpd(dev
);
940 if (genpd
->suspend_power_off
|| dev_gpd_data(dev
)->always_on
941 || (dev
->power
.wakeup_path
&& genpd_dev_active_wakeup(genpd
, dev
)))
944 genpd_stop_dev(genpd
, dev
);
947 * Since all of the "noirq" callbacks are executed sequentially, it is
948 * guaranteed that this function will never run twice in parallel for
949 * the same PM domain, so it is not necessary to use locking here.
951 genpd
->suspended_count
++;
952 pm_genpd_sync_poweroff(genpd
);
958 * pm_genpd_resume_noirq - Start of resume of device in an I/O PM domain.
959 * @dev: Device to resume.
961 * Restore power to the device's PM domain, if necessary, and start the device.
963 static int pm_genpd_resume_noirq(struct device
*dev
)
965 struct generic_pm_domain
*genpd
;
967 dev_dbg(dev
, "%s()\n", __func__
);
969 genpd
= dev_to_genpd(dev
);
973 if (genpd
->suspend_power_off
|| dev_gpd_data(dev
)->always_on
974 || (dev
->power
.wakeup_path
&& genpd_dev_active_wakeup(genpd
, dev
)))
978 * Since all of the "noirq" callbacks are executed sequentially, it is
979 * guaranteed that this function will never run twice in parallel for
980 * the same PM domain, so it is not necessary to use locking here.
982 pm_genpd_poweron(genpd
);
983 genpd
->suspended_count
--;
985 return genpd_start_dev(genpd
, dev
);
989 * pm_genpd_resume_early - Early resume of a device in an I/O PM domain.
990 * @dev: Device to resume.
992 * Carry out an early resume of a device under the assumption that its
993 * pm_domain field points to the domain member of an object of type
994 * struct generic_pm_domain representing a power domain consisting of I/O
997 static int pm_genpd_resume_early(struct device
*dev
)
999 struct generic_pm_domain
*genpd
;
1001 dev_dbg(dev
, "%s()\n", __func__
);
1003 genpd
= dev_to_genpd(dev
);
1007 return genpd
->suspend_power_off
? 0 : genpd_resume_early(genpd
, dev
);
1011 * pm_genpd_resume - Resume of device in an I/O PM domain.
1012 * @dev: Device to resume.
1014 * Resume a device under the assumption that its pm_domain field points to the
1015 * domain member of an object of type struct generic_pm_domain representing
1016 * a power domain consisting of I/O devices.
1018 static int pm_genpd_resume(struct device
*dev
)
1020 struct generic_pm_domain
*genpd
;
1022 dev_dbg(dev
, "%s()\n", __func__
);
1024 genpd
= dev_to_genpd(dev
);
1028 return genpd
->suspend_power_off
? 0 : genpd_resume_dev(genpd
, dev
);
1032 * pm_genpd_freeze - Freezing a device in an I/O PM domain.
1033 * @dev: Device to freeze.
1035 * Freeze a device under the assumption that its pm_domain field points to the
1036 * domain member of an object of type struct generic_pm_domain representing
1037 * a power domain consisting of I/O devices.
1039 static int pm_genpd_freeze(struct device
*dev
)
1041 struct generic_pm_domain
*genpd
;
1043 dev_dbg(dev
, "%s()\n", __func__
);
1045 genpd
= dev_to_genpd(dev
);
1049 return genpd
->suspend_power_off
? 0 : genpd_freeze_dev(genpd
, dev
);
1053 * pm_genpd_freeze_late - Late freeze of a device in an I/O PM domain.
1054 * @dev: Device to freeze.
1056 * Carry out a late freeze of a device under the assumption that its
1057 * pm_domain field points to the domain member of an object of type
1058 * struct generic_pm_domain representing a power domain consisting of I/O
1061 static int pm_genpd_freeze_late(struct device
*dev
)
1063 struct generic_pm_domain
*genpd
;
1065 dev_dbg(dev
, "%s()\n", __func__
);
1067 genpd
= dev_to_genpd(dev
);
1071 return genpd
->suspend_power_off
? 0 : genpd_freeze_late(genpd
, dev
);
1075 * pm_genpd_freeze_noirq - Completion of freezing a device in an I/O PM domain.
1076 * @dev: Device to freeze.
1078 * Carry out a late freeze of a device under the assumption that its
1079 * pm_domain field points to the domain member of an object of type
1080 * struct generic_pm_domain representing a power domain consisting of I/O
1083 static int pm_genpd_freeze_noirq(struct device
*dev
)
1085 struct generic_pm_domain
*genpd
;
1087 dev_dbg(dev
, "%s()\n", __func__
);
1089 genpd
= dev_to_genpd(dev
);
1093 return genpd
->suspend_power_off
|| dev_gpd_data(dev
)->always_on
?
1094 0 : genpd_stop_dev(genpd
, dev
);
1098 * pm_genpd_thaw_noirq - Early thaw of device in an I/O PM domain.
1099 * @dev: Device to thaw.
1101 * Start the device, unless power has been removed from the domain already
1102 * before the system transition.
1104 static int pm_genpd_thaw_noirq(struct device
*dev
)
1106 struct generic_pm_domain
*genpd
;
1108 dev_dbg(dev
, "%s()\n", __func__
);
1110 genpd
= dev_to_genpd(dev
);
1114 return genpd
->suspend_power_off
|| dev_gpd_data(dev
)->always_on
?
1115 0 : genpd_start_dev(genpd
, dev
);
1119 * pm_genpd_thaw_early - Early thaw of device in an I/O PM domain.
1120 * @dev: Device to thaw.
1122 * Carry out an early thaw of a device under the assumption that its
1123 * pm_domain field points to the domain member of an object of type
1124 * struct generic_pm_domain representing a power domain consisting of I/O
1127 static int pm_genpd_thaw_early(struct device
*dev
)
1129 struct generic_pm_domain
*genpd
;
1131 dev_dbg(dev
, "%s()\n", __func__
);
1133 genpd
= dev_to_genpd(dev
);
1137 return genpd
->suspend_power_off
? 0 : genpd_thaw_early(genpd
, dev
);
1141 * pm_genpd_thaw - Thaw a device belonging to an I/O power domain.
1142 * @dev: Device to thaw.
1144 * Thaw a device under the assumption that its pm_domain field points to the
1145 * domain member of an object of type struct generic_pm_domain representing
1146 * a power domain consisting of I/O devices.
1148 static int pm_genpd_thaw(struct device
*dev
)
1150 struct generic_pm_domain
*genpd
;
1152 dev_dbg(dev
, "%s()\n", __func__
);
1154 genpd
= dev_to_genpd(dev
);
1158 return genpd
->suspend_power_off
? 0 : genpd_thaw_dev(genpd
, dev
);
1162 * pm_genpd_restore_noirq - Start of restore of device in an I/O PM domain.
1163 * @dev: Device to resume.
1165 * Make sure the domain will be in the same power state as before the
1166 * hibernation the system is resuming from and start the device if necessary.
1168 static int pm_genpd_restore_noirq(struct device
*dev
)
1170 struct generic_pm_domain
*genpd
;
1172 dev_dbg(dev
, "%s()\n", __func__
);
1174 genpd
= dev_to_genpd(dev
);
1179 * Since all of the "noirq" callbacks are executed sequentially, it is
1180 * guaranteed that this function will never run twice in parallel for
1181 * the same PM domain, so it is not necessary to use locking here.
1183 * At this point suspended_count == 0 means we are being run for the
1184 * first time for the given domain in the present cycle.
1186 if (genpd
->suspended_count
++ == 0) {
1188 * The boot kernel might put the domain into arbitrary state,
1189 * so make it appear as powered off to pm_genpd_poweron(), so
1190 * that it tries to power it on in case it was really off.
1192 genpd
->status
= GPD_STATE_POWER_OFF
;
1193 if (genpd
->suspend_power_off
) {
1195 * If the domain was off before the hibernation, make
1196 * sure it will be off going forward.
1198 if (genpd
->power_off
)
1199 genpd
->power_off(genpd
);
1205 if (genpd
->suspend_power_off
)
1208 pm_genpd_poweron(genpd
);
1210 return dev_gpd_data(dev
)->always_on
? 0 : genpd_start_dev(genpd
, dev
);
1214 * pm_genpd_complete - Complete power transition of a device in a power domain.
1215 * @dev: Device to complete the transition of.
1217 * Complete a power transition of a device (during a system-wide power
1218 * transition) under the assumption that its pm_domain field points to the
1219 * domain member of an object of type struct generic_pm_domain representing
1220 * a power domain consisting of I/O devices.
1222 static void pm_genpd_complete(struct device
*dev
)
1224 struct generic_pm_domain
*genpd
;
1227 dev_dbg(dev
, "%s()\n", __func__
);
1229 genpd
= dev_to_genpd(dev
);
1233 mutex_lock(&genpd
->lock
);
1235 run_complete
= !genpd
->suspend_power_off
;
1236 if (--genpd
->prepared_count
== 0)
1237 genpd
->suspend_power_off
= false;
1239 mutex_unlock(&genpd
->lock
);
1242 pm_generic_complete(dev
);
1243 pm_runtime_set_active(dev
);
1244 pm_runtime_enable(dev
);
1245 pm_runtime_idle(dev
);
1251 #define pm_genpd_prepare NULL
1252 #define pm_genpd_suspend NULL
1253 #define pm_genpd_suspend_late NULL
1254 #define pm_genpd_suspend_noirq NULL
1255 #define pm_genpd_resume_early NULL
1256 #define pm_genpd_resume_noirq NULL
1257 #define pm_genpd_resume NULL
1258 #define pm_genpd_freeze NULL
1259 #define pm_genpd_freeze_late NULL
1260 #define pm_genpd_freeze_noirq NULL
1261 #define pm_genpd_thaw_early NULL
1262 #define pm_genpd_thaw_noirq NULL
1263 #define pm_genpd_thaw NULL
1264 #define pm_genpd_restore_noirq NULL
1265 #define pm_genpd_complete NULL
1267 #endif /* CONFIG_PM_SLEEP */
1269 static struct generic_pm_domain_data
*__pm_genpd_alloc_dev_data(struct device
*dev
)
1271 struct generic_pm_domain_data
*gpd_data
;
1273 gpd_data
= kzalloc(sizeof(*gpd_data
), GFP_KERNEL
);
1277 mutex_init(&gpd_data
->lock
);
1278 gpd_data
->nb
.notifier_call
= genpd_dev_pm_qos_notifier
;
1279 dev_pm_qos_add_notifier(dev
, &gpd_data
->nb
);
1283 static void __pm_genpd_free_dev_data(struct device
*dev
,
1284 struct generic_pm_domain_data
*gpd_data
)
1286 dev_pm_qos_remove_notifier(dev
, &gpd_data
->nb
);
1291 * __pm_genpd_add_device - Add a device to an I/O PM domain.
1292 * @genpd: PM domain to add the device to.
1293 * @dev: Device to be added.
1294 * @td: Set of PM QoS timing parameters to attach to the device.
1296 int __pm_genpd_add_device(struct generic_pm_domain
*genpd
, struct device
*dev
,
1297 struct gpd_timing_data
*td
)
1299 struct generic_pm_domain_data
*gpd_data_new
, *gpd_data
= NULL
;
1300 struct pm_domain_data
*pdd
;
1303 dev_dbg(dev
, "%s()\n", __func__
);
1305 if (IS_ERR_OR_NULL(genpd
) || IS_ERR_OR_NULL(dev
))
1308 gpd_data_new
= __pm_genpd_alloc_dev_data(dev
);
1312 genpd_acquire_lock(genpd
);
1314 if (genpd
->prepared_count
> 0) {
1319 list_for_each_entry(pdd
, &genpd
->dev_list
, list_node
)
1320 if (pdd
->dev
== dev
) {
1325 ret
= dev_pm_get_subsys_data(dev
);
1329 genpd
->device_count
++;
1330 genpd
->max_off_time_changed
= true;
1332 spin_lock_irq(&dev
->power
.lock
);
1334 dev
->pm_domain
= &genpd
->domain
;
1335 if (dev
->power
.subsys_data
->domain_data
) {
1336 gpd_data
= to_gpd_data(dev
->power
.subsys_data
->domain_data
);
1338 gpd_data
= gpd_data_new
;
1339 dev
->power
.subsys_data
->domain_data
= &gpd_data
->base
;
1341 gpd_data
->refcount
++;
1345 spin_unlock_irq(&dev
->power
.lock
);
1347 mutex_lock(&gpd_data
->lock
);
1348 gpd_data
->base
.dev
= dev
;
1349 list_add_tail(&gpd_data
->base
.list_node
, &genpd
->dev_list
);
1350 gpd_data
->need_restore
= genpd
->status
== GPD_STATE_POWER_OFF
;
1351 gpd_data
->td
.constraint_changed
= true;
1352 gpd_data
->td
.effective_constraint_ns
= -1;
1353 mutex_unlock(&gpd_data
->lock
);
1356 genpd_release_lock(genpd
);
1358 if (gpd_data
!= gpd_data_new
)
1359 __pm_genpd_free_dev_data(dev
, gpd_data_new
);
1365 * __pm_genpd_of_add_device - Add a device to an I/O PM domain.
1366 * @genpd_node: Device tree node pointer representing a PM domain to which the
1367 * the device is added to.
1368 * @dev: Device to be added.
1369 * @td: Set of PM QoS timing parameters to attach to the device.
1371 int __pm_genpd_of_add_device(struct device_node
*genpd_node
, struct device
*dev
,
1372 struct gpd_timing_data
*td
)
1374 struct generic_pm_domain
*genpd
= NULL
, *gpd
;
1376 dev_dbg(dev
, "%s()\n", __func__
);
1378 if (IS_ERR_OR_NULL(genpd_node
) || IS_ERR_OR_NULL(dev
))
1381 mutex_lock(&gpd_list_lock
);
1382 list_for_each_entry(gpd
, &gpd_list
, gpd_list_node
) {
1383 if (gpd
->of_node
== genpd_node
) {
1388 mutex_unlock(&gpd_list_lock
);
1393 return __pm_genpd_add_device(genpd
, dev
, td
);
1397 * pm_genpd_remove_device - Remove a device from an I/O PM domain.
1398 * @genpd: PM domain to remove the device from.
1399 * @dev: Device to be removed.
1401 int pm_genpd_remove_device(struct generic_pm_domain
*genpd
,
1404 struct generic_pm_domain_data
*gpd_data
;
1405 struct pm_domain_data
*pdd
;
1406 bool remove
= false;
1409 dev_dbg(dev
, "%s()\n", __func__
);
1411 if (IS_ERR_OR_NULL(genpd
) || IS_ERR_OR_NULL(dev
)
1412 || IS_ERR_OR_NULL(dev
->pm_domain
)
1413 || pd_to_genpd(dev
->pm_domain
) != genpd
)
1416 genpd_acquire_lock(genpd
);
1418 if (genpd
->prepared_count
> 0) {
1423 genpd
->device_count
--;
1424 genpd
->max_off_time_changed
= true;
1426 spin_lock_irq(&dev
->power
.lock
);
1428 dev
->pm_domain
= NULL
;
1429 pdd
= dev
->power
.subsys_data
->domain_data
;
1430 list_del_init(&pdd
->list_node
);
1431 gpd_data
= to_gpd_data(pdd
);
1432 if (--gpd_data
->refcount
== 0) {
1433 dev
->power
.subsys_data
->domain_data
= NULL
;
1437 spin_unlock_irq(&dev
->power
.lock
);
1439 mutex_lock(&gpd_data
->lock
);
1441 mutex_unlock(&gpd_data
->lock
);
1443 genpd_release_lock(genpd
);
1445 dev_pm_put_subsys_data(dev
);
1447 __pm_genpd_free_dev_data(dev
, gpd_data
);
1452 genpd_release_lock(genpd
);
1458 * pm_genpd_dev_always_on - Set/unset the "always on" flag for a given device.
1459 * @dev: Device to set/unset the flag for.
1460 * @val: The new value of the device's "always on" flag.
1462 void pm_genpd_dev_always_on(struct device
*dev
, bool val
)
1464 struct pm_subsys_data
*psd
;
1465 unsigned long flags
;
1467 spin_lock_irqsave(&dev
->power
.lock
, flags
);
1469 psd
= dev_to_psd(dev
);
1470 if (psd
&& psd
->domain_data
)
1471 to_gpd_data(psd
->domain_data
)->always_on
= val
;
1473 spin_unlock_irqrestore(&dev
->power
.lock
, flags
);
1475 EXPORT_SYMBOL_GPL(pm_genpd_dev_always_on
);
1478 * pm_genpd_dev_need_restore - Set/unset the device's "need restore" flag.
1479 * @dev: Device to set/unset the flag for.
1480 * @val: The new value of the device's "need restore" flag.
1482 void pm_genpd_dev_need_restore(struct device
*dev
, bool val
)
1484 struct pm_subsys_data
*psd
;
1485 unsigned long flags
;
1487 spin_lock_irqsave(&dev
->power
.lock
, flags
);
1489 psd
= dev_to_psd(dev
);
1490 if (psd
&& psd
->domain_data
)
1491 to_gpd_data(psd
->domain_data
)->need_restore
= val
;
1493 spin_unlock_irqrestore(&dev
->power
.lock
, flags
);
1495 EXPORT_SYMBOL_GPL(pm_genpd_dev_need_restore
);
1498 * pm_genpd_add_subdomain - Add a subdomain to an I/O PM domain.
1499 * @genpd: Master PM domain to add the subdomain to.
1500 * @subdomain: Subdomain to be added.
1502 int pm_genpd_add_subdomain(struct generic_pm_domain
*genpd
,
1503 struct generic_pm_domain
*subdomain
)
1505 struct gpd_link
*link
;
1508 if (IS_ERR_OR_NULL(genpd
) || IS_ERR_OR_NULL(subdomain
))
1512 genpd_acquire_lock(genpd
);
1513 mutex_lock_nested(&subdomain
->lock
, SINGLE_DEPTH_NESTING
);
1515 if (subdomain
->status
!= GPD_STATE_POWER_OFF
1516 && subdomain
->status
!= GPD_STATE_ACTIVE
) {
1517 mutex_unlock(&subdomain
->lock
);
1518 genpd_release_lock(genpd
);
1522 if (genpd
->status
== GPD_STATE_POWER_OFF
1523 && subdomain
->status
!= GPD_STATE_POWER_OFF
) {
1528 list_for_each_entry(link
, &genpd
->master_links
, master_node
) {
1529 if (link
->slave
== subdomain
&& link
->master
== genpd
) {
1535 link
= kzalloc(sizeof(*link
), GFP_KERNEL
);
1540 link
->master
= genpd
;
1541 list_add_tail(&link
->master_node
, &genpd
->master_links
);
1542 link
->slave
= subdomain
;
1543 list_add_tail(&link
->slave_node
, &subdomain
->slave_links
);
1544 if (subdomain
->status
!= GPD_STATE_POWER_OFF
)
1545 genpd_sd_counter_inc(genpd
);
1548 mutex_unlock(&subdomain
->lock
);
1549 genpd_release_lock(genpd
);
1555 * pm_genpd_remove_subdomain - Remove a subdomain from an I/O PM domain.
1556 * @genpd: Master PM domain to remove the subdomain from.
1557 * @subdomain: Subdomain to be removed.
1559 int pm_genpd_remove_subdomain(struct generic_pm_domain
*genpd
,
1560 struct generic_pm_domain
*subdomain
)
1562 struct gpd_link
*link
;
1565 if (IS_ERR_OR_NULL(genpd
) || IS_ERR_OR_NULL(subdomain
))
1569 genpd_acquire_lock(genpd
);
1571 list_for_each_entry(link
, &genpd
->master_links
, master_node
) {
1572 if (link
->slave
!= subdomain
)
1575 mutex_lock_nested(&subdomain
->lock
, SINGLE_DEPTH_NESTING
);
1577 if (subdomain
->status
!= GPD_STATE_POWER_OFF
1578 && subdomain
->status
!= GPD_STATE_ACTIVE
) {
1579 mutex_unlock(&subdomain
->lock
);
1580 genpd_release_lock(genpd
);
1584 list_del(&link
->master_node
);
1585 list_del(&link
->slave_node
);
1587 if (subdomain
->status
!= GPD_STATE_POWER_OFF
)
1588 genpd_sd_counter_dec(genpd
);
1590 mutex_unlock(&subdomain
->lock
);
1596 genpd_release_lock(genpd
);
1602 * pm_genpd_add_callbacks - Add PM domain callbacks to a given device.
1603 * @dev: Device to add the callbacks to.
1604 * @ops: Set of callbacks to add.
1605 * @td: Timing data to add to the device along with the callbacks (optional).
1607 * Every call to this routine should be balanced with a call to
1608 * __pm_genpd_remove_callbacks() and they must not be nested.
1610 int pm_genpd_add_callbacks(struct device
*dev
, struct gpd_dev_ops
*ops
,
1611 struct gpd_timing_data
*td
)
1613 struct generic_pm_domain_data
*gpd_data_new
, *gpd_data
= NULL
;
1619 gpd_data_new
= __pm_genpd_alloc_dev_data(dev
);
1623 pm_runtime_disable(dev
);
1626 ret
= dev_pm_get_subsys_data(dev
);
1630 spin_lock_irq(&dev
->power
.lock
);
1632 if (dev
->power
.subsys_data
->domain_data
) {
1633 gpd_data
= to_gpd_data(dev
->power
.subsys_data
->domain_data
);
1635 gpd_data
= gpd_data_new
;
1636 dev
->power
.subsys_data
->domain_data
= &gpd_data
->base
;
1638 gpd_data
->refcount
++;
1639 gpd_data
->ops
= *ops
;
1643 spin_unlock_irq(&dev
->power
.lock
);
1647 pm_runtime_enable(dev
);
1649 if (gpd_data
!= gpd_data_new
)
1650 __pm_genpd_free_dev_data(dev
, gpd_data_new
);
1654 EXPORT_SYMBOL_GPL(pm_genpd_add_callbacks
);
1657 * __pm_genpd_remove_callbacks - Remove PM domain callbacks from a given device.
1658 * @dev: Device to remove the callbacks from.
1659 * @clear_td: If set, clear the device's timing data too.
1661 * This routine can only be called after pm_genpd_add_callbacks().
1663 int __pm_genpd_remove_callbacks(struct device
*dev
, bool clear_td
)
1665 struct generic_pm_domain_data
*gpd_data
= NULL
;
1666 bool remove
= false;
1669 if (!(dev
&& dev
->power
.subsys_data
))
1672 pm_runtime_disable(dev
);
1675 spin_lock_irq(&dev
->power
.lock
);
1677 if (dev
->power
.subsys_data
->domain_data
) {
1678 gpd_data
= to_gpd_data(dev
->power
.subsys_data
->domain_data
);
1679 gpd_data
->ops
= (struct gpd_dev_ops
){ NULL
};
1681 gpd_data
->td
= (struct gpd_timing_data
){ 0 };
1683 if (--gpd_data
->refcount
== 0) {
1684 dev
->power
.subsys_data
->domain_data
= NULL
;
1691 spin_unlock_irq(&dev
->power
.lock
);
1694 pm_runtime_enable(dev
);
1699 dev_pm_put_subsys_data(dev
);
1701 __pm_genpd_free_dev_data(dev
, gpd_data
);
1705 EXPORT_SYMBOL_GPL(__pm_genpd_remove_callbacks
);
1707 int genpd_attach_cpuidle(struct generic_pm_domain
*genpd
, int state
)
1709 struct cpuidle_driver
*cpuidle_drv
;
1710 struct gpd_cpu_data
*cpu_data
;
1711 struct cpuidle_state
*idle_state
;
1714 if (IS_ERR_OR_NULL(genpd
) || state
< 0)
1717 genpd_acquire_lock(genpd
);
1719 if (genpd
->cpu_data
) {
1723 cpu_data
= kzalloc(sizeof(*cpu_data
), GFP_KERNEL
);
1728 cpuidle_drv
= cpuidle_driver_ref();
1733 if (cpuidle_drv
->state_count
<= state
) {
1737 idle_state
= &cpuidle_drv
->states
[state
];
1738 if (!idle_state
->disabled
) {
1742 cpu_data
->idle_state
= idle_state
;
1743 cpu_data
->saved_exit_latency
= idle_state
->exit_latency
;
1744 genpd
->cpu_data
= cpu_data
;
1745 genpd_recalc_cpu_exit_latency(genpd
);
1748 genpd_release_lock(genpd
);
1752 cpuidle_driver_unref();
1756 int genpd_detach_cpuidle(struct generic_pm_domain
*genpd
)
1758 struct gpd_cpu_data
*cpu_data
;
1759 struct cpuidle_state
*idle_state
;
1762 if (IS_ERR_OR_NULL(genpd
))
1765 genpd_acquire_lock(genpd
);
1767 cpu_data
= genpd
->cpu_data
;
1772 idle_state
= cpu_data
->idle_state
;
1773 if (!idle_state
->disabled
) {
1777 idle_state
->exit_latency
= cpu_data
->saved_exit_latency
;
1778 cpuidle_driver_unref();
1779 genpd
->cpu_data
= NULL
;
1783 genpd_release_lock(genpd
);
1787 /* Default device callbacks for generic PM domains. */
1790 * pm_genpd_default_save_state - Default "save device state" for PM domians.
1791 * @dev: Device to handle.
1793 static int pm_genpd_default_save_state(struct device
*dev
)
1795 int (*cb
)(struct device
*__dev
);
1797 cb
= dev_gpd_data(dev
)->ops
.save_state
;
1801 if (dev
->type
&& dev
->type
->pm
)
1802 cb
= dev
->type
->pm
->runtime_suspend
;
1803 else if (dev
->class && dev
->class->pm
)
1804 cb
= dev
->class->pm
->runtime_suspend
;
1805 else if (dev
->bus
&& dev
->bus
->pm
)
1806 cb
= dev
->bus
->pm
->runtime_suspend
;
1810 if (!cb
&& dev
->driver
&& dev
->driver
->pm
)
1811 cb
= dev
->driver
->pm
->runtime_suspend
;
1813 return cb
? cb(dev
) : 0;
1817 * pm_genpd_default_restore_state - Default PM domians "restore device state".
1818 * @dev: Device to handle.
1820 static int pm_genpd_default_restore_state(struct device
*dev
)
1822 int (*cb
)(struct device
*__dev
);
1824 cb
= dev_gpd_data(dev
)->ops
.restore_state
;
1828 if (dev
->type
&& dev
->type
->pm
)
1829 cb
= dev
->type
->pm
->runtime_resume
;
1830 else if (dev
->class && dev
->class->pm
)
1831 cb
= dev
->class->pm
->runtime_resume
;
1832 else if (dev
->bus
&& dev
->bus
->pm
)
1833 cb
= dev
->bus
->pm
->runtime_resume
;
1837 if (!cb
&& dev
->driver
&& dev
->driver
->pm
)
1838 cb
= dev
->driver
->pm
->runtime_resume
;
1840 return cb
? cb(dev
) : 0;
1843 #ifdef CONFIG_PM_SLEEP
1846 * pm_genpd_default_suspend - Default "device suspend" for PM domians.
1847 * @dev: Device to handle.
1849 static int pm_genpd_default_suspend(struct device
*dev
)
1851 int (*cb
)(struct device
*__dev
) = dev_gpd_data(dev
)->ops
.suspend
;
1853 return cb
? cb(dev
) : pm_generic_suspend(dev
);
1857 * pm_genpd_default_suspend_late - Default "late device suspend" for PM domians.
1858 * @dev: Device to handle.
1860 static int pm_genpd_default_suspend_late(struct device
*dev
)
1862 int (*cb
)(struct device
*__dev
) = dev_gpd_data(dev
)->ops
.suspend_late
;
1864 return cb
? cb(dev
) : pm_generic_suspend_late(dev
);
1868 * pm_genpd_default_resume_early - Default "early device resume" for PM domians.
1869 * @dev: Device to handle.
1871 static int pm_genpd_default_resume_early(struct device
*dev
)
1873 int (*cb
)(struct device
*__dev
) = dev_gpd_data(dev
)->ops
.resume_early
;
1875 return cb
? cb(dev
) : pm_generic_resume_early(dev
);
1879 * pm_genpd_default_resume - Default "device resume" for PM domians.
1880 * @dev: Device to handle.
1882 static int pm_genpd_default_resume(struct device
*dev
)
1884 int (*cb
)(struct device
*__dev
) = dev_gpd_data(dev
)->ops
.resume
;
1886 return cb
? cb(dev
) : pm_generic_resume(dev
);
1890 * pm_genpd_default_freeze - Default "device freeze" for PM domians.
1891 * @dev: Device to handle.
1893 static int pm_genpd_default_freeze(struct device
*dev
)
1895 int (*cb
)(struct device
*__dev
) = dev_gpd_data(dev
)->ops
.freeze
;
1897 return cb
? cb(dev
) : pm_generic_freeze(dev
);
1901 * pm_genpd_default_freeze_late - Default "late device freeze" for PM domians.
1902 * @dev: Device to handle.
1904 static int pm_genpd_default_freeze_late(struct device
*dev
)
1906 int (*cb
)(struct device
*__dev
) = dev_gpd_data(dev
)->ops
.freeze_late
;
1908 return cb
? cb(dev
) : pm_generic_freeze_late(dev
);
1912 * pm_genpd_default_thaw_early - Default "early device thaw" for PM domians.
1913 * @dev: Device to handle.
1915 static int pm_genpd_default_thaw_early(struct device
*dev
)
1917 int (*cb
)(struct device
*__dev
) = dev_gpd_data(dev
)->ops
.thaw_early
;
1919 return cb
? cb(dev
) : pm_generic_thaw_early(dev
);
1923 * pm_genpd_default_thaw - Default "device thaw" for PM domians.
1924 * @dev: Device to handle.
1926 static int pm_genpd_default_thaw(struct device
*dev
)
1928 int (*cb
)(struct device
*__dev
) = dev_gpd_data(dev
)->ops
.thaw
;
1930 return cb
? cb(dev
) : pm_generic_thaw(dev
);
1933 #else /* !CONFIG_PM_SLEEP */
1935 #define pm_genpd_default_suspend NULL
1936 #define pm_genpd_default_suspend_late NULL
1937 #define pm_genpd_default_resume_early NULL
1938 #define pm_genpd_default_resume NULL
1939 #define pm_genpd_default_freeze NULL
1940 #define pm_genpd_default_freeze_late NULL
1941 #define pm_genpd_default_thaw_early NULL
1942 #define pm_genpd_default_thaw NULL
1944 #endif /* !CONFIG_PM_SLEEP */
1947 * pm_genpd_init - Initialize a generic I/O PM domain object.
1948 * @genpd: PM domain object to initialize.
1949 * @gov: PM domain governor to associate with the domain (may be NULL).
1950 * @is_off: Initial value of the domain's power_is_off field.
1952 void pm_genpd_init(struct generic_pm_domain
*genpd
,
1953 struct dev_power_governor
*gov
, bool is_off
)
1955 if (IS_ERR_OR_NULL(genpd
))
1958 INIT_LIST_HEAD(&genpd
->master_links
);
1959 INIT_LIST_HEAD(&genpd
->slave_links
);
1960 INIT_LIST_HEAD(&genpd
->dev_list
);
1961 mutex_init(&genpd
->lock
);
1963 INIT_WORK(&genpd
->power_off_work
, genpd_power_off_work_fn
);
1964 genpd
->in_progress
= 0;
1965 atomic_set(&genpd
->sd_count
, 0);
1966 genpd
->status
= is_off
? GPD_STATE_POWER_OFF
: GPD_STATE_ACTIVE
;
1967 init_waitqueue_head(&genpd
->status_wait_queue
);
1968 genpd
->poweroff_task
= NULL
;
1969 genpd
->resume_count
= 0;
1970 genpd
->device_count
= 0;
1971 genpd
->max_off_time_ns
= -1;
1972 genpd
->max_off_time_changed
= true;
1973 genpd
->domain
.ops
.runtime_suspend
= pm_genpd_runtime_suspend
;
1974 genpd
->domain
.ops
.runtime_resume
= pm_genpd_runtime_resume
;
1975 genpd
->domain
.ops
.runtime_idle
= pm_generic_runtime_idle
;
1976 genpd
->domain
.ops
.prepare
= pm_genpd_prepare
;
1977 genpd
->domain
.ops
.suspend
= pm_genpd_suspend
;
1978 genpd
->domain
.ops
.suspend_late
= pm_genpd_suspend_late
;
1979 genpd
->domain
.ops
.suspend_noirq
= pm_genpd_suspend_noirq
;
1980 genpd
->domain
.ops
.resume_noirq
= pm_genpd_resume_noirq
;
1981 genpd
->domain
.ops
.resume_early
= pm_genpd_resume_early
;
1982 genpd
->domain
.ops
.resume
= pm_genpd_resume
;
1983 genpd
->domain
.ops
.freeze
= pm_genpd_freeze
;
1984 genpd
->domain
.ops
.freeze_late
= pm_genpd_freeze_late
;
1985 genpd
->domain
.ops
.freeze_noirq
= pm_genpd_freeze_noirq
;
1986 genpd
->domain
.ops
.thaw_noirq
= pm_genpd_thaw_noirq
;
1987 genpd
->domain
.ops
.thaw_early
= pm_genpd_thaw_early
;
1988 genpd
->domain
.ops
.thaw
= pm_genpd_thaw
;
1989 genpd
->domain
.ops
.poweroff
= pm_genpd_suspend
;
1990 genpd
->domain
.ops
.poweroff_late
= pm_genpd_suspend_late
;
1991 genpd
->domain
.ops
.poweroff_noirq
= pm_genpd_suspend_noirq
;
1992 genpd
->domain
.ops
.restore_noirq
= pm_genpd_restore_noirq
;
1993 genpd
->domain
.ops
.restore_early
= pm_genpd_resume_early
;
1994 genpd
->domain
.ops
.restore
= pm_genpd_resume
;
1995 genpd
->domain
.ops
.complete
= pm_genpd_complete
;
1996 genpd
->dev_ops
.save_state
= pm_genpd_default_save_state
;
1997 genpd
->dev_ops
.restore_state
= pm_genpd_default_restore_state
;
1998 genpd
->dev_ops
.suspend
= pm_genpd_default_suspend
;
1999 genpd
->dev_ops
.suspend_late
= pm_genpd_default_suspend_late
;
2000 genpd
->dev_ops
.resume_early
= pm_genpd_default_resume_early
;
2001 genpd
->dev_ops
.resume
= pm_genpd_default_resume
;
2002 genpd
->dev_ops
.freeze
= pm_genpd_default_freeze
;
2003 genpd
->dev_ops
.freeze_late
= pm_genpd_default_freeze_late
;
2004 genpd
->dev_ops
.thaw_early
= pm_genpd_default_thaw_early
;
2005 genpd
->dev_ops
.thaw
= pm_genpd_default_thaw
;
2006 mutex_lock(&gpd_list_lock
);
2007 list_add(&genpd
->gpd_list_node
, &gpd_list
);
2008 mutex_unlock(&gpd_list_lock
);