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