]> 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
Merge branch 'linus' into x86/urgent
[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 char *hid;
382
383 hid = acpi_device_hid(device);
384 if (!strcmp(hid, ACPI_BUTTON_HID_POWERF))
385 status =
386 acpi_install_fixed_event_handler(ACPI_EVENT_POWER_BUTTON,
387 acpi_device_notify_fixed,
388 device);
389 else if (!strcmp(hid, ACPI_BUTTON_HID_SLEEPF))
390 status =
391 acpi_install_fixed_event_handler(ACPI_EVENT_SLEEP_BUTTON,
392 acpi_device_notify_fixed,
393 device);
394 else
395 status = acpi_install_notify_handler(device->handle,
396 ACPI_DEVICE_NOTIFY,
397 acpi_device_notify,
398 device);
399
400 if (ACPI_FAILURE(status))
401 return -EINVAL;
402 return 0;
403 }
404
405 static void acpi_device_remove_notify_handler(struct acpi_device *device)
406 {
407 if (!strcmp(acpi_device_hid(device), ACPI_BUTTON_HID_POWERF))
408 acpi_remove_fixed_event_handler(ACPI_EVENT_POWER_BUTTON,
409 acpi_device_notify_fixed);
410 else if (!strcmp(acpi_device_hid(device), ACPI_BUTTON_HID_SLEEPF))
411 acpi_remove_fixed_event_handler(ACPI_EVENT_SLEEP_BUTTON,
412 acpi_device_notify_fixed);
413 else
414 acpi_remove_notify_handler(device->handle, ACPI_DEVICE_NOTIFY,
415 acpi_device_notify);
416 }
417
418 static int acpi_bus_driver_init(struct acpi_device *, struct acpi_driver *);
419 static int acpi_start_single_object(struct acpi_device *);
420 static int acpi_device_probe(struct device * dev)
421 {
422 struct acpi_device *acpi_dev = to_acpi_device(dev);
423 struct acpi_driver *acpi_drv = to_acpi_driver(dev->driver);
424 int ret;
425
426 ret = acpi_bus_driver_init(acpi_dev, acpi_drv);
427 if (!ret) {
428 if (acpi_dev->bus_ops.acpi_op_start)
429 acpi_start_single_object(acpi_dev);
430
431 if (acpi_drv->ops.notify) {
432 ret = acpi_device_install_notify_handler(acpi_dev);
433 if (ret) {
434 if (acpi_drv->ops.remove)
435 acpi_drv->ops.remove(acpi_dev,
436 acpi_dev->removal_type);
437 return ret;
438 }
439 }
440
441 ACPI_DEBUG_PRINT((ACPI_DB_INFO,
442 "Found driver [%s] for device [%s]\n",
443 acpi_drv->name, acpi_dev->pnp.bus_id));
444 get_device(dev);
445 }
446 return ret;
447 }
448
449 static int acpi_device_remove(struct device * dev)
450 {
451 struct acpi_device *acpi_dev = to_acpi_device(dev);
452 struct acpi_driver *acpi_drv = acpi_dev->driver;
453
454 if (acpi_drv) {
455 if (acpi_drv->ops.notify)
456 acpi_device_remove_notify_handler(acpi_dev);
457 if (acpi_drv->ops.remove)
458 acpi_drv->ops.remove(acpi_dev, acpi_dev->removal_type);
459 }
460 acpi_dev->driver = NULL;
461 acpi_dev->driver_data = NULL;
462
463 put_device(dev);
464 return 0;
465 }
466
467 struct bus_type acpi_bus_type = {
468 .name = "acpi",
469 .suspend = acpi_device_suspend,
470 .resume = acpi_device_resume,
471 .match = acpi_bus_match,
472 .probe = acpi_device_probe,
473 .remove = acpi_device_remove,
474 .uevent = acpi_device_uevent,
475 };
476
477 static int acpi_device_register(struct acpi_device *device,
478 struct acpi_device *parent)
479 {
480 int result;
481 struct acpi_device_bus_id *acpi_device_bus_id, *new_bus_id;
482 int found = 0;
483 /*
484 * Linkage
485 * -------
486 * Link this device to its parent and siblings.
487 */
488 INIT_LIST_HEAD(&device->children);
489 INIT_LIST_HEAD(&device->node);
490 INIT_LIST_HEAD(&device->wakeup_list);
491
492 new_bus_id = kzalloc(sizeof(struct acpi_device_bus_id), GFP_KERNEL);
493 if (!new_bus_id) {
494 printk(KERN_ERR PREFIX "Memory allocation error\n");
495 return -ENOMEM;
496 }
497
498 mutex_lock(&acpi_device_lock);
499 /*
500 * Find suitable bus_id and instance number in acpi_bus_id_list
501 * If failed, create one and link it into acpi_bus_id_list
502 */
503 list_for_each_entry(acpi_device_bus_id, &acpi_bus_id_list, node) {
504 if(!strcmp(acpi_device_bus_id->bus_id, device->flags.hardware_id? device->pnp.hardware_id : "device")) {
505 acpi_device_bus_id->instance_no ++;
506 found = 1;
507 kfree(new_bus_id);
508 break;
509 }
510 }
511 if (!found) {
512 acpi_device_bus_id = new_bus_id;
513 strcpy(acpi_device_bus_id->bus_id, device->flags.hardware_id ? device->pnp.hardware_id : "device");
514 acpi_device_bus_id->instance_no = 0;
515 list_add_tail(&acpi_device_bus_id->node, &acpi_bus_id_list);
516 }
517 dev_set_name(&device->dev, "%s:%02x", acpi_device_bus_id->bus_id, acpi_device_bus_id->instance_no);
518
519 if (device->parent)
520 list_add_tail(&device->node, &device->parent->children);
521
522 if (device->wakeup.flags.valid)
523 list_add_tail(&device->wakeup_list, &acpi_wakeup_device_list);
524 mutex_unlock(&acpi_device_lock);
525
526 if (device->parent)
527 device->dev.parent = &parent->dev;
528 device->dev.bus = &acpi_bus_type;
529 device->dev.release = &acpi_device_release;
530 result = device_register(&device->dev);
531 if (result) {
532 dev_err(&device->dev, "Error registering device\n");
533 goto end;
534 }
535
536 result = acpi_device_setup_files(device);
537 if (result)
538 printk(KERN_ERR PREFIX "Error creating sysfs interface for device %s\n",
539 dev_name(&device->dev));
540
541 device->removal_type = ACPI_BUS_REMOVAL_NORMAL;
542 return 0;
543 end:
544 mutex_lock(&acpi_device_lock);
545 if (device->parent)
546 list_del(&device->node);
547 list_del(&device->wakeup_list);
548 mutex_unlock(&acpi_device_lock);
549 return result;
550 }
551
552 static void acpi_device_unregister(struct acpi_device *device, int type)
553 {
554 mutex_lock(&acpi_device_lock);
555 if (device->parent)
556 list_del(&device->node);
557
558 list_del(&device->wakeup_list);
559 mutex_unlock(&acpi_device_lock);
560
561 acpi_detach_data(device->handle, acpi_bus_data_handler);
562
563 acpi_device_remove_files(device);
564 device_unregister(&device->dev);
565 }
566
567 /* --------------------------------------------------------------------------
568 Driver Management
569 -------------------------------------------------------------------------- */
570 /**
571 * acpi_bus_driver_init - add a device to a driver
572 * @device: the device to add and initialize
573 * @driver: driver for the device
574 *
575 * Used to initialize a device via its device driver. Called whenever a
576 * driver is bound to a device. Invokes the driver's add() ops.
577 */
578 static int
579 acpi_bus_driver_init(struct acpi_device *device, struct acpi_driver *driver)
580 {
581 int result = 0;
582
583 if (!device || !driver)
584 return -EINVAL;
585
586 if (!driver->ops.add)
587 return -ENOSYS;
588
589 result = driver->ops.add(device);
590 if (result) {
591 device->driver = NULL;
592 device->driver_data = NULL;
593 return result;
594 }
595
596 device->driver = driver;
597
598 /*
599 * TBD - Configuration Management: Assign resources to device based
600 * upon possible configuration and currently allocated resources.
601 */
602
603 ACPI_DEBUG_PRINT((ACPI_DB_INFO,
604 "Driver successfully bound to device\n"));
605 return 0;
606 }
607
608 static int acpi_start_single_object(struct acpi_device *device)
609 {
610 int result = 0;
611 struct acpi_driver *driver;
612
613
614 if (!(driver = device->driver))
615 return 0;
616
617 if (driver->ops.start) {
618 result = driver->ops.start(device);
619 if (result && driver->ops.remove)
620 driver->ops.remove(device, ACPI_BUS_REMOVAL_NORMAL);
621 }
622
623 return result;
624 }
625
626 /**
627 * acpi_bus_register_driver - register a driver with the ACPI bus
628 * @driver: driver being registered
629 *
630 * Registers a driver with the ACPI bus. Searches the namespace for all
631 * devices that match the driver's criteria and binds. Returns zero for
632 * success or a negative error status for failure.
633 */
634 int acpi_bus_register_driver(struct acpi_driver *driver)
635 {
636 int ret;
637
638 if (acpi_disabled)
639 return -ENODEV;
640 driver->drv.name = driver->name;
641 driver->drv.bus = &acpi_bus_type;
642 driver->drv.owner = driver->owner;
643
644 ret = driver_register(&driver->drv);
645 return ret;
646 }
647
648 EXPORT_SYMBOL(acpi_bus_register_driver);
649
650 /**
651 * acpi_bus_unregister_driver - unregisters a driver with the APIC bus
652 * @driver: driver to unregister
653 *
654 * Unregisters a driver with the ACPI bus. Searches the namespace for all
655 * devices that match the driver's criteria and unbinds.
656 */
657 void acpi_bus_unregister_driver(struct acpi_driver *driver)
658 {
659 driver_unregister(&driver->drv);
660 }
661
662 EXPORT_SYMBOL(acpi_bus_unregister_driver);
663
664 /* --------------------------------------------------------------------------
665 Device Enumeration
666 -------------------------------------------------------------------------- */
667 acpi_status
668 acpi_bus_get_ejd(acpi_handle handle, acpi_handle *ejd)
669 {
670 acpi_status status;
671 acpi_handle tmp;
672 struct acpi_buffer buffer = {ACPI_ALLOCATE_BUFFER, NULL};
673 union acpi_object *obj;
674
675 status = acpi_get_handle(handle, "_EJD", &tmp);
676 if (ACPI_FAILURE(status))
677 return status;
678
679 status = acpi_evaluate_object(handle, "_EJD", NULL, &buffer);
680 if (ACPI_SUCCESS(status)) {
681 obj = buffer.pointer;
682 status = acpi_get_handle(ACPI_ROOT_OBJECT, obj->string.pointer,
683 ejd);
684 kfree(buffer.pointer);
685 }
686 return status;
687 }
688 EXPORT_SYMBOL_GPL(acpi_bus_get_ejd);
689
690 void acpi_bus_data_handler(acpi_handle handle, void *context)
691 {
692
693 /* TBD */
694
695 return;
696 }
697
698 static int acpi_bus_get_perf_flags(struct acpi_device *device)
699 {
700 device->performance.state = ACPI_STATE_UNKNOWN;
701 return 0;
702 }
703
704 static acpi_status
705 acpi_bus_extract_wakeup_device_power_package(struct acpi_device *device,
706 union acpi_object *package)
707 {
708 int i = 0;
709 union acpi_object *element = NULL;
710
711 if (!device || !package || (package->package.count < 2))
712 return AE_BAD_PARAMETER;
713
714 element = &(package->package.elements[0]);
715 if (!element)
716 return AE_BAD_PARAMETER;
717 if (element->type == ACPI_TYPE_PACKAGE) {
718 if ((element->package.count < 2) ||
719 (element->package.elements[0].type !=
720 ACPI_TYPE_LOCAL_REFERENCE)
721 || (element->package.elements[1].type != ACPI_TYPE_INTEGER))
722 return AE_BAD_DATA;
723 device->wakeup.gpe_device =
724 element->package.elements[0].reference.handle;
725 device->wakeup.gpe_number =
726 (u32) element->package.elements[1].integer.value;
727 } else if (element->type == ACPI_TYPE_INTEGER) {
728 device->wakeup.gpe_number = element->integer.value;
729 } else
730 return AE_BAD_DATA;
731
732 element = &(package->package.elements[1]);
733 if (element->type != ACPI_TYPE_INTEGER) {
734 return AE_BAD_DATA;
735 }
736 device->wakeup.sleep_state = element->integer.value;
737
738 if ((package->package.count - 2) > ACPI_MAX_HANDLES) {
739 return AE_NO_MEMORY;
740 }
741 device->wakeup.resources.count = package->package.count - 2;
742 for (i = 0; i < device->wakeup.resources.count; i++) {
743 element = &(package->package.elements[i + 2]);
744 if (element->type != ACPI_TYPE_LOCAL_REFERENCE)
745 return AE_BAD_DATA;
746
747 device->wakeup.resources.handles[i] = element->reference.handle;
748 }
749
750 return AE_OK;
751 }
752
753 static int acpi_bus_get_wakeup_device_flags(struct acpi_device *device)
754 {
755 acpi_status status = 0;
756 struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL };
757 union acpi_object *package = NULL;
758 int psw_error;
759
760 struct acpi_device_id button_device_ids[] = {
761 {"PNP0C0D", 0},
762 {"PNP0C0C", 0},
763 {"PNP0C0E", 0},
764 {"", 0},
765 };
766
767 /* _PRW */
768 status = acpi_evaluate_object(device->handle, "_PRW", NULL, &buffer);
769 if (ACPI_FAILURE(status)) {
770 ACPI_EXCEPTION((AE_INFO, status, "Evaluating _PRW"));
771 goto end;
772 }
773
774 package = (union acpi_object *)buffer.pointer;
775 status = acpi_bus_extract_wakeup_device_power_package(device, package);
776 if (ACPI_FAILURE(status)) {
777 ACPI_EXCEPTION((AE_INFO, status, "Extracting _PRW package"));
778 goto end;
779 }
780
781 kfree(buffer.pointer);
782
783 device->wakeup.flags.valid = 1;
784 device->wakeup.prepare_count = 0;
785 /* Call _PSW/_DSW object to disable its ability to wake the sleeping
786 * system for the ACPI device with the _PRW object.
787 * The _PSW object is depreciated in ACPI 3.0 and is replaced by _DSW.
788 * So it is necessary to call _DSW object first. Only when it is not
789 * present will the _PSW object used.
790 */
791 psw_error = acpi_device_sleep_wake(device, 0, 0, 0);
792 if (psw_error)
793 ACPI_DEBUG_PRINT((ACPI_DB_INFO,
794 "error in _DSW or _PSW evaluation\n"));
795
796 /* Power button, Lid switch always enable wakeup */
797 if (!acpi_match_device_ids(device, button_device_ids))
798 device->wakeup.flags.run_wake = 1;
799
800 end:
801 if (ACPI_FAILURE(status))
802 device->flags.wake_capable = 0;
803 return 0;
804 }
805
806 static int acpi_bus_get_power_flags(struct acpi_device *device)
807 {
808 acpi_status status = 0;
809 acpi_handle handle = NULL;
810 u32 i = 0;
811
812
813 /*
814 * Power Management Flags
815 */
816 status = acpi_get_handle(device->handle, "_PSC", &handle);
817 if (ACPI_SUCCESS(status))
818 device->power.flags.explicit_get = 1;
819 status = acpi_get_handle(device->handle, "_IRC", &handle);
820 if (ACPI_SUCCESS(status))
821 device->power.flags.inrush_current = 1;
822
823 /*
824 * Enumerate supported power management states
825 */
826 for (i = ACPI_STATE_D0; i <= ACPI_STATE_D3; i++) {
827 struct acpi_device_power_state *ps = &device->power.states[i];
828 char object_name[5] = { '_', 'P', 'R', '0' + i, '\0' };
829
830 /* Evaluate "_PRx" to se if power resources are referenced */
831 acpi_evaluate_reference(device->handle, object_name, NULL,
832 &ps->resources);
833 if (ps->resources.count) {
834 device->power.flags.power_resources = 1;
835 ps->flags.valid = 1;
836 }
837
838 /* Evaluate "_PSx" to see if we can do explicit sets */
839 object_name[2] = 'S';
840 status = acpi_get_handle(device->handle, object_name, &handle);
841 if (ACPI_SUCCESS(status)) {
842 ps->flags.explicit_set = 1;
843 ps->flags.valid = 1;
844 }
845
846 /* State is valid if we have some power control */
847 if (ps->resources.count || ps->flags.explicit_set)
848 ps->flags.valid = 1;
849
850 ps->power = -1; /* Unknown - driver assigned */
851 ps->latency = -1; /* Unknown - driver assigned */
852 }
853
854 /* Set defaults for D0 and D3 states (always valid) */
855 device->power.states[ACPI_STATE_D0].flags.valid = 1;
856 device->power.states[ACPI_STATE_D0].power = 100;
857 device->power.states[ACPI_STATE_D3].flags.valid = 1;
858 device->power.states[ACPI_STATE_D3].power = 0;
859
860 /* TBD: System wake support and resource requirements. */
861
862 device->power.state = ACPI_STATE_UNKNOWN;
863 acpi_bus_get_power(device->handle, &(device->power.state));
864
865 return 0;
866 }
867
868 static int acpi_bus_get_flags(struct acpi_device *device)
869 {
870 acpi_status status = AE_OK;
871 acpi_handle temp = NULL;
872
873
874 /* Presence of _STA indicates 'dynamic_status' */
875 status = acpi_get_handle(device->handle, "_STA", &temp);
876 if (ACPI_SUCCESS(status))
877 device->flags.dynamic_status = 1;
878
879 /* Presence of _CID indicates 'compatible_ids' */
880 status = acpi_get_handle(device->handle, "_CID", &temp);
881 if (ACPI_SUCCESS(status))
882 device->flags.compatible_ids = 1;
883
884 /* Presence of _RMV indicates 'removable' */
885 status = acpi_get_handle(device->handle, "_RMV", &temp);
886 if (ACPI_SUCCESS(status))
887 device->flags.removable = 1;
888
889 /* Presence of _EJD|_EJ0 indicates 'ejectable' */
890 status = acpi_get_handle(device->handle, "_EJD", &temp);
891 if (ACPI_SUCCESS(status))
892 device->flags.ejectable = 1;
893 else {
894 status = acpi_get_handle(device->handle, "_EJ0", &temp);
895 if (ACPI_SUCCESS(status))
896 device->flags.ejectable = 1;
897 }
898
899 /* Presence of _LCK indicates 'lockable' */
900 status = acpi_get_handle(device->handle, "_LCK", &temp);
901 if (ACPI_SUCCESS(status))
902 device->flags.lockable = 1;
903
904 /* Presence of _PS0|_PR0 indicates 'power manageable' */
905 status = acpi_get_handle(device->handle, "_PS0", &temp);
906 if (ACPI_FAILURE(status))
907 status = acpi_get_handle(device->handle, "_PR0", &temp);
908 if (ACPI_SUCCESS(status))
909 device->flags.power_manageable = 1;
910
911 /* Presence of _PRW indicates wake capable */
912 status = acpi_get_handle(device->handle, "_PRW", &temp);
913 if (ACPI_SUCCESS(status))
914 device->flags.wake_capable = 1;
915
916 /* TBD: Performance management */
917
918 return 0;
919 }
920
921 static void acpi_device_get_busid(struct acpi_device *device,
922 acpi_handle handle, int type)
923 {
924 char bus_id[5] = { '?', 0 };
925 struct acpi_buffer buffer = { sizeof(bus_id), bus_id };
926 int i = 0;
927
928 /*
929 * Bus ID
930 * ------
931 * The device's Bus ID is simply the object name.
932 * TBD: Shouldn't this value be unique (within the ACPI namespace)?
933 */
934 switch (type) {
935 case ACPI_BUS_TYPE_SYSTEM:
936 strcpy(device->pnp.bus_id, "ACPI");
937 break;
938 case ACPI_BUS_TYPE_POWER_BUTTON:
939 strcpy(device->pnp.bus_id, "PWRF");
940 break;
941 case ACPI_BUS_TYPE_SLEEP_BUTTON:
942 strcpy(device->pnp.bus_id, "SLPF");
943 break;
944 default:
945 acpi_get_name(handle, ACPI_SINGLE_NAME, &buffer);
946 /* Clean up trailing underscores (if any) */
947 for (i = 3; i > 1; i--) {
948 if (bus_id[i] == '_')
949 bus_id[i] = '\0';
950 else
951 break;
952 }
953 strcpy(device->pnp.bus_id, bus_id);
954 break;
955 }
956 }
957
958 /*
959 * acpi_bay_match - see if a device is an ejectable driver bay
960 *
961 * If an acpi object is ejectable and has one of the ACPI ATA methods defined,
962 * then we can safely call it an ejectable drive bay
963 */
964 static int acpi_bay_match(struct acpi_device *device){
965 acpi_status status;
966 acpi_handle handle;
967 acpi_handle tmp;
968 acpi_handle phandle;
969
970 handle = device->handle;
971
972 status = acpi_get_handle(handle, "_EJ0", &tmp);
973 if (ACPI_FAILURE(status))
974 return -ENODEV;
975
976 if ((ACPI_SUCCESS(acpi_get_handle(handle, "_GTF", &tmp))) ||
977 (ACPI_SUCCESS(acpi_get_handle(handle, "_GTM", &tmp))) ||
978 (ACPI_SUCCESS(acpi_get_handle(handle, "_STM", &tmp))) ||
979 (ACPI_SUCCESS(acpi_get_handle(handle, "_SDD", &tmp))))
980 return 0;
981
982 if (acpi_get_parent(handle, &phandle))
983 return -ENODEV;
984
985 if ((ACPI_SUCCESS(acpi_get_handle(phandle, "_GTF", &tmp))) ||
986 (ACPI_SUCCESS(acpi_get_handle(phandle, "_GTM", &tmp))) ||
987 (ACPI_SUCCESS(acpi_get_handle(phandle, "_STM", &tmp))) ||
988 (ACPI_SUCCESS(acpi_get_handle(phandle, "_SDD", &tmp))))
989 return 0;
990
991 return -ENODEV;
992 }
993
994 /*
995 * acpi_dock_match - see if a device has a _DCK method
996 */
997 static int acpi_dock_match(struct acpi_device *device)
998 {
999 acpi_handle tmp;
1000 return acpi_get_handle(device->handle, "_DCK", &tmp);
1001 }
1002
1003 static struct acpica_device_id_list*
1004 acpi_add_cid(
1005 struct acpi_device_info *info,
1006 struct acpica_device_id *new_cid)
1007 {
1008 struct acpica_device_id_list *cid;
1009 char *next_id_string;
1010 acpi_size cid_length;
1011 acpi_size new_cid_length;
1012 u32 i;
1013
1014
1015 /* Allocate new CID list with room for the new CID */
1016
1017 if (!new_cid)
1018 new_cid_length = info->compatible_id_list.list_size;
1019 else if (info->compatible_id_list.list_size)
1020 new_cid_length = info->compatible_id_list.list_size +
1021 new_cid->length + sizeof(struct acpica_device_id);
1022 else
1023 new_cid_length = sizeof(struct acpica_device_id_list) + new_cid->length;
1024
1025 cid = ACPI_ALLOCATE_ZEROED(new_cid_length);
1026 if (!cid) {
1027 return NULL;
1028 }
1029
1030 cid->list_size = new_cid_length;
1031 cid->count = info->compatible_id_list.count;
1032 if (new_cid)
1033 cid->count++;
1034 next_id_string = (char *) cid->ids + (cid->count * sizeof(struct acpica_device_id));
1035
1036 /* Copy all existing CIDs */
1037
1038 for (i = 0; i < info->compatible_id_list.count; i++) {
1039 cid_length = info->compatible_id_list.ids[i].length;
1040 cid->ids[i].string = next_id_string;
1041 cid->ids[i].length = cid_length;
1042
1043 ACPI_MEMCPY(next_id_string, info->compatible_id_list.ids[i].string,
1044 cid_length);
1045
1046 next_id_string += cid_length;
1047 }
1048
1049 /* Append the new CID */
1050
1051 if (new_cid) {
1052 cid->ids[i].string = next_id_string;
1053 cid->ids[i].length = new_cid->length;
1054
1055 ACPI_MEMCPY(next_id_string, new_cid->string, new_cid->length);
1056 }
1057
1058 return cid;
1059 }
1060
1061 static void acpi_device_set_id(struct acpi_device *device,
1062 struct acpi_device *parent, acpi_handle handle,
1063 int type)
1064 {
1065 struct acpi_device_info *info = NULL;
1066 char *hid = NULL;
1067 char *uid = NULL;
1068 struct acpica_device_id_list *cid_list = NULL;
1069 char *cid_add = NULL;
1070 acpi_status status;
1071
1072 switch (type) {
1073 case ACPI_BUS_TYPE_DEVICE:
1074 status = acpi_get_object_info(handle, &info);
1075 if (ACPI_FAILURE(status)) {
1076 printk(KERN_ERR PREFIX "%s: Error reading device info\n", __func__);
1077 return;
1078 }
1079
1080 if (info->valid & ACPI_VALID_HID)
1081 hid = info->hardware_id.string;
1082 if (info->valid & ACPI_VALID_UID)
1083 uid = info->unique_id.string;
1084 if (info->valid & ACPI_VALID_CID)
1085 cid_list = &info->compatible_id_list;
1086 if (info->valid & ACPI_VALID_ADR) {
1087 device->pnp.bus_address = info->address;
1088 device->flags.bus_address = 1;
1089 }
1090
1091 /* If we have a video/bay/dock device, add our selfdefined
1092 HID to the CID list. Like that the video/bay/dock drivers
1093 will get autoloaded and the device might still match
1094 against another driver.
1095 */
1096 if (acpi_is_video_device(device))
1097 cid_add = ACPI_VIDEO_HID;
1098 else if (ACPI_SUCCESS(acpi_bay_match(device)))
1099 cid_add = ACPI_BAY_HID;
1100 else if (ACPI_SUCCESS(acpi_dock_match(device)))
1101 cid_add = ACPI_DOCK_HID;
1102
1103 break;
1104 case ACPI_BUS_TYPE_POWER:
1105 hid = ACPI_POWER_HID;
1106 break;
1107 case ACPI_BUS_TYPE_PROCESSOR:
1108 hid = ACPI_PROCESSOR_OBJECT_HID;
1109 break;
1110 case ACPI_BUS_TYPE_SYSTEM:
1111 hid = ACPI_SYSTEM_HID;
1112 break;
1113 case ACPI_BUS_TYPE_THERMAL:
1114 hid = ACPI_THERMAL_HID;
1115 break;
1116 case ACPI_BUS_TYPE_POWER_BUTTON:
1117 hid = ACPI_BUTTON_HID_POWERF;
1118 break;
1119 case ACPI_BUS_TYPE_SLEEP_BUTTON:
1120 hid = ACPI_BUTTON_HID_SLEEPF;
1121 break;
1122 }
1123
1124 /*
1125 * \_SB
1126 * ----
1127 * Fix for the system root bus device -- the only root-level device.
1128 */
1129 if (((acpi_handle)parent == ACPI_ROOT_OBJECT) && (type == ACPI_BUS_TYPE_DEVICE)) {
1130 hid = ACPI_BUS_HID;
1131 strcpy(device->pnp.device_name, ACPI_BUS_DEVICE_NAME);
1132 strcpy(device->pnp.device_class, ACPI_BUS_CLASS);
1133 }
1134
1135 if (hid) {
1136 device->pnp.hardware_id = ACPI_ALLOCATE_ZEROED(strlen (hid) + 1);
1137 if (device->pnp.hardware_id) {
1138 strcpy(device->pnp.hardware_id, hid);
1139 device->flags.hardware_id = 1;
1140 }
1141 }
1142 if (!device->flags.hardware_id)
1143 device->pnp.hardware_id = "";
1144
1145 if (uid) {
1146 device->pnp.unique_id = ACPI_ALLOCATE_ZEROED(strlen (uid) + 1);
1147 if (device->pnp.unique_id) {
1148 strcpy(device->pnp.unique_id, uid);
1149 device->flags.unique_id = 1;
1150 }
1151 }
1152 if (!device->flags.unique_id)
1153 device->pnp.unique_id = "";
1154
1155 if (cid_list || cid_add) {
1156 struct acpica_device_id_list *list;
1157
1158 if (cid_add) {
1159 struct acpica_device_id cid;
1160 cid.length = strlen (cid_add) + 1;
1161 cid.string = cid_add;
1162
1163 list = acpi_add_cid(info, &cid);
1164 } else {
1165 list = acpi_add_cid(info, NULL);
1166 }
1167
1168 if (list) {
1169 device->pnp.cid_list = list;
1170 if (cid_add)
1171 device->flags.compatible_ids = 1;
1172 }
1173 }
1174
1175 kfree(info);
1176 }
1177
1178 static int acpi_device_set_context(struct acpi_device *device, int type)
1179 {
1180 acpi_status status = AE_OK;
1181 int result = 0;
1182 /*
1183 * Context
1184 * -------
1185 * Attach this 'struct acpi_device' to the ACPI object. This makes
1186 * resolutions from handle->device very efficient. Note that we need
1187 * to be careful with fixed-feature devices as they all attach to the
1188 * root object.
1189 */
1190 if (type != ACPI_BUS_TYPE_POWER_BUTTON &&
1191 type != ACPI_BUS_TYPE_SLEEP_BUTTON) {
1192 status = acpi_attach_data(device->handle,
1193 acpi_bus_data_handler, device);
1194
1195 if (ACPI_FAILURE(status)) {
1196 printk(KERN_ERR PREFIX "Error attaching device data\n");
1197 result = -ENODEV;
1198 }
1199 }
1200 return result;
1201 }
1202
1203 static int acpi_bus_remove(struct acpi_device *dev, int rmdevice)
1204 {
1205 if (!dev)
1206 return -EINVAL;
1207
1208 dev->removal_type = ACPI_BUS_REMOVAL_EJECT;
1209 device_release_driver(&dev->dev);
1210
1211 if (!rmdevice)
1212 return 0;
1213
1214 /*
1215 * unbind _ADR-Based Devices when hot removal
1216 */
1217 if (dev->flags.bus_address) {
1218 if ((dev->parent) && (dev->parent->ops.unbind))
1219 dev->parent->ops.unbind(dev);
1220 }
1221 acpi_device_unregister(dev, ACPI_BUS_REMOVAL_EJECT);
1222
1223 return 0;
1224 }
1225
1226 static int
1227 acpi_add_single_object(struct acpi_device **child,
1228 struct acpi_device *parent, acpi_handle handle, int type,
1229 struct acpi_bus_ops *ops)
1230 {
1231 int result = 0;
1232 struct acpi_device *device = NULL;
1233
1234
1235 if (!child)
1236 return -EINVAL;
1237
1238 device = kzalloc(sizeof(struct acpi_device), GFP_KERNEL);
1239 if (!device) {
1240 printk(KERN_ERR PREFIX "Memory allocation error\n");
1241 return -ENOMEM;
1242 }
1243
1244 device->handle = handle;
1245 device->parent = parent;
1246 device->bus_ops = *ops; /* workround for not call .start */
1247
1248
1249 acpi_device_get_busid(device, handle, type);
1250
1251 /*
1252 * Flags
1253 * -----
1254 * Get prior to calling acpi_bus_get_status() so we know whether
1255 * or not _STA is present. Note that we only look for object
1256 * handles -- cannot evaluate objects until we know the device is
1257 * present and properly initialized.
1258 */
1259 result = acpi_bus_get_flags(device);
1260 if (result)
1261 goto end;
1262
1263 /*
1264 * Status
1265 * ------
1266 * See if the device is present. We always assume that non-Device
1267 * and non-Processor objects (e.g. thermal zones, power resources,
1268 * etc.) are present, functioning, etc. (at least when parent object
1269 * is present). Note that _STA has a different meaning for some
1270 * objects (e.g. power resources) so we need to be careful how we use
1271 * it.
1272 */
1273 switch (type) {
1274 case ACPI_BUS_TYPE_PROCESSOR:
1275 case ACPI_BUS_TYPE_DEVICE:
1276 result = acpi_bus_get_status(device);
1277 if (ACPI_FAILURE(result)) {
1278 result = -ENODEV;
1279 goto end;
1280 }
1281 /*
1282 * When the device is neither present nor functional, the
1283 * device should not be added to Linux ACPI device tree.
1284 * When the status of the device is not present but functinal,
1285 * it should be added to Linux ACPI tree. For example : bay
1286 * device , dock device.
1287 * In such conditions it is unncessary to check whether it is
1288 * bay device or dock device.
1289 */
1290 if (!device->status.present && !device->status.functional) {
1291 result = -ENODEV;
1292 goto end;
1293 }
1294 break;
1295 default:
1296 STRUCT_TO_INT(device->status) =
1297 ACPI_STA_DEVICE_PRESENT | ACPI_STA_DEVICE_ENABLED |
1298 ACPI_STA_DEVICE_UI | ACPI_STA_DEVICE_FUNCTIONING;
1299 break;
1300 }
1301
1302 /*
1303 * Initialize Device
1304 * -----------------
1305 * TBD: Synch with Core's enumeration/initialization process.
1306 */
1307
1308 /*
1309 * Hardware ID, Unique ID, & Bus Address
1310 * -------------------------------------
1311 */
1312 acpi_device_set_id(device, parent, handle, type);
1313
1314 /*
1315 * Power Management
1316 * ----------------
1317 */
1318 if (device->flags.power_manageable) {
1319 result = acpi_bus_get_power_flags(device);
1320 if (result)
1321 goto end;
1322 }
1323
1324 /*
1325 * Wakeup device management
1326 *-----------------------
1327 */
1328 if (device->flags.wake_capable) {
1329 result = acpi_bus_get_wakeup_device_flags(device);
1330 if (result)
1331 goto end;
1332 }
1333
1334 /*
1335 * Performance Management
1336 * ----------------------
1337 */
1338 if (device->flags.performance_manageable) {
1339 result = acpi_bus_get_perf_flags(device);
1340 if (result)
1341 goto end;
1342 }
1343
1344 if ((result = acpi_device_set_context(device, type)))
1345 goto end;
1346
1347 result = acpi_device_register(device, parent);
1348
1349 /*
1350 * Bind _ADR-Based Devices when hot add
1351 */
1352 if (device->flags.bus_address) {
1353 if (device->parent && device->parent->ops.bind)
1354 device->parent->ops.bind(device);
1355 }
1356
1357 end:
1358 if (!result)
1359 *child = device;
1360 else
1361 acpi_device_release(&device->dev);
1362
1363 return result;
1364 }
1365
1366 static int acpi_bus_scan(struct acpi_device *start, struct acpi_bus_ops *ops)
1367 {
1368 acpi_status status = AE_OK;
1369 struct acpi_device *parent = NULL;
1370 struct acpi_device *child = NULL;
1371 acpi_handle phandle = NULL;
1372 acpi_handle chandle = NULL;
1373 acpi_object_type type = 0;
1374 u32 level = 1;
1375
1376
1377 if (!start)
1378 return -EINVAL;
1379
1380 parent = start;
1381 phandle = start->handle;
1382
1383 /*
1384 * Parse through the ACPI namespace, identify all 'devices', and
1385 * create a new 'struct acpi_device' for each.
1386 */
1387 while ((level > 0) && parent) {
1388
1389 status = acpi_get_next_object(ACPI_TYPE_ANY, phandle,
1390 chandle, &chandle);
1391
1392 /*
1393 * If this scope is exhausted then move our way back up.
1394 */
1395 if (ACPI_FAILURE(status)) {
1396 level--;
1397 chandle = phandle;
1398 acpi_get_parent(phandle, &phandle);
1399 if (parent->parent)
1400 parent = parent->parent;
1401 continue;
1402 }
1403
1404 status = acpi_get_type(chandle, &type);
1405 if (ACPI_FAILURE(status))
1406 continue;
1407
1408 /*
1409 * If this is a scope object then parse it (depth-first).
1410 */
1411 if (type == ACPI_TYPE_LOCAL_SCOPE) {
1412 level++;
1413 phandle = chandle;
1414 chandle = NULL;
1415 continue;
1416 }
1417
1418 /*
1419 * We're only interested in objects that we consider 'devices'.
1420 */
1421 switch (type) {
1422 case ACPI_TYPE_DEVICE:
1423 type = ACPI_BUS_TYPE_DEVICE;
1424 break;
1425 case ACPI_TYPE_PROCESSOR:
1426 type = ACPI_BUS_TYPE_PROCESSOR;
1427 break;
1428 case ACPI_TYPE_THERMAL:
1429 type = ACPI_BUS_TYPE_THERMAL;
1430 break;
1431 case ACPI_TYPE_POWER:
1432 type = ACPI_BUS_TYPE_POWER;
1433 break;
1434 default:
1435 continue;
1436 }
1437
1438 if (ops->acpi_op_add)
1439 status = acpi_add_single_object(&child, parent,
1440 chandle, type, ops);
1441 else
1442 status = acpi_bus_get_device(chandle, &child);
1443
1444 if (ACPI_FAILURE(status))
1445 continue;
1446
1447 if (ops->acpi_op_start && !(ops->acpi_op_add)) {
1448 status = acpi_start_single_object(child);
1449 if (ACPI_FAILURE(status))
1450 continue;
1451 }
1452
1453 /*
1454 * If the device is present, enabled, and functioning then
1455 * parse its scope (depth-first). Note that we need to
1456 * represent absent devices to facilitate PnP notifications
1457 * -- but only the subtree head (not all of its children,
1458 * which will be enumerated when the parent is inserted).
1459 *
1460 * TBD: Need notifications and other detection mechanisms
1461 * in place before we can fully implement this.
1462 */
1463 /*
1464 * When the device is not present but functional, it is also
1465 * necessary to scan the children of this device.
1466 */
1467 if (child->status.present || (!child->status.present &&
1468 child->status.functional)) {
1469 status = acpi_get_next_object(ACPI_TYPE_ANY, chandle,
1470 NULL, NULL);
1471 if (ACPI_SUCCESS(status)) {
1472 level++;
1473 phandle = chandle;
1474 chandle = NULL;
1475 parent = child;
1476 }
1477 }
1478 }
1479
1480 return 0;
1481 }
1482
1483 int
1484 acpi_bus_add(struct acpi_device **child,
1485 struct acpi_device *parent, acpi_handle handle, int type)
1486 {
1487 int result;
1488 struct acpi_bus_ops ops;
1489
1490 memset(&ops, 0, sizeof(ops));
1491 ops.acpi_op_add = 1;
1492
1493 result = acpi_add_single_object(child, parent, handle, type, &ops);
1494 if (!result)
1495 result = acpi_bus_scan(*child, &ops);
1496
1497 return result;
1498 }
1499 EXPORT_SYMBOL(acpi_bus_add);
1500
1501 int acpi_bus_start(struct acpi_device *device)
1502 {
1503 int result;
1504 struct acpi_bus_ops ops;
1505
1506
1507 if (!device)
1508 return -EINVAL;
1509
1510 result = acpi_start_single_object(device);
1511 if (!result) {
1512 memset(&ops, 0, sizeof(ops));
1513 ops.acpi_op_start = 1;
1514 result = acpi_bus_scan(device, &ops);
1515 }
1516 return result;
1517 }
1518 EXPORT_SYMBOL(acpi_bus_start);
1519
1520 int acpi_bus_trim(struct acpi_device *start, int rmdevice)
1521 {
1522 acpi_status status;
1523 struct acpi_device *parent, *child;
1524 acpi_handle phandle, chandle;
1525 acpi_object_type type;
1526 u32 level = 1;
1527 int err = 0;
1528
1529 parent = start;
1530 phandle = start->handle;
1531 child = chandle = NULL;
1532
1533 while ((level > 0) && parent && (!err)) {
1534 status = acpi_get_next_object(ACPI_TYPE_ANY, phandle,
1535 chandle, &chandle);
1536
1537 /*
1538 * If this scope is exhausted then move our way back up.
1539 */
1540 if (ACPI_FAILURE(status)) {
1541 level--;
1542 chandle = phandle;
1543 acpi_get_parent(phandle, &phandle);
1544 child = parent;
1545 parent = parent->parent;
1546
1547 if (level == 0)
1548 err = acpi_bus_remove(child, rmdevice);
1549 else
1550 err = acpi_bus_remove(child, 1);
1551
1552 continue;
1553 }
1554
1555 status = acpi_get_type(chandle, &type);
1556 if (ACPI_FAILURE(status)) {
1557 continue;
1558 }
1559 /*
1560 * If there is a device corresponding to chandle then
1561 * parse it (depth-first).
1562 */
1563 if (acpi_bus_get_device(chandle, &child) == 0) {
1564 level++;
1565 phandle = chandle;
1566 chandle = NULL;
1567 parent = child;
1568 }
1569 continue;
1570 }
1571 return err;
1572 }
1573 EXPORT_SYMBOL_GPL(acpi_bus_trim);
1574
1575 static int acpi_bus_scan_fixed(struct acpi_device *root)
1576 {
1577 int result = 0;
1578 struct acpi_device *device = NULL;
1579 struct acpi_bus_ops ops;
1580
1581 if (!root)
1582 return -ENODEV;
1583
1584 memset(&ops, 0, sizeof(ops));
1585 ops.acpi_op_add = 1;
1586 ops.acpi_op_start = 1;
1587
1588 /*
1589 * Enumerate all fixed-feature devices.
1590 */
1591 if ((acpi_gbl_FADT.flags & ACPI_FADT_POWER_BUTTON) == 0) {
1592 result = acpi_add_single_object(&device, acpi_root,
1593 NULL,
1594 ACPI_BUS_TYPE_POWER_BUTTON,
1595 &ops);
1596 }
1597
1598 if ((acpi_gbl_FADT.flags & ACPI_FADT_SLEEP_BUTTON) == 0) {
1599 result = acpi_add_single_object(&device, acpi_root,
1600 NULL,
1601 ACPI_BUS_TYPE_SLEEP_BUTTON,
1602 &ops);
1603 }
1604
1605 return result;
1606 }
1607
1608 int __init acpi_scan_init(void)
1609 {
1610 int result;
1611 struct acpi_bus_ops ops;
1612
1613 memset(&ops, 0, sizeof(ops));
1614 ops.acpi_op_add = 1;
1615 ops.acpi_op_start = 1;
1616
1617 result = bus_register(&acpi_bus_type);
1618 if (result) {
1619 /* We don't want to quit even if we failed to add suspend/resume */
1620 printk(KERN_ERR PREFIX "Could not register bus type\n");
1621 }
1622
1623 /*
1624 * Create the root device in the bus's device tree
1625 */
1626 result = acpi_add_single_object(&acpi_root, NULL, ACPI_ROOT_OBJECT,
1627 ACPI_BUS_TYPE_SYSTEM, &ops);
1628 if (result)
1629 goto Done;
1630
1631 /*
1632 * Enumerate devices in the ACPI namespace.
1633 */
1634 result = acpi_bus_scan_fixed(acpi_root);
1635
1636 if (!result)
1637 result = acpi_bus_scan(acpi_root, &ops);
1638
1639 if (result)
1640 acpi_device_unregister(acpi_root, ACPI_BUS_REMOVAL_NORMAL);
1641
1642 Done:
1643 return result;
1644 }
ubuntu-bionic-kernel mirror