1 // SPDX-License-Identifier: GPL-2.0-or-later
2 /*
3 * drivers/acpi/power.c - ACPI Power Resources management.
4 *
5 * Copyright (C) 2001 - 2015 Intel Corp.
6 * Author: Andy Grover <andrew.grover@intel.com>
7 * Author: Paul Diefenbaugh <paul.s.diefenbaugh@intel.com>
8 * Author: Rafael J. Wysocki <rafael.j.wysocki@intel.com>
9 */
10
11 /*
12 * ACPI power-managed devices may be controlled in two ways:
13 * 1. via "Device Specific (D-State) Control"
14 * 2. via "Power Resource Control".
15 * The code below deals with ACPI Power Resources control.
16 *
17 * An ACPI "power resource object" represents a software controllable power
18 * plane, clock plane, or other resource depended on by a device.
19 *
20 * A device may rely on multiple power resources, and a power resource
21 * may be shared by multiple devices.
22 */
23
24 #define pr_fmt(fmt) "ACPI: PM: " fmt
25
26 #include <linux/kernel.h>
27 #include <linux/module.h>
28 #include <linux/init.h>
29 #include <linux/types.h>
30 #include <linux/slab.h>
31 #include <linux/pm_runtime.h>
32 #include <linux/sysfs.h>
33 #include <linux/acpi.h>
34 #include "sleep.h"
35 #include "internal.h"
36
37 #define ACPI_POWER_CLASS "power_resource"
38 #define ACPI_POWER_DEVICE_NAME "Power Resource"
39 #define ACPI_POWER_RESOURCE_STATE_OFF 0x00
40 #define ACPI_POWER_RESOURCE_STATE_ON 0x01
41 #define ACPI_POWER_RESOURCE_STATE_UNKNOWN 0xFF
42
43 struct acpi_power_dependent_device {
44 struct device *dev;
45 struct list_head node;
46 };
47
48 struct acpi_power_resource {
49 struct acpi_device device;
50 struct list_head list_node;
51 char *name;
52 u32 system_level;
53 u32 order;
54 unsigned int ref_count;
55 bool wakeup_enabled;
56 struct mutex resource_lock;
57 struct list_head dependents;
58 };
59
60 struct acpi_power_resource_entry {
61 struct list_head node;
62 struct acpi_power_resource *resource;
63 };
64
65 static LIST_HEAD(acpi_power_resource_list);
66 static DEFINE_MUTEX(power_resource_list_lock);
67
68 /* --------------------------------------------------------------------------
69 Power Resource Management
70 -------------------------------------------------------------------------- */
71
72 static inline
to_power_resource(struct acpi_device * device)73 struct acpi_power_resource *to_power_resource(struct acpi_device *device)
74 {
75 return container_of(device, struct acpi_power_resource, device);
76 }
77
acpi_power_get_context(acpi_handle handle)78 static struct acpi_power_resource *acpi_power_get_context(acpi_handle handle)
79 {
80 struct acpi_device *device;
81
82 if (acpi_bus_get_device(handle, &device))
83 return NULL;
84
85 return to_power_resource(device);
86 }
87
acpi_power_resources_list_add(acpi_handle handle,struct list_head * list)88 static int acpi_power_resources_list_add(acpi_handle handle,
89 struct list_head *list)
90 {
91 struct acpi_power_resource *resource = acpi_power_get_context(handle);
92 struct acpi_power_resource_entry *entry;
93
94 if (!resource || !list)
95 return -EINVAL;
96
97 entry = kzalloc(sizeof(*entry), GFP_KERNEL);
98 if (!entry)
99 return -ENOMEM;
100
101 entry->resource = resource;
102 if (!list_empty(list)) {
103 struct acpi_power_resource_entry *e;
104
105 list_for_each_entry(e, list, node)
106 if (e->resource->order > resource->order) {
107 list_add_tail(&entry->node, &e->node);
108 return 0;
109 }
110 }
111 list_add_tail(&entry->node, list);
112 return 0;
113 }
114
acpi_power_resources_list_free(struct list_head * list)115 void acpi_power_resources_list_free(struct list_head *list)
116 {
117 struct acpi_power_resource_entry *entry, *e;
118
119 list_for_each_entry_safe(entry, e, list, node) {
120 list_del(&entry->node);
121 kfree(entry);
122 }
123 }
124
acpi_power_resource_is_dup(union acpi_object * package,unsigned int start,unsigned int i)125 static bool acpi_power_resource_is_dup(union acpi_object *package,
126 unsigned int start, unsigned int i)
127 {
128 acpi_handle rhandle, dup;
129 unsigned int j;
130
131 /* The caller is expected to check the package element types */
132 rhandle = package->package.elements[i].reference.handle;
133 for (j = start; j < i; j++) {
134 dup = package->package.elements[j].reference.handle;
135 if (dup == rhandle)
136 return true;
137 }
138
139 return false;
140 }
141
acpi_extract_power_resources(union acpi_object * package,unsigned int start,struct list_head * list)142 int acpi_extract_power_resources(union acpi_object *package, unsigned int start,
143 struct list_head *list)
144 {
145 unsigned int i;
146 int err = 0;
147
148 for (i = start; i < package->package.count; i++) {
149 union acpi_object *element = &package->package.elements[i];
150 acpi_handle rhandle;
151
152 if (element->type != ACPI_TYPE_LOCAL_REFERENCE) {
153 err = -ENODATA;
154 break;
155 }
156 rhandle = element->reference.handle;
157 if (!rhandle) {
158 err = -ENODEV;
159 break;
160 }
161
162 /* Some ACPI tables contain duplicate power resource references */
163 if (acpi_power_resource_is_dup(package, start, i))
164 continue;
165
166 err = acpi_add_power_resource(rhandle);
167 if (err)
168 break;
169
170 err = acpi_power_resources_list_add(rhandle, list);
171 if (err)
172 break;
173 }
174 if (err)
175 acpi_power_resources_list_free(list);
176
177 return err;
178 }
179
acpi_power_get_state(acpi_handle handle,int * state)180 static int acpi_power_get_state(acpi_handle handle, int *state)
181 {
182 acpi_status status = AE_OK;
183 unsigned long long sta = 0;
184
185 if (!handle || !state)
186 return -EINVAL;
187
188 status = acpi_evaluate_integer(handle, "_STA", NULL, &sta);
189 if (ACPI_FAILURE(status))
190 return -ENODEV;
191
192 *state = (sta & 0x01)?ACPI_POWER_RESOURCE_STATE_ON:
193 ACPI_POWER_RESOURCE_STATE_OFF;
194
195 acpi_handle_debug(handle, "Power resource is %s\n",
196 *state ? "on" : "off");
197
198 return 0;
199 }
200
acpi_power_get_list_state(struct list_head * list,int * state)201 static int acpi_power_get_list_state(struct list_head *list, int *state)
202 {
203 struct acpi_power_resource_entry *entry;
204 int cur_state;
205
206 if (!list || !state)
207 return -EINVAL;
208
209 /* The state of the list is 'on' IFF all resources are 'on'. */
210 cur_state = 0;
211 list_for_each_entry(entry, list, node) {
212 struct acpi_power_resource *resource = entry->resource;
213 acpi_handle handle = resource->device.handle;
214 int result;
215
216 mutex_lock(&resource->resource_lock);
217 result = acpi_power_get_state(handle, &cur_state);
218 mutex_unlock(&resource->resource_lock);
219 if (result)
220 return result;
221
222 if (cur_state != ACPI_POWER_RESOURCE_STATE_ON)
223 break;
224 }
225
226 pr_debug("Power resource list is %s\n", cur_state ? "on" : "off");
227
228 *state = cur_state;
229 return 0;
230 }
231
232 static int
acpi_power_resource_add_dependent(struct acpi_power_resource * resource,struct device * dev)233 acpi_power_resource_add_dependent(struct acpi_power_resource *resource,
234 struct device *dev)
235 {
236 struct acpi_power_dependent_device *dep;
237 int ret = 0;
238
239 mutex_lock(&resource->resource_lock);
240 list_for_each_entry(dep, &resource->dependents, node) {
241 /* Only add it once */
242 if (dep->dev == dev)
243 goto unlock;
244 }
245
246 dep = kzalloc(sizeof(*dep), GFP_KERNEL);
247 if (!dep) {
248 ret = -ENOMEM;
249 goto unlock;
250 }
251
252 dep->dev = dev;
253 list_add_tail(&dep->node, &resource->dependents);
254 dev_dbg(dev, "added power dependency to [%s]\n", resource->name);
255
256 unlock:
257 mutex_unlock(&resource->resource_lock);
258 return ret;
259 }
260
261 static void
acpi_power_resource_remove_dependent(struct acpi_power_resource * resource,struct device * dev)262 acpi_power_resource_remove_dependent(struct acpi_power_resource *resource,
263 struct device *dev)
264 {
265 struct acpi_power_dependent_device *dep;
266
267 mutex_lock(&resource->resource_lock);
268 list_for_each_entry(dep, &resource->dependents, node) {
269 if (dep->dev == dev) {
270 list_del(&dep->node);
271 kfree(dep);
272 dev_dbg(dev, "removed power dependency to [%s]\n",
273 resource->name);
274 break;
275 }
276 }
277 mutex_unlock(&resource->resource_lock);
278 }
279
280 /**
281 * acpi_device_power_add_dependent - Add dependent device of this ACPI device
282 * @adev: ACPI device pointer
283 * @dev: Dependent device
284 *
285 * If @adev has non-empty _PR0 the @dev is added as dependent device to all
286 * power resources returned by it. This means that whenever these power
287 * resources are turned _ON the dependent devices get runtime resumed. This
288 * is needed for devices such as PCI to allow its driver to re-initialize
289 * it after it went to D0uninitialized.
290 *
291 * If @adev does not have _PR0 this does nothing.
292 *
293 * Returns %0 in case of success and negative errno otherwise.
294 */
acpi_device_power_add_dependent(struct acpi_device * adev,struct device * dev)295 int acpi_device_power_add_dependent(struct acpi_device *adev,
296 struct device *dev)
297 {
298 struct acpi_power_resource_entry *entry;
299 struct list_head *resources;
300 int ret;
301
302 if (!adev->flags.power_manageable)
303 return 0;
304
305 resources = &adev->power.states[ACPI_STATE_D0].resources;
306 list_for_each_entry(entry, resources, node) {
307 ret = acpi_power_resource_add_dependent(entry->resource, dev);
308 if (ret)
309 goto err;
310 }
311
312 return 0;
313
314 err:
315 list_for_each_entry(entry, resources, node)
316 acpi_power_resource_remove_dependent(entry->resource, dev);
317
318 return ret;
319 }
320
321 /**
322 * acpi_device_power_remove_dependent - Remove dependent device
323 * @adev: ACPI device pointer
324 * @dev: Dependent device
325 *
326 * Does the opposite of acpi_device_power_add_dependent() and removes the
327 * dependent device if it is found. Can be called to @adev that does not
328 * have _PR0 as well.
329 */
acpi_device_power_remove_dependent(struct acpi_device * adev,struct device * dev)330 void acpi_device_power_remove_dependent(struct acpi_device *adev,
331 struct device *dev)
332 {
333 struct acpi_power_resource_entry *entry;
334 struct list_head *resources;
335
336 if (!adev->flags.power_manageable)
337 return;
338
339 resources = &adev->power.states[ACPI_STATE_D0].resources;
340 list_for_each_entry_reverse(entry, resources, node)
341 acpi_power_resource_remove_dependent(entry->resource, dev);
342 }
343
__acpi_power_on(struct acpi_power_resource * resource)344 static int __acpi_power_on(struct acpi_power_resource *resource)
345 {
346 struct acpi_power_dependent_device *dep;
347 acpi_status status = AE_OK;
348
349 status = acpi_evaluate_object(resource->device.handle, "_ON", NULL, NULL);
350 if (ACPI_FAILURE(status))
351 return -ENODEV;
352
353 pr_debug("Power resource [%s] turned on\n", resource->name);
354
355 /*
356 * If there are other dependents on this power resource we need to
357 * resume them now so that their drivers can re-initialize the
358 * hardware properly after it went back to D0.
359 */
360 if (list_empty(&resource->dependents) ||
361 list_is_singular(&resource->dependents))
362 return 0;
363
364 list_for_each_entry(dep, &resource->dependents, node) {
365 dev_dbg(dep->dev, "runtime resuming because [%s] turned on\n",
366 resource->name);
367 pm_request_resume(dep->dev);
368 }
369
370 return 0;
371 }
372
acpi_power_on_unlocked(struct acpi_power_resource * resource)373 static int acpi_power_on_unlocked(struct acpi_power_resource *resource)
374 {
375 int result = 0;
376
377 if (resource->ref_count++) {
378 pr_debug("Power resource [%s] already on\n", resource->name);
379 } else {
380 result = __acpi_power_on(resource);
381 if (result)
382 resource->ref_count--;
383 }
384 return result;
385 }
386
acpi_power_on(struct acpi_power_resource * resource)387 static int acpi_power_on(struct acpi_power_resource *resource)
388 {
389 int result;
390
391 mutex_lock(&resource->resource_lock);
392 result = acpi_power_on_unlocked(resource);
393 mutex_unlock(&resource->resource_lock);
394 return result;
395 }
396
__acpi_power_off(struct acpi_power_resource * resource)397 static int __acpi_power_off(struct acpi_power_resource *resource)
398 {
399 acpi_status status;
400
401 status = acpi_evaluate_object(resource->device.handle, "_OFF",
402 NULL, NULL);
403 if (ACPI_FAILURE(status))
404 return -ENODEV;
405
406 pr_debug("Power resource [%s] turned off\n", resource->name);
407
408 return 0;
409 }
410
acpi_power_off_unlocked(struct acpi_power_resource * resource)411 static int acpi_power_off_unlocked(struct acpi_power_resource *resource)
412 {
413 int result = 0;
414
415 if (!resource->ref_count) {
416 pr_debug("Power resource [%s] already off\n", resource->name);
417 return 0;
418 }
419
420 if (--resource->ref_count) {
421 pr_debug("Power resource [%s] still in use\n", resource->name);
422 } else {
423 result = __acpi_power_off(resource);
424 if (result)
425 resource->ref_count++;
426 }
427 return result;
428 }
429
acpi_power_off(struct acpi_power_resource * resource)430 static int acpi_power_off(struct acpi_power_resource *resource)
431 {
432 int result;
433
434 mutex_lock(&resource->resource_lock);
435 result = acpi_power_off_unlocked(resource);
436 mutex_unlock(&resource->resource_lock);
437 return result;
438 }
439
acpi_power_off_list(struct list_head * list)440 static int acpi_power_off_list(struct list_head *list)
441 {
442 struct acpi_power_resource_entry *entry;
443 int result = 0;
444
445 list_for_each_entry_reverse(entry, list, node) {
446 result = acpi_power_off(entry->resource);
447 if (result)
448 goto err;
449 }
450 return 0;
451
452 err:
453 list_for_each_entry_continue(entry, list, node)
454 acpi_power_on(entry->resource);
455
456 return result;
457 }
458
acpi_power_on_list(struct list_head * list)459 static int acpi_power_on_list(struct list_head *list)
460 {
461 struct acpi_power_resource_entry *entry;
462 int result = 0;
463
464 list_for_each_entry(entry, list, node) {
465 result = acpi_power_on(entry->resource);
466 if (result)
467 goto err;
468 }
469 return 0;
470
471 err:
472 list_for_each_entry_continue_reverse(entry, list, node)
473 acpi_power_off(entry->resource);
474
475 return result;
476 }
477
478 static struct attribute *attrs[] = {
479 NULL,
480 };
481
482 static const struct attribute_group attr_groups[] = {
483 [ACPI_STATE_D0] = {
484 .name = "power_resources_D0",
485 .attrs = attrs,
486 },
487 [ACPI_STATE_D1] = {
488 .name = "power_resources_D1",
489 .attrs = attrs,
490 },
491 [ACPI_STATE_D2] = {
492 .name = "power_resources_D2",
493 .attrs = attrs,
494 },
495 [ACPI_STATE_D3_HOT] = {
496 .name = "power_resources_D3hot",
497 .attrs = attrs,
498 },
499 };
500
501 static const struct attribute_group wakeup_attr_group = {
502 .name = "power_resources_wakeup",
503 .attrs = attrs,
504 };
505
acpi_power_hide_list(struct acpi_device * adev,struct list_head * resources,const struct attribute_group * attr_group)506 static void acpi_power_hide_list(struct acpi_device *adev,
507 struct list_head *resources,
508 const struct attribute_group *attr_group)
509 {
510 struct acpi_power_resource_entry *entry;
511
512 if (list_empty(resources))
513 return;
514
515 list_for_each_entry_reverse(entry, resources, node) {
516 struct acpi_device *res_dev = &entry->resource->device;
517
518 sysfs_remove_link_from_group(&adev->dev.kobj,
519 attr_group->name,
520 dev_name(&res_dev->dev));
521 }
522 sysfs_remove_group(&adev->dev.kobj, attr_group);
523 }
524
acpi_power_expose_list(struct acpi_device * adev,struct list_head * resources,const struct attribute_group * attr_group)525 static void acpi_power_expose_list(struct acpi_device *adev,
526 struct list_head *resources,
527 const struct attribute_group *attr_group)
528 {
529 struct acpi_power_resource_entry *entry;
530 int ret;
531
532 if (list_empty(resources))
533 return;
534
535 ret = sysfs_create_group(&adev->dev.kobj, attr_group);
536 if (ret)
537 return;
538
539 list_for_each_entry(entry, resources, node) {
540 struct acpi_device *res_dev = &entry->resource->device;
541
542 ret = sysfs_add_link_to_group(&adev->dev.kobj,
543 attr_group->name,
544 &res_dev->dev.kobj,
545 dev_name(&res_dev->dev));
546 if (ret) {
547 acpi_power_hide_list(adev, resources, attr_group);
548 break;
549 }
550 }
551 }
552
acpi_power_expose_hide(struct acpi_device * adev,struct list_head * resources,const struct attribute_group * attr_group,bool expose)553 static void acpi_power_expose_hide(struct acpi_device *adev,
554 struct list_head *resources,
555 const struct attribute_group *attr_group,
556 bool expose)
557 {
558 if (expose)
559 acpi_power_expose_list(adev, resources, attr_group);
560 else
561 acpi_power_hide_list(adev, resources, attr_group);
562 }
563
acpi_power_add_remove_device(struct acpi_device * adev,bool add)564 void acpi_power_add_remove_device(struct acpi_device *adev, bool add)
565 {
566 int state;
567
568 if (adev->wakeup.flags.valid)
569 acpi_power_expose_hide(adev, &adev->wakeup.resources,
570 &wakeup_attr_group, add);
571
572 if (!adev->power.flags.power_resources)
573 return;
574
575 for (state = ACPI_STATE_D0; state <= ACPI_STATE_D3_HOT; state++)
576 acpi_power_expose_hide(adev,
577 &adev->power.states[state].resources,
578 &attr_groups[state], add);
579 }
580
acpi_power_wakeup_list_init(struct list_head * list,int * system_level_p)581 int acpi_power_wakeup_list_init(struct list_head *list, int *system_level_p)
582 {
583 struct acpi_power_resource_entry *entry;
584 int system_level = 5;
585
586 list_for_each_entry(entry, list, node) {
587 struct acpi_power_resource *resource = entry->resource;
588 acpi_handle handle = resource->device.handle;
589 int result;
590 int state;
591
592 mutex_lock(&resource->resource_lock);
593
594 result = acpi_power_get_state(handle, &state);
595 if (result) {
596 mutex_unlock(&resource->resource_lock);
597 return result;
598 }
599 if (state == ACPI_POWER_RESOURCE_STATE_ON) {
600 resource->ref_count++;
601 resource->wakeup_enabled = true;
602 }
603 if (system_level > resource->system_level)
604 system_level = resource->system_level;
605
606 mutex_unlock(&resource->resource_lock);
607 }
608 *system_level_p = system_level;
609 return 0;
610 }
611
612 /* --------------------------------------------------------------------------
613 Device Power Management
614 -------------------------------------------------------------------------- */
615
616 /**
617 * acpi_device_sleep_wake - execute _DSW (Device Sleep Wake) or (deprecated in
618 * ACPI 3.0) _PSW (Power State Wake)
619 * @dev: Device to handle.
620 * @enable: 0 - disable, 1 - enable the wake capabilities of the device.
621 * @sleep_state: Target sleep state of the system.
622 * @dev_state: Target power state of the device.
623 *
624 * Execute _DSW (Device Sleep Wake) or (deprecated in ACPI 3.0) _PSW (Power
625 * State Wake) for the device, if present. On failure reset the device's
626 * wakeup.flags.valid flag.
627 *
628 * RETURN VALUE:
629 * 0 if either _DSW or _PSW has been successfully executed
630 * 0 if neither _DSW nor _PSW has been found
631 * -ENODEV if the execution of either _DSW or _PSW has failed
632 */
acpi_device_sleep_wake(struct acpi_device * dev,int enable,int sleep_state,int dev_state)633 int acpi_device_sleep_wake(struct acpi_device *dev,
634 int enable, int sleep_state, int dev_state)
635 {
636 union acpi_object in_arg[3];
637 struct acpi_object_list arg_list = { 3, in_arg };
638 acpi_status status = AE_OK;
639
640 /*
641 * Try to execute _DSW first.
642 *
643 * Three arguments are needed for the _DSW object:
644 * Argument 0: enable/disable the wake capabilities
645 * Argument 1: target system state
646 * Argument 2: target device state
647 * When _DSW object is called to disable the wake capabilities, maybe
648 * the first argument is filled. The values of the other two arguments
649 * are meaningless.
650 */
651 in_arg[0].type = ACPI_TYPE_INTEGER;
652 in_arg[0].integer.value = enable;
653 in_arg[1].type = ACPI_TYPE_INTEGER;
654 in_arg[1].integer.value = sleep_state;
655 in_arg[2].type = ACPI_TYPE_INTEGER;
656 in_arg[2].integer.value = dev_state;
657 status = acpi_evaluate_object(dev->handle, "_DSW", &arg_list, NULL);
658 if (ACPI_SUCCESS(status)) {
659 return 0;
660 } else if (status != AE_NOT_FOUND) {
661 acpi_handle_info(dev->handle, "_DSW execution failed\n");
662 dev->wakeup.flags.valid = 0;
663 return -ENODEV;
664 }
665
666 /* Execute _PSW */
667 status = acpi_execute_simple_method(dev->handle, "_PSW", enable);
668 if (ACPI_FAILURE(status) && (status != AE_NOT_FOUND)) {
669 acpi_handle_info(dev->handle, "_PSW execution failed\n");
670 dev->wakeup.flags.valid = 0;
671 return -ENODEV;
672 }
673
674 return 0;
675 }
676
677 /*
678 * Prepare a wakeup device, two steps (Ref ACPI 2.0:P229):
679 * 1. Power on the power resources required for the wakeup device
680 * 2. Execute _DSW (Device Sleep Wake) or (deprecated in ACPI 3.0) _PSW (Power
681 * State Wake) for the device, if present
682 */
acpi_enable_wakeup_device_power(struct acpi_device * dev,int sleep_state)683 int acpi_enable_wakeup_device_power(struct acpi_device *dev, int sleep_state)
684 {
685 struct acpi_power_resource_entry *entry;
686 int err = 0;
687
688 if (!dev || !dev->wakeup.flags.valid)
689 return -EINVAL;
690
691 mutex_lock(&acpi_device_lock);
692
693 if (dev->wakeup.prepare_count++)
694 goto out;
695
696 list_for_each_entry(entry, &dev->wakeup.resources, node) {
697 struct acpi_power_resource *resource = entry->resource;
698
699 mutex_lock(&resource->resource_lock);
700
701 if (!resource->wakeup_enabled) {
702 err = acpi_power_on_unlocked(resource);
703 if (!err)
704 resource->wakeup_enabled = true;
705 }
706
707 mutex_unlock(&resource->resource_lock);
708
709 if (err) {
710 dev_err(&dev->dev,
711 "Cannot turn wakeup power resources on\n");
712 dev->wakeup.flags.valid = 0;
713 goto out;
714 }
715 }
716 /*
717 * Passing 3 as the third argument below means the device may be
718 * put into arbitrary power state afterward.
719 */
720 err = acpi_device_sleep_wake(dev, 1, sleep_state, 3);
721 if (err)
722 dev->wakeup.prepare_count = 0;
723
724 out:
725 mutex_unlock(&acpi_device_lock);
726 return err;
727 }
728
729 /*
730 * Shutdown a wakeup device, counterpart of above method
731 * 1. Execute _DSW (Device Sleep Wake) or (deprecated in ACPI 3.0) _PSW (Power
732 * State Wake) for the device, if present
733 * 2. Shutdown down the power resources
734 */
acpi_disable_wakeup_device_power(struct acpi_device * dev)735 int acpi_disable_wakeup_device_power(struct acpi_device *dev)
736 {
737 struct acpi_power_resource_entry *entry;
738 int err = 0;
739
740 if (!dev || !dev->wakeup.flags.valid)
741 return -EINVAL;
742
743 mutex_lock(&acpi_device_lock);
744
745 if (--dev->wakeup.prepare_count > 0)
746 goto out;
747
748 /*
749 * Executing the code below even if prepare_count is already zero when
750 * the function is called may be useful, for example for initialisation.
751 */
752 if (dev->wakeup.prepare_count < 0)
753 dev->wakeup.prepare_count = 0;
754
755 err = acpi_device_sleep_wake(dev, 0, 0, 0);
756 if (err)
757 goto out;
758
759 list_for_each_entry(entry, &dev->wakeup.resources, node) {
760 struct acpi_power_resource *resource = entry->resource;
761
762 mutex_lock(&resource->resource_lock);
763
764 if (resource->wakeup_enabled) {
765 err = acpi_power_off_unlocked(resource);
766 if (!err)
767 resource->wakeup_enabled = false;
768 }
769
770 mutex_unlock(&resource->resource_lock);
771
772 if (err) {
773 dev_err(&dev->dev,
774 "Cannot turn wakeup power resources off\n");
775 dev->wakeup.flags.valid = 0;
776 break;
777 }
778 }
779
780 out:
781 mutex_unlock(&acpi_device_lock);
782 return err;
783 }
784
acpi_power_get_inferred_state(struct acpi_device * device,int * state)785 int acpi_power_get_inferred_state(struct acpi_device *device, int *state)
786 {
787 int result = 0;
788 int list_state = 0;
789 int i = 0;
790
791 if (!device || !state)
792 return -EINVAL;
793
794 /*
795 * We know a device's inferred power state when all the resources
796 * required for a given D-state are 'on'.
797 */
798 for (i = ACPI_STATE_D0; i <= ACPI_STATE_D3_HOT; i++) {
799 struct list_head *list = &device->power.states[i].resources;
800
801 if (list_empty(list))
802 continue;
803
804 result = acpi_power_get_list_state(list, &list_state);
805 if (result)
806 return result;
807
808 if (list_state == ACPI_POWER_RESOURCE_STATE_ON) {
809 *state = i;
810 return 0;
811 }
812 }
813
814 *state = device->power.states[ACPI_STATE_D3_COLD].flags.valid ?
815 ACPI_STATE_D3_COLD : ACPI_STATE_D3_HOT;
816 return 0;
817 }
818
acpi_power_on_resources(struct acpi_device * device,int state)819 int acpi_power_on_resources(struct acpi_device *device, int state)
820 {
821 if (!device || state < ACPI_STATE_D0 || state > ACPI_STATE_D3_HOT)
822 return -EINVAL;
823
824 return acpi_power_on_list(&device->power.states[state].resources);
825 }
826
acpi_power_transition(struct acpi_device * device,int state)827 int acpi_power_transition(struct acpi_device *device, int state)
828 {
829 int result = 0;
830
831 if (!device || (state < ACPI_STATE_D0) || (state > ACPI_STATE_D3_COLD))
832 return -EINVAL;
833
834 if (device->power.state == state || !device->flags.power_manageable)
835 return 0;
836
837 if ((device->power.state < ACPI_STATE_D0)
838 || (device->power.state > ACPI_STATE_D3_COLD))
839 return -ENODEV;
840
841 /*
842 * First we reference all power resources required in the target list
843 * (e.g. so the device doesn't lose power while transitioning). Then,
844 * we dereference all power resources used in the current list.
845 */
846 if (state < ACPI_STATE_D3_COLD)
847 result = acpi_power_on_list(
848 &device->power.states[state].resources);
849
850 if (!result && device->power.state < ACPI_STATE_D3_COLD)
851 acpi_power_off_list(
852 &device->power.states[device->power.state].resources);
853
854 /* We shouldn't change the state unless the above operations succeed. */
855 device->power.state = result ? ACPI_STATE_UNKNOWN : state;
856
857 return result;
858 }
859
acpi_release_power_resource(struct device * dev)860 static void acpi_release_power_resource(struct device *dev)
861 {
862 struct acpi_device *device = to_acpi_device(dev);
863 struct acpi_power_resource *resource;
864
865 resource = container_of(device, struct acpi_power_resource, device);
866
867 mutex_lock(&power_resource_list_lock);
868 list_del(&resource->list_node);
869 mutex_unlock(&power_resource_list_lock);
870
871 acpi_free_pnp_ids(&device->pnp);
872 kfree(resource);
873 }
874
resource_in_use_show(struct device * dev,struct device_attribute * attr,char * buf)875 static ssize_t resource_in_use_show(struct device *dev,
876 struct device_attribute *attr,
877 char *buf)
878 {
879 struct acpi_power_resource *resource;
880
881 resource = to_power_resource(to_acpi_device(dev));
882 return sprintf(buf, "%u\n", !!resource->ref_count);
883 }
884 static DEVICE_ATTR_RO(resource_in_use);
885
acpi_power_sysfs_remove(struct acpi_device * device)886 static void acpi_power_sysfs_remove(struct acpi_device *device)
887 {
888 device_remove_file(&device->dev, &dev_attr_resource_in_use);
889 }
890
acpi_power_add_resource_to_list(struct acpi_power_resource * resource)891 static void acpi_power_add_resource_to_list(struct acpi_power_resource *resource)
892 {
893 mutex_lock(&power_resource_list_lock);
894
895 if (!list_empty(&acpi_power_resource_list)) {
896 struct acpi_power_resource *r;
897
898 list_for_each_entry(r, &acpi_power_resource_list, list_node)
899 if (r->order > resource->order) {
900 list_add_tail(&resource->list_node, &r->list_node);
901 goto out;
902 }
903 }
904 list_add_tail(&resource->list_node, &acpi_power_resource_list);
905
906 out:
907 mutex_unlock(&power_resource_list_lock);
908 }
909
acpi_add_power_resource(acpi_handle handle)910 int acpi_add_power_resource(acpi_handle handle)
911 {
912 struct acpi_power_resource *resource;
913 struct acpi_device *device = NULL;
914 union acpi_object acpi_object;
915 struct acpi_buffer buffer = { sizeof(acpi_object), &acpi_object };
916 acpi_status status;
917 int state, result = -ENODEV;
918
919 acpi_bus_get_device(handle, &device);
920 if (device)
921 return 0;
922
923 resource = kzalloc(sizeof(*resource), GFP_KERNEL);
924 if (!resource)
925 return -ENOMEM;
926
927 device = &resource->device;
928 acpi_init_device_object(device, handle, ACPI_BUS_TYPE_POWER);
929 mutex_init(&resource->resource_lock);
930 INIT_LIST_HEAD(&resource->list_node);
931 INIT_LIST_HEAD(&resource->dependents);
932 resource->name = device->pnp.bus_id;
933 strcpy(acpi_device_name(device), ACPI_POWER_DEVICE_NAME);
934 strcpy(acpi_device_class(device), ACPI_POWER_CLASS);
935 device->power.state = ACPI_STATE_UNKNOWN;
936
937 /* Evaluate the object to get the system level and resource order. */
938 status = acpi_evaluate_object(handle, NULL, NULL, &buffer);
939 if (ACPI_FAILURE(status))
940 goto err;
941
942 resource->system_level = acpi_object.power_resource.system_level;
943 resource->order = acpi_object.power_resource.resource_order;
944
945 result = acpi_power_get_state(handle, &state);
946 if (result)
947 goto err;
948
949 pr_info("%s [%s] (%s)\n", acpi_device_name(device),
950 acpi_device_bid(device), state ? "on" : "off");
951
952 device->flags.match_driver = true;
953 result = acpi_device_add(device, acpi_release_power_resource);
954 if (result)
955 goto err;
956
957 if (!device_create_file(&device->dev, &dev_attr_resource_in_use))
958 device->remove = acpi_power_sysfs_remove;
959
960 acpi_power_add_resource_to_list(resource);
961 acpi_device_add_finalize(device);
962 return 0;
963
964 err:
965 acpi_release_power_resource(&device->dev);
966 return result;
967 }
968
969 #ifdef CONFIG_ACPI_SLEEP
acpi_resume_power_resources(void)970 void acpi_resume_power_resources(void)
971 {
972 struct acpi_power_resource *resource;
973
974 mutex_lock(&power_resource_list_lock);
975
976 list_for_each_entry(resource, &acpi_power_resource_list, list_node) {
977 int result, state;
978
979 mutex_lock(&resource->resource_lock);
980
981 result = acpi_power_get_state(resource->device.handle, &state);
982 if (result) {
983 mutex_unlock(&resource->resource_lock);
984 continue;
985 }
986
987 if (state == ACPI_POWER_RESOURCE_STATE_OFF
988 && resource->ref_count) {
989 dev_info(&resource->device.dev, "Turning ON\n");
990 __acpi_power_on(resource);
991 }
992
993 mutex_unlock(&resource->resource_lock);
994 }
995
996 mutex_unlock(&power_resource_list_lock);
997 }
998 #endif
999
acpi_turn_off_unused_power_resources(void)1000 void acpi_turn_off_unused_power_resources(void)
1001 {
1002 struct acpi_power_resource *resource;
1003
1004 mutex_lock(&power_resource_list_lock);
1005
1006 list_for_each_entry_reverse(resource, &acpi_power_resource_list, list_node) {
1007 mutex_lock(&resource->resource_lock);
1008
1009 if (!resource->ref_count) {
1010 dev_info(&resource->device.dev, "Turning OFF\n");
1011 __acpi_power_off(resource);
1012 }
1013
1014 mutex_unlock(&resource->resource_lock);
1015 }
1016
1017 mutex_unlock(&power_resource_list_lock);
1018 }
1019