1 /* 2 * acpi_power.c - ACPI Bus Power Management ($Revision: 39 $) 3 * 4 * Copyright (C) 2001, 2002 Andy Grover <andrew.grover@intel.com> 5 * Copyright (C) 2001, 2002 Paul Diefenbaugh <paul.s.diefenbaugh@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 as published by 11 * the Free Software Foundation; either version 2 of the License, or (at 12 * your option) any later version. 13 * 14 * This program is distributed in the hope that it will be useful, but 15 * WITHOUT ANY WARRANTY; without even the implied warranty of 16 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU 17 * General Public License for more details. 18 * 19 * You should have received a copy of the GNU General Public License along 20 * with this program; if not, write to the Free Software Foundation, Inc., 21 * 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA. 22 * 23 * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~ 24 */ 25 26 /* 27 * ACPI power-managed devices may be controlled in two ways: 28 * 1. via "Device Specific (D-State) Control" 29 * 2. via "Power Resource Control". 30 * This module is used to manage devices relying on Power Resource Control. 31 * 32 * An ACPI "power resource object" describes a software controllable power 33 * plane, clock plane, or other resource used by a power managed device. 34 * A device may rely on multiple power resources, and a power resource 35 * may be shared by multiple devices. 36 */ 37 38 #include <linux/kernel.h> 39 #include <linux/module.h> 40 #include <linux/init.h> 41 #include <linux/types.h> 42 #include <linux/proc_fs.h> 43 #include <linux/seq_file.h> 44 #include <acpi/acpi_bus.h> 45 #include <acpi/acpi_drivers.h> 46 47 #define _COMPONENT ACPI_POWER_COMPONENT 48 ACPI_MODULE_NAME("power"); 49 #define ACPI_POWER_CLASS "power_resource" 50 #define ACPI_POWER_DEVICE_NAME "Power Resource" 51 #define ACPI_POWER_FILE_INFO "info" 52 #define ACPI_POWER_FILE_STATUS "state" 53 #define ACPI_POWER_RESOURCE_STATE_OFF 0x00 54 #define ACPI_POWER_RESOURCE_STATE_ON 0x01 55 #define ACPI_POWER_RESOURCE_STATE_UNKNOWN 0xFF 56 57 #ifdef MODULE_PARAM_PREFIX 58 #undef MODULE_PARAM_PREFIX 59 #endif 60 #define MODULE_PARAM_PREFIX "acpi." 61 int acpi_power_nocheck; 62 module_param_named(power_nocheck, acpi_power_nocheck, bool, 000); 63 64 static int acpi_power_add(struct acpi_device *device); 65 static int acpi_power_remove(struct acpi_device *device, int type); 66 static int acpi_power_resume(struct acpi_device *device); 67 static int acpi_power_open_fs(struct inode *inode, struct file *file); 68 69 static struct acpi_device_id power_device_ids[] = { 70 {ACPI_POWER_HID, 0}, 71 {"", 0}, 72 }; 73 MODULE_DEVICE_TABLE(acpi, power_device_ids); 74 75 static struct acpi_driver acpi_power_driver = { 76 .name = "power", 77 .class = ACPI_POWER_CLASS, 78 .ids = power_device_ids, 79 .ops = { 80 .add = acpi_power_add, 81 .remove = acpi_power_remove, 82 .resume = acpi_power_resume, 83 }, 84 }; 85 86 struct acpi_power_reference { 87 struct list_head node; 88 struct acpi_device *device; 89 }; 90 91 struct acpi_power_resource { 92 struct acpi_device * device; 93 acpi_bus_id name; 94 u32 system_level; 95 u32 order; 96 struct mutex resource_lock; 97 struct list_head reference; 98 }; 99 100 static struct list_head acpi_power_resource_list; 101 102 static const struct file_operations acpi_power_fops = { 103 .owner = THIS_MODULE, 104 .open = acpi_power_open_fs, 105 .read = seq_read, 106 .llseek = seq_lseek, 107 .release = single_release, 108 }; 109 110 /* -------------------------------------------------------------------------- 111 Power Resource Management 112 -------------------------------------------------------------------------- */ 113 114 static int 115 acpi_power_get_context(acpi_handle handle, 116 struct acpi_power_resource **resource) 117 { 118 int result = 0; 119 struct acpi_device *device = NULL; 120 121 122 if (!resource) 123 return -ENODEV; 124 125 result = acpi_bus_get_device(handle, &device); 126 if (result) { 127 printk(KERN_WARNING PREFIX "Getting context [%p]\n", handle); 128 return result; 129 } 130 131 *resource = acpi_driver_data(device); 132 if (!*resource) 133 return -ENODEV; 134 135 return 0; 136 } 137 138 static int acpi_power_get_state(acpi_handle handle, int *state) 139 { 140 acpi_status status = AE_OK; 141 unsigned long long sta = 0; 142 char node_name[5]; 143 struct acpi_buffer buffer = { sizeof(node_name), node_name }; 144 145 146 if (!handle || !state) 147 return -EINVAL; 148 149 status = acpi_evaluate_integer(handle, "_STA", NULL, &sta); 150 if (ACPI_FAILURE(status)) 151 return -ENODEV; 152 153 *state = (sta & 0x01)?ACPI_POWER_RESOURCE_STATE_ON: 154 ACPI_POWER_RESOURCE_STATE_OFF; 155 156 acpi_get_name(handle, ACPI_SINGLE_NAME, &buffer); 157 158 ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Resource [%s] is %s\n", 159 node_name, 160 *state ? "on" : "off")); 161 162 return 0; 163 } 164 165 static int acpi_power_get_list_state(struct acpi_handle_list *list, int *state) 166 { 167 int result = 0, state1; 168 u32 i = 0; 169 170 171 if (!list || !state) 172 return -EINVAL; 173 174 /* The state of the list is 'on' IFF all resources are 'on'. */ 175 /* */ 176 177 for (i = 0; i < list->count; i++) { 178 /* 179 * The state of the power resource can be obtained by 180 * using the ACPI handle. In such case it is unnecessary to 181 * get the Power resource first and then get its state again. 182 */ 183 result = acpi_power_get_state(list->handles[i], &state1); 184 if (result) 185 return result; 186 187 *state = state1; 188 189 if (*state != ACPI_POWER_RESOURCE_STATE_ON) 190 break; 191 } 192 193 ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Resource list is %s\n", 194 *state ? "on" : "off")); 195 196 return result; 197 } 198 199 static int acpi_power_on(acpi_handle handle, struct acpi_device *dev) 200 { 201 int result = 0, state; 202 int found = 0; 203 acpi_status status = AE_OK; 204 struct acpi_power_resource *resource = NULL; 205 struct list_head *node, *next; 206 struct acpi_power_reference *ref; 207 208 209 result = acpi_power_get_context(handle, &resource); 210 if (result) 211 return result; 212 213 mutex_lock(&resource->resource_lock); 214 list_for_each_safe(node, next, &resource->reference) { 215 ref = container_of(node, struct acpi_power_reference, node); 216 if (dev->handle == ref->device->handle) { 217 ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Device [%s] already referenced by resource [%s]\n", 218 dev->pnp.bus_id, resource->name)); 219 found = 1; 220 break; 221 } 222 } 223 224 if (!found) { 225 ref = kmalloc(sizeof (struct acpi_power_reference), 226 irqs_disabled() ? GFP_ATOMIC : GFP_KERNEL); 227 if (!ref) { 228 ACPI_DEBUG_PRINT((ACPI_DB_INFO, "kmalloc() failed\n")); 229 mutex_unlock(&resource->resource_lock); 230 return -ENOMEM; 231 } 232 list_add_tail(&ref->node, &resource->reference); 233 ref->device = dev; 234 ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Device [%s] added to resource [%s] references\n", 235 dev->pnp.bus_id, resource->name)); 236 } 237 mutex_unlock(&resource->resource_lock); 238 239 status = acpi_evaluate_object(resource->device->handle, "_ON", NULL, NULL); 240 if (ACPI_FAILURE(status)) 241 return -ENODEV; 242 243 if (!acpi_power_nocheck) { 244 /* 245 * If acpi_power_nocheck is set, it is unnecessary to check 246 * the power state after power transition. 247 */ 248 result = acpi_power_get_state(resource->device->handle, 249 &state); 250 if (result) 251 return result; 252 if (state != ACPI_POWER_RESOURCE_STATE_ON) 253 return -ENOEXEC; 254 } 255 /* Update the power resource's _device_ power state */ 256 resource->device->power.state = ACPI_STATE_D0; 257 258 ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Resource [%s] turned on\n", 259 resource->name)); 260 return 0; 261 } 262 263 static int acpi_power_off_device(acpi_handle handle, struct acpi_device *dev) 264 { 265 int result = 0, state; 266 acpi_status status = AE_OK; 267 struct acpi_power_resource *resource = NULL; 268 struct list_head *node, *next; 269 struct acpi_power_reference *ref; 270 271 272 result = acpi_power_get_context(handle, &resource); 273 if (result) 274 return result; 275 276 mutex_lock(&resource->resource_lock); 277 list_for_each_safe(node, next, &resource->reference) { 278 ref = container_of(node, struct acpi_power_reference, node); 279 if (dev->handle == ref->device->handle) { 280 list_del(&ref->node); 281 kfree(ref); 282 ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Device [%s] removed from resource [%s] references\n", 283 dev->pnp.bus_id, resource->name)); 284 break; 285 } 286 } 287 288 if (!list_empty(&resource->reference)) { 289 ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Cannot turn resource [%s] off - resource is in use\n", 290 resource->name)); 291 mutex_unlock(&resource->resource_lock); 292 return 0; 293 } 294 mutex_unlock(&resource->resource_lock); 295 296 status = acpi_evaluate_object(resource->device->handle, "_OFF", NULL, NULL); 297 if (ACPI_FAILURE(status)) 298 return -ENODEV; 299 300 if (!acpi_power_nocheck) { 301 /* 302 * If acpi_power_nocheck is set, it is unnecessary to check 303 * the power state after power transition. 304 */ 305 result = acpi_power_get_state(handle, &state); 306 if (result) 307 return result; 308 if (state != ACPI_POWER_RESOURCE_STATE_OFF) 309 return -ENOEXEC; 310 } 311 312 /* Update the power resource's _device_ power state */ 313 resource->device->power.state = ACPI_STATE_D3; 314 315 ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Resource [%s] turned off\n", 316 resource->name)); 317 318 return 0; 319 } 320 321 /** 322 * acpi_device_sleep_wake - execute _DSW (Device Sleep Wake) or (deprecated in 323 * ACPI 3.0) _PSW (Power State Wake) 324 * @dev: Device to handle. 325 * @enable: 0 - disable, 1 - enable the wake capabilities of the device. 326 * @sleep_state: Target sleep state of the system. 327 * @dev_state: Target power state of the device. 328 * 329 * Execute _DSW (Device Sleep Wake) or (deprecated in ACPI 3.0) _PSW (Power 330 * State Wake) for the device, if present. On failure reset the device's 331 * wakeup.flags.valid flag. 332 * 333 * RETURN VALUE: 334 * 0 if either _DSW or _PSW has been successfully executed 335 * 0 if neither _DSW nor _PSW has been found 336 * -ENODEV if the execution of either _DSW or _PSW has failed 337 */ 338 int acpi_device_sleep_wake(struct acpi_device *dev, 339 int enable, int sleep_state, int dev_state) 340 { 341 union acpi_object in_arg[3]; 342 struct acpi_object_list arg_list = { 3, in_arg }; 343 acpi_status status = AE_OK; 344 345 /* 346 * Try to execute _DSW first. 347 * 348 * Three agruments are needed for the _DSW object: 349 * Argument 0: enable/disable the wake capabilities 350 * Argument 1: target system state 351 * Argument 2: target device state 352 * When _DSW object is called to disable the wake capabilities, maybe 353 * the first argument is filled. The values of the other two agruments 354 * are meaningless. 355 */ 356 in_arg[0].type = ACPI_TYPE_INTEGER; 357 in_arg[0].integer.value = enable; 358 in_arg[1].type = ACPI_TYPE_INTEGER; 359 in_arg[1].integer.value = sleep_state; 360 in_arg[2].type = ACPI_TYPE_INTEGER; 361 in_arg[2].integer.value = dev_state; 362 status = acpi_evaluate_object(dev->handle, "_DSW", &arg_list, NULL); 363 if (ACPI_SUCCESS(status)) { 364 return 0; 365 } else if (status != AE_NOT_FOUND) { 366 printk(KERN_ERR PREFIX "_DSW execution failed\n"); 367 dev->wakeup.flags.valid = 0; 368 return -ENODEV; 369 } 370 371 /* Execute _PSW */ 372 arg_list.count = 1; 373 in_arg[0].integer.value = enable; 374 status = acpi_evaluate_object(dev->handle, "_PSW", &arg_list, NULL); 375 if (ACPI_FAILURE(status) && (status != AE_NOT_FOUND)) { 376 printk(KERN_ERR PREFIX "_PSW execution failed\n"); 377 dev->wakeup.flags.valid = 0; 378 return -ENODEV; 379 } 380 381 return 0; 382 } 383 384 /* 385 * Prepare a wakeup device, two steps (Ref ACPI 2.0:P229): 386 * 1. Power on the power resources required for the wakeup device 387 * 2. Execute _DSW (Device Sleep Wake) or (deprecated in ACPI 3.0) _PSW (Power 388 * State Wake) for the device, if present 389 */ 390 int acpi_enable_wakeup_device_power(struct acpi_device *dev, int sleep_state) 391 { 392 int i, err; 393 394 if (!dev || !dev->wakeup.flags.valid) 395 return -EINVAL; 396 397 /* 398 * Do not execute the code below twice in a row without calling 399 * acpi_disable_wakeup_device_power() in between for the same device 400 */ 401 if (dev->wakeup.flags.prepared) 402 return 0; 403 404 /* Open power resource */ 405 for (i = 0; i < dev->wakeup.resources.count; i++) { 406 int ret = acpi_power_on(dev->wakeup.resources.handles[i], dev); 407 if (ret) { 408 printk(KERN_ERR PREFIX "Transition power state\n"); 409 dev->wakeup.flags.valid = 0; 410 return -ENODEV; 411 } 412 } 413 414 /* 415 * Passing 3 as the third argument below means the device may be placed 416 * in arbitrary power state afterwards. 417 */ 418 err = acpi_device_sleep_wake(dev, 1, sleep_state, 3); 419 if (!err) 420 dev->wakeup.flags.prepared = 1; 421 422 return err; 423 } 424 425 /* 426 * Shutdown a wakeup device, counterpart of above method 427 * 1. Execute _DSW (Device Sleep Wake) or (deprecated in ACPI 3.0) _PSW (Power 428 * State Wake) for the device, if present 429 * 2. Shutdown down the power resources 430 */ 431 int acpi_disable_wakeup_device_power(struct acpi_device *dev) 432 { 433 int i, ret; 434 435 if (!dev || !dev->wakeup.flags.valid) 436 return -EINVAL; 437 438 /* 439 * Do not execute the code below twice in a row without calling 440 * acpi_enable_wakeup_device_power() in between for the same device 441 */ 442 if (!dev->wakeup.flags.prepared) 443 return 0; 444 445 dev->wakeup.flags.prepared = 0; 446 447 ret = acpi_device_sleep_wake(dev, 0, 0, 0); 448 if (ret) 449 return ret; 450 451 /* Close power resource */ 452 for (i = 0; i < dev->wakeup.resources.count; i++) { 453 ret = acpi_power_off_device(dev->wakeup.resources.handles[i], dev); 454 if (ret) { 455 printk(KERN_ERR PREFIX "Transition power state\n"); 456 dev->wakeup.flags.valid = 0; 457 return -ENODEV; 458 } 459 } 460 461 return ret; 462 } 463 464 /* -------------------------------------------------------------------------- 465 Device Power Management 466 -------------------------------------------------------------------------- */ 467 468 int acpi_power_get_inferred_state(struct acpi_device *device) 469 { 470 int result = 0; 471 struct acpi_handle_list *list = NULL; 472 int list_state = 0; 473 int i = 0; 474 475 476 if (!device) 477 return -EINVAL; 478 479 device->power.state = ACPI_STATE_UNKNOWN; 480 481 /* 482 * We know a device's inferred power state when all the resources 483 * required for a given D-state are 'on'. 484 */ 485 for (i = ACPI_STATE_D0; i < ACPI_STATE_D3; i++) { 486 list = &device->power.states[i].resources; 487 if (list->count < 1) 488 continue; 489 490 result = acpi_power_get_list_state(list, &list_state); 491 if (result) 492 return result; 493 494 if (list_state == ACPI_POWER_RESOURCE_STATE_ON) { 495 device->power.state = i; 496 return 0; 497 } 498 } 499 500 device->power.state = ACPI_STATE_D3; 501 502 return 0; 503 } 504 505 int acpi_power_transition(struct acpi_device *device, int state) 506 { 507 int result = 0; 508 struct acpi_handle_list *cl = NULL; /* Current Resources */ 509 struct acpi_handle_list *tl = NULL; /* Target Resources */ 510 int i = 0; 511 512 513 if (!device || (state < ACPI_STATE_D0) || (state > ACPI_STATE_D3)) 514 return -EINVAL; 515 516 if ((device->power.state < ACPI_STATE_D0) 517 || (device->power.state > ACPI_STATE_D3)) 518 return -ENODEV; 519 520 cl = &device->power.states[device->power.state].resources; 521 tl = &device->power.states[state].resources; 522 523 /* TBD: Resources must be ordered. */ 524 525 /* 526 * First we reference all power resources required in the target list 527 * (e.g. so the device doesn't lose power while transitioning). 528 */ 529 for (i = 0; i < tl->count; i++) { 530 result = acpi_power_on(tl->handles[i], device); 531 if (result) 532 goto end; 533 } 534 535 if (device->power.state == state) { 536 goto end; 537 } 538 539 /* 540 * Then we dereference all power resources used in the current list. 541 */ 542 for (i = 0; i < cl->count; i++) { 543 result = acpi_power_off_device(cl->handles[i], device); 544 if (result) 545 goto end; 546 } 547 548 end: 549 if (result) 550 device->power.state = ACPI_STATE_UNKNOWN; 551 else { 552 /* We shouldn't change the state till all above operations succeed */ 553 device->power.state = state; 554 } 555 556 return result; 557 } 558 559 /* -------------------------------------------------------------------------- 560 FS Interface (/proc) 561 -------------------------------------------------------------------------- */ 562 563 static struct proc_dir_entry *acpi_power_dir; 564 565 static int acpi_power_seq_show(struct seq_file *seq, void *offset) 566 { 567 int count = 0; 568 int result = 0, state; 569 struct acpi_power_resource *resource = NULL; 570 struct list_head *node, *next; 571 struct acpi_power_reference *ref; 572 573 574 resource = seq->private; 575 576 if (!resource) 577 goto end; 578 579 result = acpi_power_get_state(resource->device->handle, &state); 580 if (result) 581 goto end; 582 583 seq_puts(seq, "state: "); 584 switch (state) { 585 case ACPI_POWER_RESOURCE_STATE_ON: 586 seq_puts(seq, "on\n"); 587 break; 588 case ACPI_POWER_RESOURCE_STATE_OFF: 589 seq_puts(seq, "off\n"); 590 break; 591 default: 592 seq_puts(seq, "unknown\n"); 593 break; 594 } 595 596 mutex_lock(&resource->resource_lock); 597 list_for_each_safe(node, next, &resource->reference) { 598 ref = container_of(node, struct acpi_power_reference, node); 599 count++; 600 } 601 mutex_unlock(&resource->resource_lock); 602 603 seq_printf(seq, "system level: S%d\n" 604 "order: %d\n" 605 "reference count: %d\n", 606 resource->system_level, 607 resource->order, count); 608 609 end: 610 return 0; 611 } 612 613 static int acpi_power_open_fs(struct inode *inode, struct file *file) 614 { 615 return single_open(file, acpi_power_seq_show, PDE(inode)->data); 616 } 617 618 static int acpi_power_add_fs(struct acpi_device *device) 619 { 620 struct proc_dir_entry *entry = NULL; 621 622 623 if (!device) 624 return -EINVAL; 625 626 if (!acpi_device_dir(device)) { 627 acpi_device_dir(device) = proc_mkdir(acpi_device_bid(device), 628 acpi_power_dir); 629 if (!acpi_device_dir(device)) 630 return -ENODEV; 631 } 632 633 /* 'status' [R] */ 634 entry = proc_create_data(ACPI_POWER_FILE_STATUS, 635 S_IRUGO, acpi_device_dir(device), 636 &acpi_power_fops, acpi_driver_data(device)); 637 if (!entry) 638 return -EIO; 639 return 0; 640 } 641 642 static int acpi_power_remove_fs(struct acpi_device *device) 643 { 644 645 if (acpi_device_dir(device)) { 646 remove_proc_entry(ACPI_POWER_FILE_STATUS, 647 acpi_device_dir(device)); 648 remove_proc_entry(acpi_device_bid(device), acpi_power_dir); 649 acpi_device_dir(device) = NULL; 650 } 651 652 return 0; 653 } 654 655 /* -------------------------------------------------------------------------- 656 Driver Interface 657 -------------------------------------------------------------------------- */ 658 659 static int acpi_power_add(struct acpi_device *device) 660 { 661 int result = 0, state; 662 acpi_status status = AE_OK; 663 struct acpi_power_resource *resource = NULL; 664 union acpi_object acpi_object; 665 struct acpi_buffer buffer = { sizeof(acpi_object), &acpi_object }; 666 667 668 if (!device) 669 return -EINVAL; 670 671 resource = kzalloc(sizeof(struct acpi_power_resource), GFP_KERNEL); 672 if (!resource) 673 return -ENOMEM; 674 675 resource->device = device; 676 mutex_init(&resource->resource_lock); 677 INIT_LIST_HEAD(&resource->reference); 678 strcpy(resource->name, device->pnp.bus_id); 679 strcpy(acpi_device_name(device), ACPI_POWER_DEVICE_NAME); 680 strcpy(acpi_device_class(device), ACPI_POWER_CLASS); 681 device->driver_data = resource; 682 683 /* Evalute the object to get the system level and resource order. */ 684 status = acpi_evaluate_object(device->handle, NULL, NULL, &buffer); 685 if (ACPI_FAILURE(status)) { 686 result = -ENODEV; 687 goto end; 688 } 689 resource->system_level = acpi_object.power_resource.system_level; 690 resource->order = acpi_object.power_resource.resource_order; 691 692 result = acpi_power_get_state(device->handle, &state); 693 if (result) 694 goto end; 695 696 switch (state) { 697 case ACPI_POWER_RESOURCE_STATE_ON: 698 device->power.state = ACPI_STATE_D0; 699 break; 700 case ACPI_POWER_RESOURCE_STATE_OFF: 701 device->power.state = ACPI_STATE_D3; 702 break; 703 default: 704 device->power.state = ACPI_STATE_UNKNOWN; 705 break; 706 } 707 708 result = acpi_power_add_fs(device); 709 if (result) 710 goto end; 711 712 printk(KERN_INFO PREFIX "%s [%s] (%s)\n", acpi_device_name(device), 713 acpi_device_bid(device), state ? "on" : "off"); 714 715 end: 716 if (result) 717 kfree(resource); 718 719 return result; 720 } 721 722 static int acpi_power_remove(struct acpi_device *device, int type) 723 { 724 struct acpi_power_resource *resource = NULL; 725 struct list_head *node, *next; 726 727 728 if (!device || !acpi_driver_data(device)) 729 return -EINVAL; 730 731 resource = acpi_driver_data(device); 732 733 acpi_power_remove_fs(device); 734 735 mutex_lock(&resource->resource_lock); 736 list_for_each_safe(node, next, &resource->reference) { 737 struct acpi_power_reference *ref = container_of(node, struct acpi_power_reference, node); 738 list_del(&ref->node); 739 kfree(ref); 740 } 741 mutex_unlock(&resource->resource_lock); 742 743 kfree(resource); 744 745 return 0; 746 } 747 748 static int acpi_power_resume(struct acpi_device *device) 749 { 750 int result = 0, state; 751 struct acpi_power_resource *resource = NULL; 752 struct acpi_power_reference *ref; 753 754 if (!device || !acpi_driver_data(device)) 755 return -EINVAL; 756 757 resource = acpi_driver_data(device); 758 759 result = acpi_power_get_state(device->handle, &state); 760 if (result) 761 return result; 762 763 mutex_lock(&resource->resource_lock); 764 if (state == ACPI_POWER_RESOURCE_STATE_OFF && 765 !list_empty(&resource->reference)) { 766 ref = container_of(resource->reference.next, struct acpi_power_reference, node); 767 mutex_unlock(&resource->resource_lock); 768 result = acpi_power_on(device->handle, ref->device); 769 return result; 770 } 771 772 mutex_unlock(&resource->resource_lock); 773 return 0; 774 } 775 776 static int __init acpi_power_init(void) 777 { 778 int result = 0; 779 780 781 if (acpi_disabled) 782 return 0; 783 784 INIT_LIST_HEAD(&acpi_power_resource_list); 785 786 acpi_power_dir = proc_mkdir(ACPI_POWER_CLASS, acpi_root_dir); 787 if (!acpi_power_dir) 788 return -ENODEV; 789 790 result = acpi_bus_register_driver(&acpi_power_driver); 791 if (result < 0) { 792 remove_proc_entry(ACPI_POWER_CLASS, acpi_root_dir); 793 return -ENODEV; 794 } 795 796 return 0; 797 } 798 799 subsys_initcall(acpi_power_init); 800