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