GNU Linux-libre 4.14.265-gnu1
[releases.git] / drivers / acpi / device_pm.c
1 /*
2  * drivers/acpi/device_pm.c - ACPI device power management routines.
3  *
4  * Copyright (C) 2012, Intel Corp.
5  * Author: Rafael J. Wysocki <rafael.j.wysocki@intel.com>
6  *
7  * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
8  *
9  *  This program is free software; you can redistribute it and/or modify
10  *  it under the terms of the GNU General Public License version 2 as published
11  *  by the Free Software Foundation.
12  *
13  *  This program is distributed in the hope that it will be useful, but
14  *  WITHOUT ANY WARRANTY; without even the implied warranty of
15  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
16  *  General Public License for more details.
17  *
18  * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
19  */
20
21 #include <linux/acpi.h>
22 #include <linux/export.h>
23 #include <linux/mutex.h>
24 #include <linux/pm_qos.h>
25 #include <linux/pm_domain.h>
26 #include <linux/pm_runtime.h>
27 #include <linux/suspend.h>
28
29 #include "internal.h"
30
31 #define _COMPONENT      ACPI_POWER_COMPONENT
32 ACPI_MODULE_NAME("device_pm");
33
34 /**
35  * acpi_power_state_string - String representation of ACPI device power state.
36  * @state: ACPI device power state to return the string representation of.
37  */
38 const char *acpi_power_state_string(int state)
39 {
40         switch (state) {
41         case ACPI_STATE_D0:
42                 return "D0";
43         case ACPI_STATE_D1:
44                 return "D1";
45         case ACPI_STATE_D2:
46                 return "D2";
47         case ACPI_STATE_D3_HOT:
48                 return "D3hot";
49         case ACPI_STATE_D3_COLD:
50                 return "D3cold";
51         default:
52                 return "(unknown)";
53         }
54 }
55
56 /**
57  * acpi_device_get_power - Get power state of an ACPI device.
58  * @device: Device to get the power state of.
59  * @state: Place to store the power state of the device.
60  *
61  * This function does not update the device's power.state field, but it may
62  * update its parent's power.state field (when the parent's power state is
63  * unknown and the device's power state turns out to be D0).
64  */
65 int acpi_device_get_power(struct acpi_device *device, int *state)
66 {
67         int result = ACPI_STATE_UNKNOWN;
68
69         if (!device || !state)
70                 return -EINVAL;
71
72         if (!device->flags.power_manageable) {
73                 /* TBD: Non-recursive algorithm for walking up hierarchy. */
74                 *state = device->parent ?
75                         device->parent->power.state : ACPI_STATE_D0;
76                 goto out;
77         }
78
79         /*
80          * Get the device's power state from power resources settings and _PSC,
81          * if available.
82          */
83         if (device->power.flags.power_resources) {
84                 int error = acpi_power_get_inferred_state(device, &result);
85                 if (error)
86                         return error;
87         }
88         if (device->power.flags.explicit_get) {
89                 acpi_handle handle = device->handle;
90                 unsigned long long psc;
91                 acpi_status status;
92
93                 status = acpi_evaluate_integer(handle, "_PSC", NULL, &psc);
94                 if (ACPI_FAILURE(status))
95                         return -ENODEV;
96
97                 /*
98                  * The power resources settings may indicate a power state
99                  * shallower than the actual power state of the device, because
100                  * the same power resources may be referenced by other devices.
101                  *
102                  * For systems predating ACPI 4.0 we assume that D3hot is the
103                  * deepest state that can be supported.
104                  */
105                 if (psc > result && psc < ACPI_STATE_D3_COLD)
106                         result = psc;
107                 else if (result == ACPI_STATE_UNKNOWN)
108                         result = psc > ACPI_STATE_D2 ? ACPI_STATE_D3_HOT : psc;
109         }
110
111         /*
112          * If we were unsure about the device parent's power state up to this
113          * point, the fact that the device is in D0 implies that the parent has
114          * to be in D0 too, except if ignore_parent is set.
115          */
116         if (!device->power.flags.ignore_parent && device->parent
117             && device->parent->power.state == ACPI_STATE_UNKNOWN
118             && result == ACPI_STATE_D0)
119                 device->parent->power.state = ACPI_STATE_D0;
120
121         *state = result;
122
123  out:
124         ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Device [%s] power state is %s\n",
125                           device->pnp.bus_id, acpi_power_state_string(*state)));
126
127         return 0;
128 }
129
130 static int acpi_dev_pm_explicit_set(struct acpi_device *adev, int state)
131 {
132         if (adev->power.states[state].flags.explicit_set) {
133                 char method[5] = { '_', 'P', 'S', '0' + state, '\0' };
134                 acpi_status status;
135
136                 status = acpi_evaluate_object(adev->handle, method, NULL, NULL);
137                 if (ACPI_FAILURE(status))
138                         return -ENODEV;
139         }
140         return 0;
141 }
142
143 /**
144  * acpi_device_set_power - Set power state of an ACPI device.
145  * @device: Device to set the power state of.
146  * @state: New power state to set.
147  *
148  * Callers must ensure that the device is power manageable before using this
149  * function.
150  */
151 int acpi_device_set_power(struct acpi_device *device, int state)
152 {
153         int target_state = state;
154         int result = 0;
155
156         if (!device || !device->flags.power_manageable
157             || (state < ACPI_STATE_D0) || (state > ACPI_STATE_D3_COLD))
158                 return -EINVAL;
159
160         /* Make sure this is a valid target state */
161
162         if (state == device->power.state) {
163                 ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Device [%s] already in %s\n",
164                                   device->pnp.bus_id,
165                                   acpi_power_state_string(state)));
166                 return 0;
167         }
168
169         if (state == ACPI_STATE_D3_COLD) {
170                 /*
171                  * For transitions to D3cold we need to execute _PS3 and then
172                  * possibly drop references to the power resources in use.
173                  */
174                 state = ACPI_STATE_D3_HOT;
175                 /* If D3cold is not supported, use D3hot as the target state. */
176                 if (!device->power.states[ACPI_STATE_D3_COLD].flags.valid)
177                         target_state = state;
178         } else if (!device->power.states[state].flags.valid) {
179                 dev_warn(&device->dev, "Power state %s not supported\n",
180                          acpi_power_state_string(state));
181                 return -ENODEV;
182         }
183
184         if (!device->power.flags.ignore_parent &&
185             device->parent && (state < device->parent->power.state)) {
186                 dev_warn(&device->dev,
187                          "Cannot transition to power state %s for parent in %s\n",
188                          acpi_power_state_string(state),
189                          acpi_power_state_string(device->parent->power.state));
190                 return -ENODEV;
191         }
192
193         /*
194          * Transition Power
195          * ----------------
196          * In accordance with ACPI 6, _PSx is executed before manipulating power
197          * resources, unless the target state is D0, in which case _PS0 is
198          * supposed to be executed after turning the power resources on.
199          */
200         if (state > ACPI_STATE_D0) {
201                 /*
202                  * According to ACPI 6, devices cannot go from lower-power
203                  * (deeper) states to higher-power (shallower) states.
204                  */
205                 if (state < device->power.state) {
206                         dev_warn(&device->dev, "Cannot transition from %s to %s\n",
207                                  acpi_power_state_string(device->power.state),
208                                  acpi_power_state_string(state));
209                         return -ENODEV;
210                 }
211
212                 result = acpi_dev_pm_explicit_set(device, state);
213                 if (result)
214                         goto end;
215
216                 if (device->power.flags.power_resources)
217                         result = acpi_power_transition(device, target_state);
218         } else {
219                 if (device->power.flags.power_resources) {
220                         result = acpi_power_transition(device, ACPI_STATE_D0);
221                         if (result)
222                                 goto end;
223                 }
224                 result = acpi_dev_pm_explicit_set(device, ACPI_STATE_D0);
225         }
226
227  end:
228         if (result) {
229                 dev_warn(&device->dev, "Failed to change power state to %s\n",
230                          acpi_power_state_string(target_state));
231         } else {
232                 device->power.state = target_state;
233                 ACPI_DEBUG_PRINT((ACPI_DB_INFO,
234                                   "Device [%s] transitioned to %s\n",
235                                   device->pnp.bus_id,
236                                   acpi_power_state_string(target_state)));
237         }
238
239         return result;
240 }
241 EXPORT_SYMBOL(acpi_device_set_power);
242
243 int acpi_bus_set_power(acpi_handle handle, int state)
244 {
245         struct acpi_device *device;
246         int result;
247
248         result = acpi_bus_get_device(handle, &device);
249         if (result)
250                 return result;
251
252         return acpi_device_set_power(device, state);
253 }
254 EXPORT_SYMBOL(acpi_bus_set_power);
255
256 int acpi_bus_init_power(struct acpi_device *device)
257 {
258         int state;
259         int result;
260
261         if (!device)
262                 return -EINVAL;
263
264         device->power.state = ACPI_STATE_UNKNOWN;
265         if (!acpi_device_is_present(device)) {
266                 device->flags.initialized = false;
267                 return -ENXIO;
268         }
269
270         result = acpi_device_get_power(device, &state);
271         if (result)
272                 return result;
273
274         if (state < ACPI_STATE_D3_COLD && device->power.flags.power_resources) {
275                 /* Reference count the power resources. */
276                 result = acpi_power_on_resources(device, state);
277                 if (result)
278                         return result;
279
280                 if (state == ACPI_STATE_D0) {
281                         /*
282                          * If _PSC is not present and the state inferred from
283                          * power resources appears to be D0, it still may be
284                          * necessary to execute _PS0 at this point, because
285                          * another device using the same power resources may
286                          * have been put into D0 previously and that's why we
287                          * see D0 here.
288                          */
289                         result = acpi_dev_pm_explicit_set(device, state);
290                         if (result)
291                                 return result;
292                 }
293         } else if (state == ACPI_STATE_UNKNOWN) {
294                 /*
295                  * No power resources and missing _PSC?  Cross fingers and make
296                  * it D0 in hope that this is what the BIOS put the device into.
297                  * [We tried to force D0 here by executing _PS0, but that broke
298                  * Toshiba P870-303 in a nasty way.]
299                  */
300                 state = ACPI_STATE_D0;
301         }
302         device->power.state = state;
303         return 0;
304 }
305
306 /**
307  * acpi_device_fix_up_power - Force device with missing _PSC into D0.
308  * @device: Device object whose power state is to be fixed up.
309  *
310  * Devices without power resources and _PSC, but having _PS0 and _PS3 defined,
311  * are assumed to be put into D0 by the BIOS.  However, in some cases that may
312  * not be the case and this function should be used then.
313  */
314 int acpi_device_fix_up_power(struct acpi_device *device)
315 {
316         int ret = 0;
317
318         if (!device->power.flags.power_resources
319             && !device->power.flags.explicit_get
320             && device->power.state == ACPI_STATE_D0)
321                 ret = acpi_dev_pm_explicit_set(device, ACPI_STATE_D0);
322
323         return ret;
324 }
325 EXPORT_SYMBOL_GPL(acpi_device_fix_up_power);
326
327 int acpi_device_update_power(struct acpi_device *device, int *state_p)
328 {
329         int state;
330         int result;
331
332         if (device->power.state == ACPI_STATE_UNKNOWN) {
333                 result = acpi_bus_init_power(device);
334                 if (!result && state_p)
335                         *state_p = device->power.state;
336
337                 return result;
338         }
339
340         result = acpi_device_get_power(device, &state);
341         if (result)
342                 return result;
343
344         if (state == ACPI_STATE_UNKNOWN) {
345                 state = ACPI_STATE_D0;
346                 result = acpi_device_set_power(device, state);
347                 if (result)
348                         return result;
349         } else {
350                 if (device->power.flags.power_resources) {
351                         /*
352                          * We don't need to really switch the state, bu we need
353                          * to update the power resources' reference counters.
354                          */
355                         result = acpi_power_transition(device, state);
356                         if (result)
357                                 return result;
358                 }
359                 device->power.state = state;
360         }
361         if (state_p)
362                 *state_p = state;
363
364         return 0;
365 }
366 EXPORT_SYMBOL_GPL(acpi_device_update_power);
367
368 int acpi_bus_update_power(acpi_handle handle, int *state_p)
369 {
370         struct acpi_device *device;
371         int result;
372
373         result = acpi_bus_get_device(handle, &device);
374         return result ? result : acpi_device_update_power(device, state_p);
375 }
376 EXPORT_SYMBOL_GPL(acpi_bus_update_power);
377
378 bool acpi_bus_power_manageable(acpi_handle handle)
379 {
380         struct acpi_device *device;
381         int result;
382
383         result = acpi_bus_get_device(handle, &device);
384         return result ? false : device->flags.power_manageable;
385 }
386 EXPORT_SYMBOL(acpi_bus_power_manageable);
387
388 #ifdef CONFIG_PM
389 static DEFINE_MUTEX(acpi_pm_notifier_lock);
390 static DEFINE_MUTEX(acpi_pm_notifier_install_lock);
391
392 void acpi_pm_wakeup_event(struct device *dev)
393 {
394         pm_wakeup_dev_event(dev, 0, acpi_s2idle_wakeup());
395 }
396 EXPORT_SYMBOL_GPL(acpi_pm_wakeup_event);
397
398 static void acpi_pm_notify_handler(acpi_handle handle, u32 val, void *not_used)
399 {
400         struct acpi_device *adev;
401
402         if (val != ACPI_NOTIFY_DEVICE_WAKE)
403                 return;
404
405         acpi_handle_debug(handle, "Wake notify\n");
406
407         adev = acpi_bus_get_acpi_device(handle);
408         if (!adev)
409                 return;
410
411         mutex_lock(&acpi_pm_notifier_lock);
412
413         if (adev->wakeup.flags.notifier_present) {
414                 pm_wakeup_ws_event(adev->wakeup.ws, 0, acpi_s2idle_wakeup());
415                 if (adev->wakeup.context.func) {
416                         acpi_handle_debug(handle, "Running %pF for %s\n",
417                                           adev->wakeup.context.func,
418                                           dev_name(adev->wakeup.context.dev));
419                         adev->wakeup.context.func(&adev->wakeup.context);
420                 }
421         }
422
423         mutex_unlock(&acpi_pm_notifier_lock);
424
425         acpi_bus_put_acpi_device(adev);
426 }
427
428 /**
429  * acpi_add_pm_notifier - Register PM notify handler for given ACPI device.
430  * @adev: ACPI device to add the notify handler for.
431  * @dev: Device to generate a wakeup event for while handling the notification.
432  * @func: Work function to execute when handling the notification.
433  *
434  * NOTE: @adev need not be a run-wake or wakeup device to be a valid source of
435  * PM wakeup events.  For example, wakeup events may be generated for bridges
436  * if one of the devices below the bridge is signaling wakeup, even if the
437  * bridge itself doesn't have a wakeup GPE associated with it.
438  */
439 acpi_status acpi_add_pm_notifier(struct acpi_device *adev, struct device *dev,
440                         void (*func)(struct acpi_device_wakeup_context *context))
441 {
442         acpi_status status = AE_ALREADY_EXISTS;
443
444         if (!dev && !func)
445                 return AE_BAD_PARAMETER;
446
447         mutex_lock(&acpi_pm_notifier_install_lock);
448
449         if (adev->wakeup.flags.notifier_present)
450                 goto out;
451
452         status = acpi_install_notify_handler(adev->handle, ACPI_SYSTEM_NOTIFY,
453                                              acpi_pm_notify_handler, NULL);
454         if (ACPI_FAILURE(status))
455                 goto out;
456
457         mutex_lock(&acpi_pm_notifier_lock);
458         adev->wakeup.ws = wakeup_source_register(dev_name(&adev->dev));
459         adev->wakeup.context.dev = dev;
460         adev->wakeup.context.func = func;
461         adev->wakeup.flags.notifier_present = true;
462         mutex_unlock(&acpi_pm_notifier_lock);
463
464  out:
465         mutex_unlock(&acpi_pm_notifier_install_lock);
466         return status;
467 }
468
469 /**
470  * acpi_remove_pm_notifier - Unregister PM notifier from given ACPI device.
471  * @adev: ACPI device to remove the notifier from.
472  */
473 acpi_status acpi_remove_pm_notifier(struct acpi_device *adev)
474 {
475         acpi_status status = AE_BAD_PARAMETER;
476
477         mutex_lock(&acpi_pm_notifier_install_lock);
478
479         if (!adev->wakeup.flags.notifier_present)
480                 goto out;
481
482         status = acpi_remove_notify_handler(adev->handle,
483                                             ACPI_SYSTEM_NOTIFY,
484                                             acpi_pm_notify_handler);
485         if (ACPI_FAILURE(status))
486                 goto out;
487
488         mutex_lock(&acpi_pm_notifier_lock);
489         adev->wakeup.context.func = NULL;
490         adev->wakeup.context.dev = NULL;
491         wakeup_source_unregister(adev->wakeup.ws);
492         adev->wakeup.flags.notifier_present = false;
493         mutex_unlock(&acpi_pm_notifier_lock);
494
495  out:
496         mutex_unlock(&acpi_pm_notifier_install_lock);
497         return status;
498 }
499
500 bool acpi_bus_can_wakeup(acpi_handle handle)
501 {
502         struct acpi_device *device;
503         int result;
504
505         result = acpi_bus_get_device(handle, &device);
506         return result ? false : device->wakeup.flags.valid;
507 }
508 EXPORT_SYMBOL(acpi_bus_can_wakeup);
509
510 bool acpi_pm_device_can_wakeup(struct device *dev)
511 {
512         struct acpi_device *adev = ACPI_COMPANION(dev);
513
514         return adev ? acpi_device_can_wakeup(adev) : false;
515 }
516
517 /**
518  * acpi_dev_pm_get_state - Get preferred power state of ACPI device.
519  * @dev: Device whose preferred target power state to return.
520  * @adev: ACPI device node corresponding to @dev.
521  * @target_state: System state to match the resultant device state.
522  * @d_min_p: Location to store the highest power state available to the device.
523  * @d_max_p: Location to store the lowest power state available to the device.
524  *
525  * Find the lowest power (highest number) and highest power (lowest number) ACPI
526  * device power states that the device can be in while the system is in the
527  * state represented by @target_state.  Store the integer numbers representing
528  * those stats in the memory locations pointed to by @d_max_p and @d_min_p,
529  * respectively.
530  *
531  * Callers must ensure that @dev and @adev are valid pointers and that @adev
532  * actually corresponds to @dev before using this function.
533  *
534  * Returns 0 on success or -ENODATA when one of the ACPI methods fails or
535  * returns a value that doesn't make sense.  The memory locations pointed to by
536  * @d_max_p and @d_min_p are only modified on success.
537  */
538 static int acpi_dev_pm_get_state(struct device *dev, struct acpi_device *adev,
539                                  u32 target_state, int *d_min_p, int *d_max_p)
540 {
541         char method[] = { '_', 'S', '0' + target_state, 'D', '\0' };
542         acpi_handle handle = adev->handle;
543         unsigned long long ret;
544         int d_min, d_max;
545         bool wakeup = false;
546         acpi_status status;
547
548         /*
549          * If the system state is S0, the lowest power state the device can be
550          * in is D3cold, unless the device has _S0W and is supposed to signal
551          * wakeup, in which case the return value of _S0W has to be used as the
552          * lowest power state available to the device.
553          */
554         d_min = ACPI_STATE_D0;
555         d_max = ACPI_STATE_D3_COLD;
556
557         /*
558          * If present, _SxD methods return the minimum D-state (highest power
559          * state) we can use for the corresponding S-states.  Otherwise, the
560          * minimum D-state is D0 (ACPI 3.x).
561          */
562         if (target_state > ACPI_STATE_S0) {
563                 /*
564                  * We rely on acpi_evaluate_integer() not clobbering the integer
565                  * provided if AE_NOT_FOUND is returned.
566                  */
567                 ret = d_min;
568                 status = acpi_evaluate_integer(handle, method, NULL, &ret);
569                 if ((ACPI_FAILURE(status) && status != AE_NOT_FOUND)
570                     || ret > ACPI_STATE_D3_COLD)
571                         return -ENODATA;
572
573                 /*
574                  * We need to handle legacy systems where D3hot and D3cold are
575                  * the same and 3 is returned in both cases, so fall back to
576                  * D3cold if D3hot is not a valid state.
577                  */
578                 if (!adev->power.states[ret].flags.valid) {
579                         if (ret == ACPI_STATE_D3_HOT)
580                                 ret = ACPI_STATE_D3_COLD;
581                         else
582                                 return -ENODATA;
583                 }
584                 d_min = ret;
585                 wakeup = device_may_wakeup(dev) && adev->wakeup.flags.valid
586                         && adev->wakeup.sleep_state >= target_state;
587         } else if (dev_pm_qos_flags(dev, PM_QOS_FLAG_REMOTE_WAKEUP) !=
588                         PM_QOS_FLAGS_NONE) {
589                 wakeup = adev->wakeup.flags.valid;
590         }
591
592         /*
593          * If _PRW says we can wake up the system from the target sleep state,
594          * the D-state returned by _SxD is sufficient for that (we assume a
595          * wakeup-aware driver if wake is set).  Still, if _SxW exists
596          * (ACPI 3.x), it should return the maximum (lowest power) D-state that
597          * can wake the system.  _S0W may be valid, too.
598          */
599         if (wakeup) {
600                 method[3] = 'W';
601                 status = acpi_evaluate_integer(handle, method, NULL, &ret);
602                 if (status == AE_NOT_FOUND) {
603                         if (target_state > ACPI_STATE_S0)
604                                 d_max = d_min;
605                 } else if (ACPI_SUCCESS(status) && ret <= ACPI_STATE_D3_COLD) {
606                         /* Fall back to D3cold if ret is not a valid state. */
607                         if (!adev->power.states[ret].flags.valid)
608                                 ret = ACPI_STATE_D3_COLD;
609
610                         d_max = ret > d_min ? ret : d_min;
611                 } else {
612                         return -ENODATA;
613                 }
614         }
615
616         if (d_min_p)
617                 *d_min_p = d_min;
618
619         if (d_max_p)
620                 *d_max_p = d_max;
621
622         return 0;
623 }
624
625 /**
626  * acpi_pm_device_sleep_state - Get preferred power state of ACPI device.
627  * @dev: Device whose preferred target power state to return.
628  * @d_min_p: Location to store the upper limit of the allowed states range.
629  * @d_max_in: Deepest low-power state to take into consideration.
630  * Return value: Preferred power state of the device on success, -ENODEV
631  * if there's no 'struct acpi_device' for @dev, -EINVAL if @d_max_in is
632  * incorrect, or -ENODATA on ACPI method failure.
633  *
634  * The caller must ensure that @dev is valid before using this function.
635  */
636 int acpi_pm_device_sleep_state(struct device *dev, int *d_min_p, int d_max_in)
637 {
638         struct acpi_device *adev;
639         int ret, d_min, d_max;
640
641         if (d_max_in < ACPI_STATE_D0 || d_max_in > ACPI_STATE_D3_COLD)
642                 return -EINVAL;
643
644         if (d_max_in > ACPI_STATE_D2) {
645                 enum pm_qos_flags_status stat;
646
647                 stat = dev_pm_qos_flags(dev, PM_QOS_FLAG_NO_POWER_OFF);
648                 if (stat == PM_QOS_FLAGS_ALL)
649                         d_max_in = ACPI_STATE_D2;
650         }
651
652         adev = ACPI_COMPANION(dev);
653         if (!adev) {
654                 dev_dbg(dev, "ACPI companion missing in %s!\n", __func__);
655                 return -ENODEV;
656         }
657
658         ret = acpi_dev_pm_get_state(dev, adev, acpi_target_system_state(),
659                                     &d_min, &d_max);
660         if (ret)
661                 return ret;
662
663         if (d_max_in < d_min)
664                 return -EINVAL;
665
666         if (d_max > d_max_in) {
667                 for (d_max = d_max_in; d_max > d_min; d_max--) {
668                         if (adev->power.states[d_max].flags.valid)
669                                 break;
670                 }
671         }
672
673         if (d_min_p)
674                 *d_min_p = d_min;
675
676         return d_max;
677 }
678 EXPORT_SYMBOL(acpi_pm_device_sleep_state);
679
680 /**
681  * acpi_pm_notify_work_func - ACPI devices wakeup notification work function.
682  * @context: Device wakeup context.
683  */
684 static void acpi_pm_notify_work_func(struct acpi_device_wakeup_context *context)
685 {
686         struct device *dev = context->dev;
687
688         if (dev) {
689                 pm_wakeup_event(dev, 0);
690                 pm_request_resume(dev);
691         }
692 }
693
694 static DEFINE_MUTEX(acpi_wakeup_lock);
695
696 static int __acpi_device_wakeup_enable(struct acpi_device *adev,
697                                        u32 target_state)
698 {
699         struct acpi_device_wakeup *wakeup = &adev->wakeup;
700         acpi_status status;
701         int error = 0;
702
703         mutex_lock(&acpi_wakeup_lock);
704
705         if (wakeup->enable_count >= INT_MAX) {
706                 acpi_handle_info(adev->handle, "Wakeup enable count out of bounds!\n");
707                 goto out;
708         }
709         if (wakeup->enable_count > 0)
710                 goto inc;
711
712         error = acpi_enable_wakeup_device_power(adev, target_state);
713         if (error)
714                 goto out;
715
716         status = acpi_enable_gpe(wakeup->gpe_device, wakeup->gpe_number);
717         if (ACPI_FAILURE(status)) {
718                 acpi_disable_wakeup_device_power(adev);
719                 error = -EIO;
720                 goto out;
721         }
722
723 inc:
724         wakeup->enable_count++;
725
726 out:
727         mutex_unlock(&acpi_wakeup_lock);
728         return error;
729 }
730
731 /**
732  * acpi_device_wakeup_enable - Enable wakeup functionality for device.
733  * @adev: ACPI device to enable wakeup functionality for.
734  * @target_state: State the system is transitioning into.
735  *
736  * Enable the GPE associated with @adev so that it can generate wakeup signals
737  * for the device in response to external (remote) events and enable wakeup
738  * power for it.
739  *
740  * Callers must ensure that @adev is a valid ACPI device node before executing
741  * this function.
742  */
743 static int acpi_device_wakeup_enable(struct acpi_device *adev, u32 target_state)
744 {
745         return __acpi_device_wakeup_enable(adev, target_state);
746 }
747
748 /**
749  * acpi_device_wakeup_disable - Disable wakeup functionality for device.
750  * @adev: ACPI device to disable wakeup functionality for.
751  *
752  * Disable the GPE associated with @adev and disable wakeup power for it.
753  *
754  * Callers must ensure that @adev is a valid ACPI device node before executing
755  * this function.
756  */
757 static void acpi_device_wakeup_disable(struct acpi_device *adev)
758 {
759         struct acpi_device_wakeup *wakeup = &adev->wakeup;
760
761         mutex_lock(&acpi_wakeup_lock);
762
763         if (!wakeup->enable_count)
764                 goto out;
765
766         acpi_disable_gpe(wakeup->gpe_device, wakeup->gpe_number);
767         acpi_disable_wakeup_device_power(adev);
768
769         wakeup->enable_count--;
770
771 out:
772         mutex_unlock(&acpi_wakeup_lock);
773 }
774
775 /**
776  * acpi_pm_set_device_wakeup - Enable/disable remote wakeup for given device.
777  * @dev: Device to enable/disable to generate wakeup events.
778  * @enable: Whether to enable or disable the wakeup functionality.
779  */
780 int acpi_pm_set_device_wakeup(struct device *dev, bool enable)
781 {
782         struct acpi_device *adev;
783         int error;
784
785         adev = ACPI_COMPANION(dev);
786         if (!adev) {
787                 dev_dbg(dev, "ACPI companion missing in %s!\n", __func__);
788                 return -ENODEV;
789         }
790
791         if (!acpi_device_can_wakeup(adev))
792                 return -EINVAL;
793
794         if (!enable) {
795                 acpi_device_wakeup_disable(adev);
796                 dev_dbg(dev, "Wakeup disabled by ACPI\n");
797                 return 0;
798         }
799
800         error = __acpi_device_wakeup_enable(adev, acpi_target_system_state());
801         if (!error)
802                 dev_dbg(dev, "Wakeup enabled by ACPI\n");
803
804         return error;
805 }
806 EXPORT_SYMBOL_GPL(acpi_pm_set_device_wakeup);
807
808 /**
809  * acpi_dev_pm_low_power - Put ACPI device into a low-power state.
810  * @dev: Device to put into a low-power state.
811  * @adev: ACPI device node corresponding to @dev.
812  * @system_state: System state to choose the device state for.
813  */
814 static int acpi_dev_pm_low_power(struct device *dev, struct acpi_device *adev,
815                                  u32 system_state)
816 {
817         int ret, state;
818
819         if (!acpi_device_power_manageable(adev))
820                 return 0;
821
822         ret = acpi_dev_pm_get_state(dev, adev, system_state, NULL, &state);
823         return ret ? ret : acpi_device_set_power(adev, state);
824 }
825
826 /**
827  * acpi_dev_pm_full_power - Put ACPI device into the full-power state.
828  * @adev: ACPI device node to put into the full-power state.
829  */
830 static int acpi_dev_pm_full_power(struct acpi_device *adev)
831 {
832         return acpi_device_power_manageable(adev) ?
833                 acpi_device_set_power(adev, ACPI_STATE_D0) : 0;
834 }
835
836 /**
837  * acpi_dev_runtime_suspend - Put device into a low-power state using ACPI.
838  * @dev: Device to put into a low-power state.
839  *
840  * Put the given device into a runtime low-power state using the standard ACPI
841  * mechanism.  Set up remote wakeup if desired, choose the state to put the
842  * device into (this checks if remote wakeup is expected to work too), and set
843  * the power state of the device.
844  */
845 int acpi_dev_runtime_suspend(struct device *dev)
846 {
847         struct acpi_device *adev = ACPI_COMPANION(dev);
848         bool remote_wakeup;
849         int error;
850
851         if (!adev)
852                 return 0;
853
854         remote_wakeup = dev_pm_qos_flags(dev, PM_QOS_FLAG_REMOTE_WAKEUP) >
855                                 PM_QOS_FLAGS_NONE;
856         if (remote_wakeup) {
857                 error = acpi_device_wakeup_enable(adev, ACPI_STATE_S0);
858                 if (error)
859                         return -EAGAIN;
860         }
861
862         error = acpi_dev_pm_low_power(dev, adev, ACPI_STATE_S0);
863         if (error && remote_wakeup)
864                 acpi_device_wakeup_disable(adev);
865
866         return error;
867 }
868 EXPORT_SYMBOL_GPL(acpi_dev_runtime_suspend);
869
870 /**
871  * acpi_dev_runtime_resume - Put device into the full-power state using ACPI.
872  * @dev: Device to put into the full-power state.
873  *
874  * Put the given device into the full-power state using the standard ACPI
875  * mechanism at run time.  Set the power state of the device to ACPI D0 and
876  * disable remote wakeup.
877  */
878 int acpi_dev_runtime_resume(struct device *dev)
879 {
880         struct acpi_device *adev = ACPI_COMPANION(dev);
881         int error;
882
883         if (!adev)
884                 return 0;
885
886         error = acpi_dev_pm_full_power(adev);
887         acpi_device_wakeup_disable(adev);
888         return error;
889 }
890 EXPORT_SYMBOL_GPL(acpi_dev_runtime_resume);
891
892 /**
893  * acpi_subsys_runtime_suspend - Suspend device using ACPI.
894  * @dev: Device to suspend.
895  *
896  * Carry out the generic runtime suspend procedure for @dev and use ACPI to put
897  * it into a runtime low-power state.
898  */
899 int acpi_subsys_runtime_suspend(struct device *dev)
900 {
901         int ret = pm_generic_runtime_suspend(dev);
902         return ret ? ret : acpi_dev_runtime_suspend(dev);
903 }
904 EXPORT_SYMBOL_GPL(acpi_subsys_runtime_suspend);
905
906 /**
907  * acpi_subsys_runtime_resume - Resume device using ACPI.
908  * @dev: Device to Resume.
909  *
910  * Use ACPI to put the given device into the full-power state and carry out the
911  * generic runtime resume procedure for it.
912  */
913 int acpi_subsys_runtime_resume(struct device *dev)
914 {
915         int ret = acpi_dev_runtime_resume(dev);
916         return ret ? ret : pm_generic_runtime_resume(dev);
917 }
918 EXPORT_SYMBOL_GPL(acpi_subsys_runtime_resume);
919
920 #ifdef CONFIG_PM_SLEEP
921 /**
922  * acpi_dev_suspend_late - Put device into a low-power state using ACPI.
923  * @dev: Device to put into a low-power state.
924  *
925  * Put the given device into a low-power state during system transition to a
926  * sleep state using the standard ACPI mechanism.  Set up system wakeup if
927  * desired, choose the state to put the device into (this checks if system
928  * wakeup is expected to work too), and set the power state of the device.
929  */
930 int acpi_dev_suspend_late(struct device *dev)
931 {
932         struct acpi_device *adev = ACPI_COMPANION(dev);
933         u32 target_state;
934         bool wakeup;
935         int error;
936
937         if (!adev)
938                 return 0;
939
940         target_state = acpi_target_system_state();
941         wakeup = device_may_wakeup(dev) && acpi_device_can_wakeup(adev);
942         if (wakeup) {
943                 error = acpi_device_wakeup_enable(adev, target_state);
944                 if (error)
945                         return error;
946         }
947
948         error = acpi_dev_pm_low_power(dev, adev, target_state);
949         if (error && wakeup)
950                 acpi_device_wakeup_disable(adev);
951
952         return error;
953 }
954 EXPORT_SYMBOL_GPL(acpi_dev_suspend_late);
955
956 /**
957  * acpi_dev_resume_early - Put device into the full-power state using ACPI.
958  * @dev: Device to put into the full-power state.
959  *
960  * Put the given device into the full-power state using the standard ACPI
961  * mechanism during system transition to the working state.  Set the power
962  * state of the device to ACPI D0 and disable remote wakeup.
963  */
964 int acpi_dev_resume_early(struct device *dev)
965 {
966         struct acpi_device *adev = ACPI_COMPANION(dev);
967         int error;
968
969         if (!adev)
970                 return 0;
971
972         error = acpi_dev_pm_full_power(adev);
973         acpi_device_wakeup_disable(adev);
974         return error;
975 }
976 EXPORT_SYMBOL_GPL(acpi_dev_resume_early);
977
978 /**
979  * acpi_subsys_prepare - Prepare device for system transition to a sleep state.
980  * @dev: Device to prepare.
981  */
982 int acpi_subsys_prepare(struct device *dev)
983 {
984         struct acpi_device *adev = ACPI_COMPANION(dev);
985         u32 sys_target;
986         int ret, state;
987
988         ret = pm_generic_prepare(dev);
989         if (ret < 0)
990                 return ret;
991
992         if (!adev || !pm_runtime_suspended(dev)
993             || device_may_wakeup(dev) != !!adev->wakeup.prepare_count)
994                 return 0;
995
996         sys_target = acpi_target_system_state();
997         if (sys_target == ACPI_STATE_S0)
998                 return 1;
999
1000         if (adev->power.flags.dsw_present)
1001                 return 0;
1002
1003         ret = acpi_dev_pm_get_state(dev, adev, sys_target, NULL, &state);
1004         return !ret && state == adev->power.state;
1005 }
1006 EXPORT_SYMBOL_GPL(acpi_subsys_prepare);
1007
1008 /**
1009  * acpi_subsys_suspend - Run the device driver's suspend callback.
1010  * @dev: Device to handle.
1011  *
1012  * Follow PCI and resume devices suspended at run time before running their
1013  * system suspend callbacks.
1014  */
1015 int acpi_subsys_suspend(struct device *dev)
1016 {
1017         pm_runtime_resume(dev);
1018         return pm_generic_suspend(dev);
1019 }
1020 EXPORT_SYMBOL_GPL(acpi_subsys_suspend);
1021
1022 /**
1023  * acpi_subsys_suspend_late - Suspend device using ACPI.
1024  * @dev: Device to suspend.
1025  *
1026  * Carry out the generic late suspend procedure for @dev and use ACPI to put
1027  * it into a low-power state during system transition into a sleep state.
1028  */
1029 int acpi_subsys_suspend_late(struct device *dev)
1030 {
1031         int ret = pm_generic_suspend_late(dev);
1032         return ret ? ret : acpi_dev_suspend_late(dev);
1033 }
1034 EXPORT_SYMBOL_GPL(acpi_subsys_suspend_late);
1035
1036 /**
1037  * acpi_subsys_resume_early - Resume device using ACPI.
1038  * @dev: Device to Resume.
1039  *
1040  * Use ACPI to put the given device into the full-power state and carry out the
1041  * generic early resume procedure for it during system transition into the
1042  * working state.
1043  */
1044 int acpi_subsys_resume_early(struct device *dev)
1045 {
1046         int ret = acpi_dev_resume_early(dev);
1047         return ret ? ret : pm_generic_resume_early(dev);
1048 }
1049 EXPORT_SYMBOL_GPL(acpi_subsys_resume_early);
1050
1051 /**
1052  * acpi_subsys_freeze - Run the device driver's freeze callback.
1053  * @dev: Device to handle.
1054  */
1055 int acpi_subsys_freeze(struct device *dev)
1056 {
1057         /*
1058          * This used to be done in acpi_subsys_prepare() for all devices and
1059          * some drivers may depend on it, so do it here.  Ideally, however,
1060          * runtime-suspended devices should not be touched during freeze/thaw
1061          * transitions.
1062          */
1063         pm_runtime_resume(dev);
1064         return pm_generic_freeze(dev);
1065 }
1066 EXPORT_SYMBOL_GPL(acpi_subsys_freeze);
1067
1068 #endif /* CONFIG_PM_SLEEP */
1069
1070 static struct dev_pm_domain acpi_general_pm_domain = {
1071         .ops = {
1072                 .runtime_suspend = acpi_subsys_runtime_suspend,
1073                 .runtime_resume = acpi_subsys_runtime_resume,
1074 #ifdef CONFIG_PM_SLEEP
1075                 .prepare = acpi_subsys_prepare,
1076                 .complete = pm_complete_with_resume_check,
1077                 .suspend = acpi_subsys_suspend,
1078                 .suspend_late = acpi_subsys_suspend_late,
1079                 .resume_early = acpi_subsys_resume_early,
1080                 .freeze = acpi_subsys_freeze,
1081                 .poweroff = acpi_subsys_suspend,
1082                 .poweroff_late = acpi_subsys_suspend_late,
1083                 .restore_early = acpi_subsys_resume_early,
1084 #endif
1085         },
1086 };
1087
1088 /**
1089  * acpi_dev_pm_detach - Remove ACPI power management from the device.
1090  * @dev: Device to take care of.
1091  * @power_off: Whether or not to try to remove power from the device.
1092  *
1093  * Remove the device from the general ACPI PM domain and remove its wakeup
1094  * notifier.  If @power_off is set, additionally remove power from the device if
1095  * possible.
1096  *
1097  * Callers must ensure proper synchronization of this function with power
1098  * management callbacks.
1099  */
1100 static void acpi_dev_pm_detach(struct device *dev, bool power_off)
1101 {
1102         struct acpi_device *adev = ACPI_COMPANION(dev);
1103
1104         if (adev && dev->pm_domain == &acpi_general_pm_domain) {
1105                 dev_pm_domain_set(dev, NULL);
1106                 acpi_remove_pm_notifier(adev);
1107                 if (power_off) {
1108                         /*
1109                          * If the device's PM QoS resume latency limit or flags
1110                          * have been exposed to user space, they have to be
1111                          * hidden at this point, so that they don't affect the
1112                          * choice of the low-power state to put the device into.
1113                          */
1114                         dev_pm_qos_hide_latency_limit(dev);
1115                         dev_pm_qos_hide_flags(dev);
1116                         acpi_device_wakeup_disable(adev);
1117                         acpi_dev_pm_low_power(dev, adev, ACPI_STATE_S0);
1118                 }
1119         }
1120 }
1121
1122 /**
1123  * acpi_dev_pm_attach - Prepare device for ACPI power management.
1124  * @dev: Device to prepare.
1125  * @power_on: Whether or not to power on the device.
1126  *
1127  * If @dev has a valid ACPI handle that has a valid struct acpi_device object
1128  * attached to it, install a wakeup notification handler for the device and
1129  * add it to the general ACPI PM domain.  If @power_on is set, the device will
1130  * be put into the ACPI D0 state before the function returns.
1131  *
1132  * This assumes that the @dev's bus type uses generic power management callbacks
1133  * (or doesn't use any power management callbacks at all).
1134  *
1135  * Callers must ensure proper synchronization of this function with power
1136  * management callbacks.
1137  */
1138 int acpi_dev_pm_attach(struct device *dev, bool power_on)
1139 {
1140         /*
1141          * Skip devices whose ACPI companions match the device IDs below,
1142          * because they require special power management handling incompatible
1143          * with the generic ACPI PM domain.
1144          */
1145         static const struct acpi_device_id special_pm_ids[] = {
1146                 {"PNP0C0B", }, /* Generic ACPI fan */
1147                 {"INT3404", }, /* Fan */
1148                 {}
1149         };
1150         struct acpi_device *adev = ACPI_COMPANION(dev);
1151
1152         if (!adev || !acpi_match_device_ids(adev, special_pm_ids))
1153                 return -ENODEV;
1154
1155         if (dev->pm_domain)
1156                 return -EEXIST;
1157
1158         /*
1159          * Only attach the power domain to the first device if the
1160          * companion is shared by multiple. This is to prevent doing power
1161          * management twice.
1162          */
1163         if (!acpi_device_is_first_physical_node(adev, dev))
1164                 return -EBUSY;
1165
1166         acpi_add_pm_notifier(adev, dev, acpi_pm_notify_work_func);
1167         dev_pm_domain_set(dev, &acpi_general_pm_domain);
1168         if (power_on) {
1169                 acpi_dev_pm_full_power(adev);
1170                 acpi_device_wakeup_disable(adev);
1171         }
1172
1173         dev->pm_domain->detach = acpi_dev_pm_detach;
1174         return 0;
1175 }
1176 EXPORT_SYMBOL_GPL(acpi_dev_pm_attach);
1177 #endif /* CONFIG_PM */