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