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