]> git.proxmox.com Git - mirror_ubuntu-zesty-kernel.git/blob - drivers/acpi/scan.c
projects / mirror_ubuntu-zesty-kernel.git / blob
? search:


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