drivers/acpi/scan.c

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