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