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