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