cpuidle: add checks to avoid NULL pointer dereference
[GitHub/mt8127/android_kernel_alcatel_ttab.git] / drivers / acpi / scan.c
1 /*
2 * scan.c - support for transforming the ACPI namespace into individual objects
3 */
4
5 #include <linux/module.h>
6 #include <linux/init.h>
7 #include <linux/slab.h>
8 #include <linux/kernel.h>
9 #include <linux/acpi.h>
10 #include <linux/signal.h>
11 #include <linux/kthread.h>
12 #include <linux/dmi.h>
13
14 #include <acpi/acpi_drivers.h>
15
16 #include "internal.h"
17
18 #define _COMPONENT ACPI_BUS_COMPONENT
19 ACPI_MODULE_NAME("scan");
20 #define STRUCT_TO_INT(s) (*((int*)&s))
21 extern struct acpi_device *acpi_root;
22
23 #define ACPI_BUS_CLASS "system_bus"
24 #define ACPI_BUS_HID "LNXSYBUS"
25 #define ACPI_BUS_DEVICE_NAME "System Bus"
26
27 #define ACPI_IS_ROOT_DEVICE(device) (!(device)->parent)
28
29 static const char *dummy_hid = "device";
30
31 static LIST_HEAD(acpi_device_list);
32 static LIST_HEAD(acpi_bus_id_list);
33 DEFINE_MUTEX(acpi_device_lock);
34 LIST_HEAD(acpi_wakeup_device_list);
35
36 struct acpi_device_bus_id{
37 char bus_id[15];
38 unsigned int instance_no;
39 struct list_head node;
40 };
41
42 /*
43 * Creates hid/cid(s) string needed for modalias and uevent
44 * e.g. on a device with hid:IBM0001 and cid:ACPI0001 you get:
45 * char *modalias: "acpi:IBM0001:ACPI0001"
46 */
47 static int create_modalias(struct acpi_device *acpi_dev, char *modalias,
48 int size)
49 {
50 int len;
51 int count;
52 struct acpi_hardware_id *id;
53
54 if (list_empty(&acpi_dev->pnp.ids))
55 return 0;
56
57 len = snprintf(modalias, size, "acpi:");
58 size -= len;
59
60 list_for_each_entry(id, &acpi_dev->pnp.ids, list) {
61 count = snprintf(&modalias[len], size, "%s:", id->id);
62 if (count < 0 || count >= size)
63 return -EINVAL;
64 len += count;
65 size -= count;
66 }
67
68 modalias[len] = '\0';
69 return len;
70 }
71
72 static ssize_t
73 acpi_device_modalias_show(struct device *dev, struct device_attribute *attr, char *buf) {
74 struct acpi_device *acpi_dev = to_acpi_device(dev);
75 int len;
76
77 /* Device has no HID and no CID or string is >1024 */
78 len = create_modalias(acpi_dev, buf, 1024);
79 if (len <= 0)
80 return 0;
81 buf[len++] = '\n';
82 return len;
83 }
84 static DEVICE_ATTR(modalias, 0444, acpi_device_modalias_show, NULL);
85
86 static void acpi_bus_hot_remove_device(void *context)
87 {
88 struct acpi_device *device;
89 acpi_handle handle = context;
90 struct acpi_object_list arg_list;
91 union acpi_object arg;
92 acpi_status status = AE_OK;
93
94 if (acpi_bus_get_device(handle, &device))
95 return;
96
97 if (!device)
98 return;
99
100 ACPI_DEBUG_PRINT((ACPI_DB_INFO,
101 "Hot-removing device %s...\n", dev_name(&device->dev)));
102
103 if (acpi_bus_trim(device, 1)) {
104 printk(KERN_ERR PREFIX
105 "Removing device failed\n");
106 return;
107 }
108
109 /* power off device */
110 status = acpi_evaluate_object(handle, "_PS3", NULL, NULL);
111 if (ACPI_FAILURE(status) && status != AE_NOT_FOUND)
112 printk(KERN_WARNING PREFIX
113 "Power-off device failed\n");
114
115 if (device->flags.lockable) {
116 arg_list.count = 1;
117 arg_list.pointer = &arg;
118 arg.type = ACPI_TYPE_INTEGER;
119 arg.integer.value = 0;
120 acpi_evaluate_object(handle, "_LCK", &arg_list, NULL);
121 }
122
123 arg_list.count = 1;
124 arg_list.pointer = &arg;
125 arg.type = ACPI_TYPE_INTEGER;
126 arg.integer.value = 1;
127
128 /*
129 * TBD: _EJD support.
130 */
131 status = acpi_evaluate_object(handle, "_EJ0", &arg_list, NULL);
132 if (ACPI_FAILURE(status))
133 printk(KERN_WARNING PREFIX
134 "Eject device failed\n");
135
136 return;
137 }
138
139 static ssize_t
140 acpi_eject_store(struct device *d, struct device_attribute *attr,
141 const char *buf, size_t count)
142 {
143 int ret = count;
144 acpi_status status;
145 acpi_object_type type = 0;
146 struct acpi_device *acpi_device = to_acpi_device(d);
147
148 if ((!count) || (buf[0] != '1')) {
149 return -EINVAL;
150 }
151 #ifndef FORCE_EJECT
152 if (acpi_device->driver == NULL) {
153 ret = -ENODEV;
154 goto err;
155 }
156 #endif
157 status = acpi_get_type(acpi_device->handle, &type);
158 if (ACPI_FAILURE(status) || (!acpi_device->flags.ejectable)) {
159 ret = -ENODEV;
160 goto err;
161 }
162
163 acpi_os_hotplug_execute(acpi_bus_hot_remove_device, acpi_device->handle);
164 err:
165 return ret;
166 }
167
168 static DEVICE_ATTR(eject, 0200, NULL, acpi_eject_store);
169
170 static ssize_t
171 acpi_device_hid_show(struct device *dev, struct device_attribute *attr, char *buf) {
172 struct acpi_device *acpi_dev = to_acpi_device(dev);
173
174 return sprintf(buf, "%s\n", acpi_device_hid(acpi_dev));
175 }
176 static DEVICE_ATTR(hid, 0444, acpi_device_hid_show, NULL);
177
178 static ssize_t
179 acpi_device_path_show(struct device *dev, struct device_attribute *attr, char *buf) {
180 struct acpi_device *acpi_dev = to_acpi_device(dev);
181 struct acpi_buffer path = {ACPI_ALLOCATE_BUFFER, NULL};
182 int result;
183
184 result = acpi_get_name(acpi_dev->handle, ACPI_FULL_PATHNAME, &path);
185 if (result)
186 goto end;
187
188 result = sprintf(buf, "%s\n", (char*)path.pointer);
189 kfree(path.pointer);
190 end:
191 return result;
192 }
193 static DEVICE_ATTR(path, 0444, acpi_device_path_show, NULL);
194
195 static int acpi_device_setup_files(struct acpi_device *dev)
196 {
197 acpi_status status;
198 acpi_handle temp;
199 int result = 0;
200
201 /*
202 * Devices gotten from FADT don't have a "path" attribute
203 */
204 if (dev->handle) {
205 result = device_create_file(&dev->dev, &dev_attr_path);
206 if (result)
207 goto end;
208 }
209
210 if (!list_empty(&dev->pnp.ids)) {
211 result = device_create_file(&dev->dev, &dev_attr_hid);
212 if (result)
213 goto end;
214
215 result = device_create_file(&dev->dev, &dev_attr_modalias);
216 if (result)
217 goto end;
218 }
219
220 /*
221 * If device has _EJ0, 'eject' file is created that is used to trigger
222 * hot-removal function from userland.
223 */
224 status = acpi_get_handle(dev->handle, "_EJ0", &temp);
225 if (ACPI_SUCCESS(status))
226 result = device_create_file(&dev->dev, &dev_attr_eject);
227 end:
228 return result;
229 }
230
231 static void acpi_device_remove_files(struct acpi_device *dev)
232 {
233 acpi_status status;
234 acpi_handle temp;
235
236 /*
237 * If device has _EJ0, 'eject' file is created that is used to trigger
238 * hot-removal function from userland.
239 */
240 status = acpi_get_handle(dev->handle, "_EJ0", &temp);
241 if (ACPI_SUCCESS(status))
242 device_remove_file(&dev->dev, &dev_attr_eject);
243
244 device_remove_file(&dev->dev, &dev_attr_modalias);
245 device_remove_file(&dev->dev, &dev_attr_hid);
246 if (dev->handle)
247 device_remove_file(&dev->dev, &dev_attr_path);
248 }
249 /* --------------------------------------------------------------------------
250 ACPI Bus operations
251 -------------------------------------------------------------------------- */
252
253 int acpi_match_device_ids(struct acpi_device *device,
254 const struct acpi_device_id *ids)
255 {
256 const struct acpi_device_id *id;
257 struct acpi_hardware_id *hwid;
258
259 /*
260 * If the device is not present, it is unnecessary to load device
261 * driver for it.
262 */
263 if (!device->status.present)
264 return -ENODEV;
265
266 for (id = ids; id->id[0]; id++)
267 list_for_each_entry(hwid, &device->pnp.ids, list)
268 if (!strcmp((char *) id->id, hwid->id))
269 return 0;
270
271 return -ENOENT;
272 }
273 EXPORT_SYMBOL(acpi_match_device_ids);
274
275 static void acpi_free_ids(struct acpi_device *device)
276 {
277 struct acpi_hardware_id *id, *tmp;
278
279 list_for_each_entry_safe(id, tmp, &device->pnp.ids, list) {
280 kfree(id->id);
281 kfree(id);
282 }
283 }
284
285 static void acpi_device_release(struct device *dev)
286 {
287 struct acpi_device *acpi_dev = to_acpi_device(dev);
288
289 acpi_free_ids(acpi_dev);
290 kfree(acpi_dev);
291 }
292
293 static int acpi_device_suspend(struct device *dev, pm_message_t state)
294 {
295 struct acpi_device *acpi_dev = to_acpi_device(dev);
296 struct acpi_driver *acpi_drv = acpi_dev->driver;
297
298 if (acpi_drv && acpi_drv->ops.suspend)
299 return acpi_drv->ops.suspend(acpi_dev, state);
300 return 0;
301 }
302
303 static int acpi_device_resume(struct device *dev)
304 {
305 struct acpi_device *acpi_dev = to_acpi_device(dev);
306 struct acpi_driver *acpi_drv = acpi_dev->driver;
307
308 if (acpi_drv && acpi_drv->ops.resume)
309 return acpi_drv->ops.resume(acpi_dev);
310 return 0;
311 }
312
313 static int acpi_bus_match(struct device *dev, struct device_driver *drv)
314 {
315 struct acpi_device *acpi_dev = to_acpi_device(dev);
316 struct acpi_driver *acpi_drv = to_acpi_driver(drv);
317
318 return !acpi_match_device_ids(acpi_dev, acpi_drv->ids);
319 }
320
321 static int acpi_device_uevent(struct device *dev, struct kobj_uevent_env *env)
322 {
323 struct acpi_device *acpi_dev = to_acpi_device(dev);
324 int len;
325
326 if (list_empty(&acpi_dev->pnp.ids))
327 return 0;
328
329 if (add_uevent_var(env, "MODALIAS="))
330 return -ENOMEM;
331 len = create_modalias(acpi_dev, &env->buf[env->buflen - 1],
332 sizeof(env->buf) - env->buflen);
333 if (len >= (sizeof(env->buf) - env->buflen))
334 return -ENOMEM;
335 env->buflen += len;
336 return 0;
337 }
338
339 static void acpi_device_notify(acpi_handle handle, u32 event, void *data)
340 {
341 struct acpi_device *device = data;
342
343 device->driver->ops.notify(device, event);
344 }
345
346 static acpi_status acpi_device_notify_fixed(void *data)
347 {
348 struct acpi_device *device = data;
349
350 /* Fixed hardware devices have no handles */
351 acpi_device_notify(NULL, ACPI_FIXED_HARDWARE_EVENT, device);
352 return AE_OK;
353 }
354
355 static int acpi_device_install_notify_handler(struct acpi_device *device)
356 {
357 acpi_status status;
358
359 if (device->device_type == ACPI_BUS_TYPE_POWER_BUTTON)
360 status =
361 acpi_install_fixed_event_handler(ACPI_EVENT_POWER_BUTTON,
362 acpi_device_notify_fixed,
363 device);
364 else if (device->device_type == ACPI_BUS_TYPE_SLEEP_BUTTON)
365 status =
366 acpi_install_fixed_event_handler(ACPI_EVENT_SLEEP_BUTTON,
367 acpi_device_notify_fixed,
368 device);
369 else
370 status = acpi_install_notify_handler(device->handle,
371 ACPI_DEVICE_NOTIFY,
372 acpi_device_notify,
373 device);
374
375 if (ACPI_FAILURE(status))
376 return -EINVAL;
377 return 0;
378 }
379
380 static void acpi_device_remove_notify_handler(struct acpi_device *device)
381 {
382 if (device->device_type == ACPI_BUS_TYPE_POWER_BUTTON)
383 acpi_remove_fixed_event_handler(ACPI_EVENT_POWER_BUTTON,
384 acpi_device_notify_fixed);
385 else if (device->device_type == ACPI_BUS_TYPE_SLEEP_BUTTON)
386 acpi_remove_fixed_event_handler(ACPI_EVENT_SLEEP_BUTTON,
387 acpi_device_notify_fixed);
388 else
389 acpi_remove_notify_handler(device->handle, ACPI_DEVICE_NOTIFY,
390 acpi_device_notify);
391 }
392
393 static int acpi_bus_driver_init(struct acpi_device *, struct acpi_driver *);
394 static int acpi_start_single_object(struct acpi_device *);
395 static int acpi_device_probe(struct device * dev)
396 {
397 struct acpi_device *acpi_dev = to_acpi_device(dev);
398 struct acpi_driver *acpi_drv = to_acpi_driver(dev->driver);
399 int ret;
400
401 ret = acpi_bus_driver_init(acpi_dev, acpi_drv);
402 if (!ret) {
403 if (acpi_dev->bus_ops.acpi_op_start)
404 acpi_start_single_object(acpi_dev);
405
406 if (acpi_drv->ops.notify) {
407 ret = acpi_device_install_notify_handler(acpi_dev);
408 if (ret) {
409 if (acpi_drv->ops.remove)
410 acpi_drv->ops.remove(acpi_dev,
411 acpi_dev->removal_type);
412 return ret;
413 }
414 }
415
416 ACPI_DEBUG_PRINT((ACPI_DB_INFO,
417 "Found driver [%s] for device [%s]\n",
418 acpi_drv->name, acpi_dev->pnp.bus_id));
419 get_device(dev);
420 }
421 return ret;
422 }
423
424 static int acpi_device_remove(struct device * dev)
425 {
426 struct acpi_device *acpi_dev = to_acpi_device(dev);
427 struct acpi_driver *acpi_drv = acpi_dev->driver;
428
429 if (acpi_drv) {
430 if (acpi_drv->ops.notify)
431 acpi_device_remove_notify_handler(acpi_dev);
432 if (acpi_drv->ops.remove)
433 acpi_drv->ops.remove(acpi_dev, acpi_dev->removal_type);
434 }
435 acpi_dev->driver = NULL;
436 acpi_dev->driver_data = NULL;
437
438 put_device(dev);
439 return 0;
440 }
441
442 struct bus_type acpi_bus_type = {
443 .name = "acpi",
444 .suspend = acpi_device_suspend,
445 .resume = acpi_device_resume,
446 .match = acpi_bus_match,
447 .probe = acpi_device_probe,
448 .remove = acpi_device_remove,
449 .uevent = acpi_device_uevent,
450 };
451
452 static int acpi_device_register(struct acpi_device *device)
453 {
454 int result;
455 struct acpi_device_bus_id *acpi_device_bus_id, *new_bus_id;
456 int found = 0;
457
458 /*
459 * Linkage
460 * -------
461 * Link this device to its parent and siblings.
462 */
463 INIT_LIST_HEAD(&device->children);
464 INIT_LIST_HEAD(&device->node);
465 INIT_LIST_HEAD(&device->wakeup_list);
466
467 new_bus_id = kzalloc(sizeof(struct acpi_device_bus_id), GFP_KERNEL);
468 if (!new_bus_id) {
469 printk(KERN_ERR PREFIX "Memory allocation error\n");
470 return -ENOMEM;
471 }
472
473 mutex_lock(&acpi_device_lock);
474 /*
475 * Find suitable bus_id and instance number in acpi_bus_id_list
476 * If failed, create one and link it into acpi_bus_id_list
477 */
478 list_for_each_entry(acpi_device_bus_id, &acpi_bus_id_list, node) {
479 if (!strcmp(acpi_device_bus_id->bus_id,
480 acpi_device_hid(device))) {
481 acpi_device_bus_id->instance_no++;
482 found = 1;
483 kfree(new_bus_id);
484 break;
485 }
486 }
487 if (!found) {
488 acpi_device_bus_id = new_bus_id;
489 strcpy(acpi_device_bus_id->bus_id, acpi_device_hid(device));
490 acpi_device_bus_id->instance_no = 0;
491 list_add_tail(&acpi_device_bus_id->node, &acpi_bus_id_list);
492 }
493 dev_set_name(&device->dev, "%s:%02x", acpi_device_bus_id->bus_id, acpi_device_bus_id->instance_no);
494
495 if (device->parent)
496 list_add_tail(&device->node, &device->parent->children);
497
498 if (device->wakeup.flags.valid)
499 list_add_tail(&device->wakeup_list, &acpi_wakeup_device_list);
500 mutex_unlock(&acpi_device_lock);
501
502 if (device->parent)
503 device->dev.parent = &device->parent->dev;
504 device->dev.bus = &acpi_bus_type;
505 device->dev.release = &acpi_device_release;
506 result = device_register(&device->dev);
507 if (result) {
508 dev_err(&device->dev, "Error registering device\n");
509 goto end;
510 }
511
512 result = acpi_device_setup_files(device);
513 if (result)
514 printk(KERN_ERR PREFIX "Error creating sysfs interface for device %s\n",
515 dev_name(&device->dev));
516
517 device->removal_type = ACPI_BUS_REMOVAL_NORMAL;
518 return 0;
519 end:
520 mutex_lock(&acpi_device_lock);
521 if (device->parent)
522 list_del(&device->node);
523 list_del(&device->wakeup_list);
524 mutex_unlock(&acpi_device_lock);
525 return result;
526 }
527
528 static void acpi_device_unregister(struct acpi_device *device, int type)
529 {
530 mutex_lock(&acpi_device_lock);
531 if (device->parent)
532 list_del(&device->node);
533
534 list_del(&device->wakeup_list);
535 mutex_unlock(&acpi_device_lock);
536
537 acpi_detach_data(device->handle, acpi_bus_data_handler);
538
539 acpi_device_remove_files(device);
540 device_unregister(&device->dev);
541 }
542
543 /* --------------------------------------------------------------------------
544 Driver Management
545 -------------------------------------------------------------------------- */
546 /**
547 * acpi_bus_driver_init - add a device to a driver
548 * @device: the device to add and initialize
549 * @driver: driver for the device
550 *
551 * Used to initialize a device via its device driver. Called whenever a
552 * driver is bound to a device. Invokes the driver's add() ops.
553 */
554 static int
555 acpi_bus_driver_init(struct acpi_device *device, struct acpi_driver *driver)
556 {
557 int result = 0;
558
559 if (!device || !driver)
560 return -EINVAL;
561
562 if (!driver->ops.add)
563 return -ENOSYS;
564
565 result = driver->ops.add(device);
566 if (result) {
567 device->driver = NULL;
568 device->driver_data = NULL;
569 return result;
570 }
571
572 device->driver = driver;
573
574 /*
575 * TBD - Configuration Management: Assign resources to device based
576 * upon possible configuration and currently allocated resources.
577 */
578
579 ACPI_DEBUG_PRINT((ACPI_DB_INFO,
580 "Driver successfully bound to device\n"));
581 return 0;
582 }
583
584 static int acpi_start_single_object(struct acpi_device *device)
585 {
586 int result = 0;
587 struct acpi_driver *driver;
588
589
590 if (!(driver = device->driver))
591 return 0;
592
593 if (driver->ops.start) {
594 result = driver->ops.start(device);
595 if (result && driver->ops.remove)
596 driver->ops.remove(device, ACPI_BUS_REMOVAL_NORMAL);
597 }
598
599 return result;
600 }
601
602 /**
603 * acpi_bus_register_driver - register a driver with the ACPI bus
604 * @driver: driver being registered
605 *
606 * Registers a driver with the ACPI bus. Searches the namespace for all
607 * devices that match the driver's criteria and binds. Returns zero for
608 * success or a negative error status for failure.
609 */
610 int acpi_bus_register_driver(struct acpi_driver *driver)
611 {
612 int ret;
613
614 if (acpi_disabled)
615 return -ENODEV;
616 driver->drv.name = driver->name;
617 driver->drv.bus = &acpi_bus_type;
618 driver->drv.owner = driver->owner;
619
620 ret = driver_register(&driver->drv);
621 return ret;
622 }
623
624 EXPORT_SYMBOL(acpi_bus_register_driver);
625
626 /**
627 * acpi_bus_unregister_driver - unregisters a driver with the APIC bus
628 * @driver: driver to unregister
629 *
630 * Unregisters a driver with the ACPI bus. Searches the namespace for all
631 * devices that match the driver's criteria and unbinds.
632 */
633 void acpi_bus_unregister_driver(struct acpi_driver *driver)
634 {
635 driver_unregister(&driver->drv);
636 }
637
638 EXPORT_SYMBOL(acpi_bus_unregister_driver);
639
640 /* --------------------------------------------------------------------------
641 Device Enumeration
642 -------------------------------------------------------------------------- */
643 static struct acpi_device *acpi_bus_get_parent(acpi_handle handle)
644 {
645 acpi_status status;
646 int ret;
647 struct acpi_device *device;
648
649 /*
650 * Fixed hardware devices do not appear in the namespace and do not
651 * have handles, but we fabricate acpi_devices for them, so we have
652 * to deal with them specially.
653 */
654 if (handle == NULL)
655 return acpi_root;
656
657 do {
658 status = acpi_get_parent(handle, &handle);
659 if (status == AE_NULL_ENTRY)
660 return NULL;
661 if (ACPI_FAILURE(status))
662 return acpi_root;
663
664 ret = acpi_bus_get_device(handle, &device);
665 if (ret == 0)
666 return device;
667 } while (1);
668 }
669
670 acpi_status
671 acpi_bus_get_ejd(acpi_handle handle, acpi_handle *ejd)
672 {
673 acpi_status status;
674 acpi_handle tmp;
675 struct acpi_buffer buffer = {ACPI_ALLOCATE_BUFFER, NULL};
676 union acpi_object *obj;
677
678 status = acpi_get_handle(handle, "_EJD", &tmp);
679 if (ACPI_FAILURE(status))
680 return status;
681
682 status = acpi_evaluate_object(handle, "_EJD", NULL, &buffer);
683 if (ACPI_SUCCESS(status)) {
684 obj = buffer.pointer;
685 status = acpi_get_handle(ACPI_ROOT_OBJECT, obj->string.pointer,
686 ejd);
687 kfree(buffer.pointer);
688 }
689 return status;
690 }
691 EXPORT_SYMBOL_GPL(acpi_bus_get_ejd);
692
693 void acpi_bus_data_handler(acpi_handle handle, void *context)
694 {
695
696 /* TBD */
697
698 return;
699 }
700
701 static int acpi_bus_get_perf_flags(struct acpi_device *device)
702 {
703 device->performance.state = ACPI_STATE_UNKNOWN;
704 return 0;
705 }
706
707 static acpi_status
708 acpi_bus_extract_wakeup_device_power_package(acpi_handle handle,
709 struct acpi_device_wakeup *wakeup)
710 {
711 struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL };
712 union acpi_object *package = NULL;
713 union acpi_object *element = NULL;
714 acpi_status status;
715 int i = 0;
716
717 if (!wakeup)
718 return AE_BAD_PARAMETER;
719
720 /* _PRW */
721 status = acpi_evaluate_object(handle, "_PRW", NULL, &buffer);
722 if (ACPI_FAILURE(status)) {
723 ACPI_EXCEPTION((AE_INFO, status, "Evaluating _PRW"));
724 return status;
725 }
726
727 package = (union acpi_object *)buffer.pointer;
728
729 if (!package || (package->package.count < 2)) {
730 status = AE_BAD_DATA;
731 goto out;
732 }
733
734 element = &(package->package.elements[0]);
735 if (!element) {
736 status = AE_BAD_DATA;
737 goto out;
738 }
739 if (element->type == ACPI_TYPE_PACKAGE) {
740 if ((element->package.count < 2) ||
741 (element->package.elements[0].type !=
742 ACPI_TYPE_LOCAL_REFERENCE)
743 || (element->package.elements[1].type != ACPI_TYPE_INTEGER)) {
744 status = AE_BAD_DATA;
745 goto out;
746 }
747 wakeup->gpe_device =
748 element->package.elements[0].reference.handle;
749 wakeup->gpe_number =
750 (u32) element->package.elements[1].integer.value;
751 } else if (element->type == ACPI_TYPE_INTEGER) {
752 wakeup->gpe_device = NULL;
753 wakeup->gpe_number = element->integer.value;
754 } else {
755 status = AE_BAD_DATA;
756 goto out;
757 }
758
759 element = &(package->package.elements[1]);
760 if (element->type != ACPI_TYPE_INTEGER) {
761 status = AE_BAD_DATA;
762 goto out;
763 }
764 wakeup->sleep_state = element->integer.value;
765
766 if ((package->package.count - 2) > ACPI_MAX_HANDLES) {
767 status = AE_NO_MEMORY;
768 goto out;
769 }
770 wakeup->resources.count = package->package.count - 2;
771 for (i = 0; i < wakeup->resources.count; i++) {
772 element = &(package->package.elements[i + 2]);
773 if (element->type != ACPI_TYPE_LOCAL_REFERENCE) {
774 status = AE_BAD_DATA;
775 goto out;
776 }
777
778 wakeup->resources.handles[i] = element->reference.handle;
779 }
780
781 acpi_setup_gpe_for_wake(handle, wakeup->gpe_device, wakeup->gpe_number);
782
783 out:
784 kfree(buffer.pointer);
785
786 return status;
787 }
788
789 static void acpi_bus_set_run_wake_flags(struct acpi_device *device)
790 {
791 struct acpi_device_id button_device_ids[] = {
792 {"PNP0C0D", 0},
793 {"PNP0C0C", 0},
794 {"PNP0C0E", 0},
795 {"", 0},
796 };
797 acpi_status status;
798 acpi_event_status event_status;
799
800 device->wakeup.flags.notifier_present = 0;
801
802 /* Power button, Lid switch always enable wakeup */
803 if (!acpi_match_device_ids(device, button_device_ids)) {
804 device->wakeup.flags.run_wake = 1;
805 device_set_wakeup_capable(&device->dev, true);
806 return;
807 }
808
809 status = acpi_get_gpe_status(device->wakeup.gpe_device,
810 device->wakeup.gpe_number,
811 &event_status);
812 if (status == AE_OK)
813 device->wakeup.flags.run_wake =
814 !!(event_status & ACPI_EVENT_FLAG_HANDLE);
815 }
816
817 static void acpi_bus_get_wakeup_device_flags(struct acpi_device *device)
818 {
819 acpi_handle temp;
820 acpi_status status = 0;
821 int psw_error;
822
823 /* Presence of _PRW indicates wake capable */
824 status = acpi_get_handle(device->handle, "_PRW", &temp);
825 if (ACPI_FAILURE(status))
826 return;
827
828 status = acpi_bus_extract_wakeup_device_power_package(device->handle,
829 &device->wakeup);
830 if (ACPI_FAILURE(status)) {
831 ACPI_EXCEPTION((AE_INFO, status, "Extracting _PRW package"));
832 return;
833 }
834
835 device->wakeup.flags.valid = 1;
836 device->wakeup.prepare_count = 0;
837 acpi_bus_set_run_wake_flags(device);
838 /* Call _PSW/_DSW object to disable its ability to wake the sleeping
839 * system for the ACPI device with the _PRW object.
840 * The _PSW object is depreciated in ACPI 3.0 and is replaced by _DSW.
841 * So it is necessary to call _DSW object first. Only when it is not
842 * present will the _PSW object used.
843 */
844 psw_error = acpi_device_sleep_wake(device, 0, 0, 0);
845 if (psw_error)
846 ACPI_DEBUG_PRINT((ACPI_DB_INFO,
847 "error in _DSW or _PSW evaluation\n"));
848 }
849
850 static void acpi_bus_add_power_resource(acpi_handle handle);
851
852 static int acpi_bus_get_power_flags(struct acpi_device *device)
853 {
854 acpi_status status = 0;
855 acpi_handle handle = NULL;
856 u32 i = 0;
857
858
859 /*
860 * Power Management Flags
861 */
862 status = acpi_get_handle(device->handle, "_PSC", &handle);
863 if (ACPI_SUCCESS(status))
864 device->power.flags.explicit_get = 1;
865 status = acpi_get_handle(device->handle, "_IRC", &handle);
866 if (ACPI_SUCCESS(status))
867 device->power.flags.inrush_current = 1;
868
869 /*
870 * Enumerate supported power management states
871 */
872 for (i = ACPI_STATE_D0; i <= ACPI_STATE_D3_HOT; i++) {
873 struct acpi_device_power_state *ps = &device->power.states[i];
874 char object_name[5] = { '_', 'P', 'R', '0' + i, '\0' };
875
876 /* Evaluate "_PRx" to se if power resources are referenced */
877 acpi_evaluate_reference(device->handle, object_name, NULL,
878 &ps->resources);
879 if (ps->resources.count) {
880 int j;
881
882 device->power.flags.power_resources = 1;
883 for (j = 0; j < ps->resources.count; j++)
884 acpi_bus_add_power_resource(ps->resources.handles[j]);
885 }
886
887 /* Evaluate "_PSx" to see if we can do explicit sets */
888 object_name[2] = 'S';
889 status = acpi_get_handle(device->handle, object_name, &handle);
890 if (ACPI_SUCCESS(status))
891 ps->flags.explicit_set = 1;
892
893 /*
894 * State is valid if there are means to put the device into it.
895 * D3hot is only valid if _PR3 present.
896 */
897 if (ps->resources.count ||
898 (ps->flags.explicit_set && i < ACPI_STATE_D3_HOT))
899 ps->flags.valid = 1;
900
901 ps->power = -1; /* Unknown - driver assigned */
902 ps->latency = -1; /* Unknown - driver assigned */
903 }
904
905 /* Set defaults for D0 and D3 states (always valid) */
906 device->power.states[ACPI_STATE_D0].flags.valid = 1;
907 device->power.states[ACPI_STATE_D0].power = 100;
908 device->power.states[ACPI_STATE_D3].flags.valid = 1;
909 device->power.states[ACPI_STATE_D3].power = 0;
910
911 /* Set D3cold's explicit_set flag if _PS3 exists. */
912 if (device->power.states[ACPI_STATE_D3_HOT].flags.explicit_set)
913 device->power.states[ACPI_STATE_D3_COLD].flags.explicit_set = 1;
914
915 acpi_bus_init_power(device);
916
917 return 0;
918 }
919
920 static int acpi_bus_get_flags(struct acpi_device *device)
921 {
922 acpi_status status = AE_OK;
923 acpi_handle temp = NULL;
924
925
926 /* Presence of _STA indicates 'dynamic_status' */
927 status = acpi_get_handle(device->handle, "_STA", &temp);
928 if (ACPI_SUCCESS(status))
929 device->flags.dynamic_status = 1;
930
931 /* Presence of _RMV indicates 'removable' */
932 status = acpi_get_handle(device->handle, "_RMV", &temp);
933 if (ACPI_SUCCESS(status))
934 device->flags.removable = 1;
935
936 /* Presence of _EJD|_EJ0 indicates 'ejectable' */
937 status = acpi_get_handle(device->handle, "_EJD", &temp);
938 if (ACPI_SUCCESS(status))
939 device->flags.ejectable = 1;
940 else {
941 status = acpi_get_handle(device->handle, "_EJ0", &temp);
942 if (ACPI_SUCCESS(status))
943 device->flags.ejectable = 1;
944 }
945
946 /* Presence of _LCK indicates 'lockable' */
947 status = acpi_get_handle(device->handle, "_LCK", &temp);
948 if (ACPI_SUCCESS(status))
949 device->flags.lockable = 1;
950
951 /* Power resources cannot be power manageable. */
952 if (device->device_type == ACPI_BUS_TYPE_POWER)
953 return 0;
954
955 /* Presence of _PS0|_PR0 indicates 'power manageable' */
956 status = acpi_get_handle(device->handle, "_PS0", &temp);
957 if (ACPI_FAILURE(status))
958 status = acpi_get_handle(device->handle, "_PR0", &temp);
959 if (ACPI_SUCCESS(status))
960 device->flags.power_manageable = 1;
961
962 /* TBD: Performance management */
963
964 return 0;
965 }
966
967 static void acpi_device_get_busid(struct acpi_device *device)
968 {
969 char bus_id[5] = { '?', 0 };
970 struct acpi_buffer buffer = { sizeof(bus_id), bus_id };
971 int i = 0;
972
973 /*
974 * Bus ID
975 * ------
976 * The device's Bus ID is simply the object name.
977 * TBD: Shouldn't this value be unique (within the ACPI namespace)?
978 */
979 if (ACPI_IS_ROOT_DEVICE(device)) {
980 strcpy(device->pnp.bus_id, "ACPI");
981 return;
982 }
983
984 switch (device->device_type) {
985 case ACPI_BUS_TYPE_POWER_BUTTON:
986 strcpy(device->pnp.bus_id, "PWRF");
987 break;
988 case ACPI_BUS_TYPE_SLEEP_BUTTON:
989 strcpy(device->pnp.bus_id, "SLPF");
990 break;
991 default:
992 acpi_get_name(device->handle, ACPI_SINGLE_NAME, &buffer);
993 /* Clean up trailing underscores (if any) */
994 for (i = 3; i > 1; i--) {
995 if (bus_id[i] == '_')
996 bus_id[i] = '\0';
997 else
998 break;
999 }
1000 strcpy(device->pnp.bus_id, bus_id);
1001 break;
1002 }
1003 }
1004
1005 /*
1006 * acpi_bay_match - see if a device is an ejectable driver bay
1007 *
1008 * If an acpi object is ejectable and has one of the ACPI ATA methods defined,
1009 * then we can safely call it an ejectable drive bay
1010 */
1011 static int acpi_bay_match(struct acpi_device *device){
1012 acpi_status status;
1013 acpi_handle handle;
1014 acpi_handle tmp;
1015 acpi_handle phandle;
1016
1017 handle = device->handle;
1018
1019 status = acpi_get_handle(handle, "_EJ0", &tmp);
1020 if (ACPI_FAILURE(status))
1021 return -ENODEV;
1022
1023 if ((ACPI_SUCCESS(acpi_get_handle(handle, "_GTF", &tmp))) ||
1024 (ACPI_SUCCESS(acpi_get_handle(handle, "_GTM", &tmp))) ||
1025 (ACPI_SUCCESS(acpi_get_handle(handle, "_STM", &tmp))) ||
1026 (ACPI_SUCCESS(acpi_get_handle(handle, "_SDD", &tmp))))
1027 return 0;
1028
1029 if (acpi_get_parent(handle, &phandle))
1030 return -ENODEV;
1031
1032 if ((ACPI_SUCCESS(acpi_get_handle(phandle, "_GTF", &tmp))) ||
1033 (ACPI_SUCCESS(acpi_get_handle(phandle, "_GTM", &tmp))) ||
1034 (ACPI_SUCCESS(acpi_get_handle(phandle, "_STM", &tmp))) ||
1035 (ACPI_SUCCESS(acpi_get_handle(phandle, "_SDD", &tmp))))
1036 return 0;
1037
1038 return -ENODEV;
1039 }
1040
1041 /*
1042 * acpi_dock_match - see if a device has a _DCK method
1043 */
1044 static int acpi_dock_match(struct acpi_device *device)
1045 {
1046 acpi_handle tmp;
1047 return acpi_get_handle(device->handle, "_DCK", &tmp);
1048 }
1049
1050 const char *acpi_device_hid(struct acpi_device *device)
1051 {
1052 struct acpi_hardware_id *hid;
1053
1054 if (list_empty(&device->pnp.ids))
1055 return dummy_hid;
1056
1057 hid = list_first_entry(&device->pnp.ids, struct acpi_hardware_id, list);
1058 return hid->id;
1059 }
1060 EXPORT_SYMBOL(acpi_device_hid);
1061
1062 static void acpi_add_id(struct acpi_device *device, const char *dev_id)
1063 {
1064 struct acpi_hardware_id *id;
1065
1066 id = kmalloc(sizeof(*id), GFP_KERNEL);
1067 if (!id)
1068 return;
1069
1070 id->id = kstrdup(dev_id, GFP_KERNEL);
1071 if (!id->id) {
1072 kfree(id);
1073 return;
1074 }
1075
1076 list_add_tail(&id->list, &device->pnp.ids);
1077 }
1078
1079 /*
1080 * Old IBM workstations have a DSDT bug wherein the SMBus object
1081 * lacks the SMBUS01 HID and the methods do not have the necessary "_"
1082 * prefix. Work around this.
1083 */
1084 static int acpi_ibm_smbus_match(struct acpi_device *device)
1085 {
1086 acpi_handle h_dummy;
1087 struct acpi_buffer path = {ACPI_ALLOCATE_BUFFER, NULL};
1088 int result;
1089
1090 if (!dmi_name_in_vendors("IBM"))
1091 return -ENODEV;
1092
1093 /* Look for SMBS object */
1094 result = acpi_get_name(device->handle, ACPI_SINGLE_NAME, &path);
1095 if (result)
1096 return result;
1097
1098 if (strcmp("SMBS", path.pointer)) {
1099 result = -ENODEV;
1100 goto out;
1101 }
1102
1103 /* Does it have the necessary (but misnamed) methods? */
1104 result = -ENODEV;
1105 if (ACPI_SUCCESS(acpi_get_handle(device->handle, "SBI", &h_dummy)) &&
1106 ACPI_SUCCESS(acpi_get_handle(device->handle, "SBR", &h_dummy)) &&
1107 ACPI_SUCCESS(acpi_get_handle(device->handle, "SBW", &h_dummy)))
1108 result = 0;
1109 out:
1110 kfree(path.pointer);
1111 return result;
1112 }
1113
1114 static void acpi_device_set_id(struct acpi_device *device)
1115 {
1116 acpi_status status;
1117 struct acpi_device_info *info;
1118 struct acpica_device_id_list *cid_list;
1119 int i;
1120
1121 switch (device->device_type) {
1122 case ACPI_BUS_TYPE_DEVICE:
1123 if (ACPI_IS_ROOT_DEVICE(device)) {
1124 acpi_add_id(device, ACPI_SYSTEM_HID);
1125 break;
1126 }
1127
1128 status = acpi_get_object_info(device->handle, &info);
1129 if (ACPI_FAILURE(status)) {
1130 printk(KERN_ERR PREFIX "%s: Error reading device info\n", __func__);
1131 return;
1132 }
1133
1134 if (info->valid & ACPI_VALID_HID)
1135 acpi_add_id(device, info->hardware_id.string);
1136 if (info->valid & ACPI_VALID_CID) {
1137 cid_list = &info->compatible_id_list;
1138 for (i = 0; i < cid_list->count; i++)
1139 acpi_add_id(device, cid_list->ids[i].string);
1140 }
1141 if (info->valid & ACPI_VALID_ADR) {
1142 device->pnp.bus_address = info->address;
1143 device->flags.bus_address = 1;
1144 }
1145
1146 kfree(info);
1147
1148 /*
1149 * Some devices don't reliably have _HIDs & _CIDs, so add
1150 * synthetic HIDs to make sure drivers can find them.
1151 */
1152 if (acpi_is_video_device(device))
1153 acpi_add_id(device, ACPI_VIDEO_HID);
1154 else if (ACPI_SUCCESS(acpi_bay_match(device)))
1155 acpi_add_id(device, ACPI_BAY_HID);
1156 else if (ACPI_SUCCESS(acpi_dock_match(device)))
1157 acpi_add_id(device, ACPI_DOCK_HID);
1158 else if (!acpi_ibm_smbus_match(device))
1159 acpi_add_id(device, ACPI_SMBUS_IBM_HID);
1160 else if (!acpi_device_hid(device) &&
1161 ACPI_IS_ROOT_DEVICE(device->parent)) {
1162 acpi_add_id(device, ACPI_BUS_HID); /* \_SB, LNXSYBUS */
1163 strcpy(device->pnp.device_name, ACPI_BUS_DEVICE_NAME);
1164 strcpy(device->pnp.device_class, ACPI_BUS_CLASS);
1165 }
1166
1167 break;
1168 case ACPI_BUS_TYPE_POWER:
1169 acpi_add_id(device, ACPI_POWER_HID);
1170 break;
1171 case ACPI_BUS_TYPE_PROCESSOR:
1172 acpi_add_id(device, ACPI_PROCESSOR_OBJECT_HID);
1173 break;
1174 case ACPI_BUS_TYPE_THERMAL:
1175 acpi_add_id(device, ACPI_THERMAL_HID);
1176 break;
1177 case ACPI_BUS_TYPE_POWER_BUTTON:
1178 acpi_add_id(device, ACPI_BUTTON_HID_POWERF);
1179 break;
1180 case ACPI_BUS_TYPE_SLEEP_BUTTON:
1181 acpi_add_id(device, ACPI_BUTTON_HID_SLEEPF);
1182 break;
1183 }
1184 }
1185
1186 static int acpi_device_set_context(struct acpi_device *device)
1187 {
1188 acpi_status status;
1189
1190 /*
1191 * Context
1192 * -------
1193 * Attach this 'struct acpi_device' to the ACPI object. This makes
1194 * resolutions from handle->device very efficient. Fixed hardware
1195 * devices have no handles, so we skip them.
1196 */
1197 if (!device->handle)
1198 return 0;
1199
1200 status = acpi_attach_data(device->handle,
1201 acpi_bus_data_handler, device);
1202 if (ACPI_SUCCESS(status))
1203 return 0;
1204
1205 printk(KERN_ERR PREFIX "Error attaching device data\n");
1206 return -ENODEV;
1207 }
1208
1209 static int acpi_bus_remove(struct acpi_device *dev, int rmdevice)
1210 {
1211 if (!dev)
1212 return -EINVAL;
1213
1214 dev->removal_type = ACPI_BUS_REMOVAL_EJECT;
1215 device_release_driver(&dev->dev);
1216
1217 if (!rmdevice)
1218 return 0;
1219
1220 /*
1221 * unbind _ADR-Based Devices when hot removal
1222 */
1223 if (dev->flags.bus_address) {
1224 if ((dev->parent) && (dev->parent->ops.unbind))
1225 dev->parent->ops.unbind(dev);
1226 }
1227 acpi_device_unregister(dev, ACPI_BUS_REMOVAL_EJECT);
1228
1229 return 0;
1230 }
1231
1232 static int acpi_add_single_object(struct acpi_device **child,
1233 acpi_handle handle, int type,
1234 unsigned long long sta,
1235 struct acpi_bus_ops *ops)
1236 {
1237 int result;
1238 struct acpi_device *device;
1239 struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL };
1240
1241 device = kzalloc(sizeof(struct acpi_device), GFP_KERNEL);
1242 if (!device) {
1243 printk(KERN_ERR PREFIX "Memory allocation error\n");
1244 return -ENOMEM;
1245 }
1246
1247 INIT_LIST_HEAD(&device->pnp.ids);
1248 device->device_type = type;
1249 device->handle = handle;
1250 device->parent = acpi_bus_get_parent(handle);
1251 device->bus_ops = *ops; /* workround for not call .start */
1252 STRUCT_TO_INT(device->status) = sta;
1253
1254 acpi_device_get_busid(device);
1255
1256 /*
1257 * Flags
1258 * -----
1259 * Note that we only look for object handles -- cannot evaluate objects
1260 * until we know the device is present and properly initialized.
1261 */
1262 result = acpi_bus_get_flags(device);
1263 if (result)
1264 goto end;
1265
1266 /*
1267 * Initialize Device
1268 * -----------------
1269 * TBD: Synch with Core's enumeration/initialization process.
1270 */
1271 acpi_device_set_id(device);
1272
1273 /*
1274 * Power Management
1275 * ----------------
1276 */
1277 if (device->flags.power_manageable) {
1278 result = acpi_bus_get_power_flags(device);
1279 if (result)
1280 goto end;
1281 }
1282
1283 /*
1284 * Wakeup device management
1285 *-----------------------
1286 */
1287 acpi_bus_get_wakeup_device_flags(device);
1288
1289 /*
1290 * Performance Management
1291 * ----------------------
1292 */
1293 if (device->flags.performance_manageable) {
1294 result = acpi_bus_get_perf_flags(device);
1295 if (result)
1296 goto end;
1297 }
1298
1299 if ((result = acpi_device_set_context(device)))
1300 goto end;
1301
1302 result = acpi_device_register(device);
1303
1304 /*
1305 * Bind _ADR-Based Devices when hot add
1306 */
1307 if (device->flags.bus_address) {
1308 if (device->parent && device->parent->ops.bind)
1309 device->parent->ops.bind(device);
1310 }
1311
1312 end:
1313 if (!result) {
1314 acpi_get_name(handle, ACPI_FULL_PATHNAME, &buffer);
1315 ACPI_DEBUG_PRINT((ACPI_DB_INFO,
1316 "Adding %s [%s] parent %s\n", dev_name(&device->dev),
1317 (char *) buffer.pointer,
1318 device->parent ? dev_name(&device->parent->dev) :
1319 "(null)"));
1320 kfree(buffer.pointer);
1321 *child = device;
1322 } else
1323 acpi_device_release(&device->dev);
1324
1325 return result;
1326 }
1327
1328 #define ACPI_STA_DEFAULT (ACPI_STA_DEVICE_PRESENT | ACPI_STA_DEVICE_ENABLED | \
1329 ACPI_STA_DEVICE_UI | ACPI_STA_DEVICE_FUNCTIONING)
1330
1331 static void acpi_bus_add_power_resource(acpi_handle handle)
1332 {
1333 struct acpi_bus_ops ops = {
1334 .acpi_op_add = 1,
1335 .acpi_op_start = 1,
1336 };
1337 struct acpi_device *device = NULL;
1338
1339 acpi_bus_get_device(handle, &device);
1340 if (!device)
1341 acpi_add_single_object(&device, handle, ACPI_BUS_TYPE_POWER,
1342 ACPI_STA_DEFAULT, &ops);
1343 }
1344
1345 static int acpi_bus_type_and_status(acpi_handle handle, int *type,
1346 unsigned long long *sta)
1347 {
1348 acpi_status status;
1349 acpi_object_type acpi_type;
1350
1351 status = acpi_get_type(handle, &acpi_type);
1352 if (ACPI_FAILURE(status))
1353 return -ENODEV;
1354
1355 switch (acpi_type) {
1356 case ACPI_TYPE_ANY: /* for ACPI_ROOT_OBJECT */
1357 case ACPI_TYPE_DEVICE:
1358 *type = ACPI_BUS_TYPE_DEVICE;
1359 status = acpi_bus_get_status_handle(handle, sta);
1360 if (ACPI_FAILURE(status))
1361 return -ENODEV;
1362 break;
1363 case ACPI_TYPE_PROCESSOR:
1364 *type = ACPI_BUS_TYPE_PROCESSOR;
1365 status = acpi_bus_get_status_handle(handle, sta);
1366 if (ACPI_FAILURE(status))
1367 return -ENODEV;
1368 break;
1369 case ACPI_TYPE_THERMAL:
1370 *type = ACPI_BUS_TYPE_THERMAL;
1371 *sta = ACPI_STA_DEFAULT;
1372 break;
1373 case ACPI_TYPE_POWER:
1374 *type = ACPI_BUS_TYPE_POWER;
1375 *sta = ACPI_STA_DEFAULT;
1376 break;
1377 default:
1378 return -ENODEV;
1379 }
1380
1381 return 0;
1382 }
1383
1384 static acpi_status acpi_bus_check_add(acpi_handle handle, u32 lvl,
1385 void *context, void **return_value)
1386 {
1387 struct acpi_bus_ops *ops = context;
1388 int type;
1389 unsigned long long sta;
1390 struct acpi_device *device;
1391 acpi_status status;
1392 int result;
1393
1394 result = acpi_bus_type_and_status(handle, &type, &sta);
1395 if (result)
1396 return AE_OK;
1397
1398 if (!(sta & ACPI_STA_DEVICE_PRESENT) &&
1399 !(sta & ACPI_STA_DEVICE_FUNCTIONING)) {
1400 struct acpi_device_wakeup wakeup;
1401 acpi_handle temp;
1402
1403 status = acpi_get_handle(handle, "_PRW", &temp);
1404 if (ACPI_SUCCESS(status))
1405 acpi_bus_extract_wakeup_device_power_package(handle,
1406 &wakeup);
1407 return AE_CTRL_DEPTH;
1408 }
1409
1410 /*
1411 * We may already have an acpi_device from a previous enumeration. If
1412 * so, we needn't add it again, but we may still have to start it.
1413 */
1414 device = NULL;
1415 acpi_bus_get_device(handle, &device);
1416 if (ops->acpi_op_add && !device)
1417 acpi_add_single_object(&device, handle, type, sta, ops);
1418
1419 if (!device)
1420 return AE_CTRL_DEPTH;
1421
1422 if (ops->acpi_op_start && !(ops->acpi_op_add)) {
1423 status = acpi_start_single_object(device);
1424 if (ACPI_FAILURE(status))
1425 return AE_CTRL_DEPTH;
1426 }
1427
1428 if (!*return_value)
1429 *return_value = device;
1430 return AE_OK;
1431 }
1432
1433 static int acpi_bus_scan(acpi_handle handle, struct acpi_bus_ops *ops,
1434 struct acpi_device **child)
1435 {
1436 acpi_status status;
1437 void *device = NULL;
1438
1439 status = acpi_bus_check_add(handle, 0, ops, &device);
1440 if (ACPI_SUCCESS(status))
1441 acpi_walk_namespace(ACPI_TYPE_ANY, handle, ACPI_UINT32_MAX,
1442 acpi_bus_check_add, NULL, ops, &device);
1443
1444 if (child)
1445 *child = device;
1446
1447 if (device)
1448 return 0;
1449 else
1450 return -ENODEV;
1451 }
1452
1453 /*
1454 * acpi_bus_add and acpi_bus_start
1455 *
1456 * scan a given ACPI tree and (probably recently hot-plugged)
1457 * create and add or starts found devices.
1458 *
1459 * If no devices were found -ENODEV is returned which does not
1460 * mean that this is a real error, there just have been no suitable
1461 * ACPI objects in the table trunk from which the kernel could create
1462 * a device and add/start an appropriate driver.
1463 */
1464
1465 int
1466 acpi_bus_add(struct acpi_device **child,
1467 struct acpi_device *parent, acpi_handle handle, int type)
1468 {
1469 struct acpi_bus_ops ops;
1470
1471 memset(&ops, 0, sizeof(ops));
1472 ops.acpi_op_add = 1;
1473
1474 return acpi_bus_scan(handle, &ops, child);
1475 }
1476 EXPORT_SYMBOL(acpi_bus_add);
1477
1478 int acpi_bus_start(struct acpi_device *device)
1479 {
1480 struct acpi_bus_ops ops;
1481 int result;
1482
1483 if (!device)
1484 return -EINVAL;
1485
1486 memset(&ops, 0, sizeof(ops));
1487 ops.acpi_op_start = 1;
1488
1489 result = acpi_bus_scan(device->handle, &ops, NULL);
1490
1491 acpi_update_all_gpes();
1492
1493 return result;
1494 }
1495 EXPORT_SYMBOL(acpi_bus_start);
1496
1497 int acpi_bus_trim(struct acpi_device *start, int rmdevice)
1498 {
1499 acpi_status status;
1500 struct acpi_device *parent, *child;
1501 acpi_handle phandle, chandle;
1502 acpi_object_type type;
1503 u32 level = 1;
1504 int err = 0;
1505
1506 parent = start;
1507 phandle = start->handle;
1508 child = chandle = NULL;
1509
1510 while ((level > 0) && parent && (!err)) {
1511 status = acpi_get_next_object(ACPI_TYPE_ANY, phandle,
1512 chandle, &chandle);
1513
1514 /*
1515 * If this scope is exhausted then move our way back up.
1516 */
1517 if (ACPI_FAILURE(status)) {
1518 level--;
1519 chandle = phandle;
1520 acpi_get_parent(phandle, &phandle);
1521 child = parent;
1522 parent = parent->parent;
1523
1524 if (level == 0)
1525 err = acpi_bus_remove(child, rmdevice);
1526 else
1527 err = acpi_bus_remove(child, 1);
1528
1529 continue;
1530 }
1531
1532 status = acpi_get_type(chandle, &type);
1533 if (ACPI_FAILURE(status)) {
1534 continue;
1535 }
1536 /*
1537 * If there is a device corresponding to chandle then
1538 * parse it (depth-first).
1539 */
1540 if (acpi_bus_get_device(chandle, &child) == 0) {
1541 level++;
1542 phandle = chandle;
1543 chandle = NULL;
1544 parent = child;
1545 }
1546 continue;
1547 }
1548 return err;
1549 }
1550 EXPORT_SYMBOL_GPL(acpi_bus_trim);
1551
1552 static int acpi_bus_scan_fixed(void)
1553 {
1554 int result = 0;
1555 struct acpi_device *device = NULL;
1556 struct acpi_bus_ops ops;
1557
1558 memset(&ops, 0, sizeof(ops));
1559 ops.acpi_op_add = 1;
1560 ops.acpi_op_start = 1;
1561
1562 /*
1563 * Enumerate all fixed-feature devices.
1564 */
1565 if ((acpi_gbl_FADT.flags & ACPI_FADT_POWER_BUTTON) == 0) {
1566 result = acpi_add_single_object(&device, NULL,
1567 ACPI_BUS_TYPE_POWER_BUTTON,
1568 ACPI_STA_DEFAULT,
1569 &ops);
1570 }
1571
1572 if ((acpi_gbl_FADT.flags & ACPI_FADT_SLEEP_BUTTON) == 0) {
1573 result = acpi_add_single_object(&device, NULL,
1574 ACPI_BUS_TYPE_SLEEP_BUTTON,
1575 ACPI_STA_DEFAULT,
1576 &ops);
1577 }
1578
1579 return result;
1580 }
1581
1582 int __init acpi_scan_init(void)
1583 {
1584 int result;
1585 struct acpi_bus_ops ops;
1586
1587 memset(&ops, 0, sizeof(ops));
1588 ops.acpi_op_add = 1;
1589 ops.acpi_op_start = 1;
1590
1591 result = bus_register(&acpi_bus_type);
1592 if (result) {
1593 /* We don't want to quit even if we failed to add suspend/resume */
1594 printk(KERN_ERR PREFIX "Could not register bus type\n");
1595 }
1596
1597 acpi_power_init();
1598
1599 /*
1600 * Enumerate devices in the ACPI namespace.
1601 */
1602 result = acpi_bus_scan(ACPI_ROOT_OBJECT, &ops, &acpi_root);
1603
1604 if (!result)
1605 result = acpi_bus_scan_fixed();
1606
1607 if (result)
1608 acpi_device_unregister(acpi_root, ACPI_BUS_REMOVAL_NORMAL);
1609 else
1610 acpi_update_all_gpes();
1611
1612 return result;
1613 }