drivers/acpi/bus.c

   1 /*
   2  *  acpi_bus.c - ACPI Bus Driver ($Revision: 80 $)
   3  *
   4  *  Copyright (C) 2001, 2002 Paul Diefenbaugh <paul.s.diefenbaugh@intel.com>
   5  *
   6  * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
   7  *
   8  *  This program is free software; you can redistribute it and/or modify
   9  *  it under the terms of the GNU General Public License as published by
  10  *  the Free Software Foundation; either version 2 of the License, or (at
  11  *  your option) any later version.
  12  *
  13  *  This program is distributed in the hope that it will be useful, but
  14  *  WITHOUT ANY WARRANTY; without even the implied warranty of
  15  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
  16  *  General Public License for more details.
  17  *
  18  *  You should have received a copy of the GNU General Public License along
  19  *  with this program; if not, write to the Free Software Foundation, Inc.,
  20  *  59 Temple Place, Suite 330, Boston, MA 02111-1307 USA.
  21  *
  22  * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
  23  */
  24
  25 #include <linux/module.h>
  26 #include <linux/init.h>
  27 #include <linux/ioport.h>
  28 #include <linux/kernel.h>
  29 #include <linux/list.h>
  30 #include <linux/sched.h>
  31 #include <linux/pm.h>
  32 #include <linux/device.h>
  33 #include <linux/proc_fs.h>
  34 #include <linux/acpi.h>
  35 #include <linux/slab.h>
  36 #include <linux/regulator/machine.h>
  37 #ifdef CONFIG_X86
  38 #include <asm/mpspec.h>
  39 #endif
  40 #include <linux/pci.h>
  41 #include <acpi/apei.h>
  42 #include <linux/dmi.h>
  43 #include <linux/suspend.h>
  44
  45 #include "internal.h"
  46
  47 #define _COMPONENT              ACPI_BUS_COMPONENT
  48 ACPI_MODULE_NAME("bus");
  49
  50 struct acpi_device *acpi_root;
  51 struct proc_dir_entry *acpi_root_dir;
  52 EXPORT_SYMBOL(acpi_root_dir);
  53
  54 #ifdef CONFIG_X86
  55 #ifdef CONFIG_ACPI_CUSTOM_DSDT
  56 static inline int set_copy_dsdt(const struct dmi_system_id *id)
  57 {
  58         return 0;
  59 }
  60 #else
  61 static int set_copy_dsdt(const struct dmi_system_id *id)
  62 {
  63         printk(KERN_NOTICE "%s detected - "
  64                 "force copy of DSDT to local memory\n", id->ident);
  65         acpi_gbl_copy_dsdt_locally = 1;
  66         return 0;
  67 }
  68 #endif
  69
  70 static struct dmi_system_id dsdt_dmi_table[] __initdata = {
  71         /*
  72          * Invoke DSDT corruption work-around on all Toshiba Satellite.
  73          * https://bugzilla.kernel.org/show_bug.cgi?id=14679
  74          */
  75         {
  76          .callback = set_copy_dsdt,
  77          .ident = "TOSHIBA Satellite",
  78          .matches = {
  79                 DMI_MATCH(DMI_SYS_VENDOR, "TOSHIBA"),
  80                 DMI_MATCH(DMI_PRODUCT_NAME, "Satellite"),
  81                 },
  82         },
  83         {}
  84 };
  85 #else
  86 static struct dmi_system_id dsdt_dmi_table[] __initdata = {
  87         {}
  88 };
  89 #endif
  90
  91 /* --------------------------------------------------------------------------
  92                                 Device Management
  93    -------------------------------------------------------------------------- */
  94
  95 acpi_status acpi_bus_get_status_handle(acpi_handle handle,
  96                                        unsigned long long *sta)
  97 {
  98         acpi_status status;
  99
 100         status = acpi_evaluate_integer(handle, "_STA", NULL, sta);
 101         if (ACPI_SUCCESS(status))
 102                 return AE_OK;
 103
 104         if (status == AE_NOT_FOUND) {
 105                 *sta = ACPI_STA_DEVICE_PRESENT | ACPI_STA_DEVICE_ENABLED |
 106                        ACPI_STA_DEVICE_UI      | ACPI_STA_DEVICE_FUNCTIONING;
 107                 return AE_OK;
 108         }
 109         return status;
 110 }
 111
 112 int acpi_bus_get_status(struct acpi_device *device)
 113 {
 114         acpi_status status;
 115         unsigned long long sta;
 116
 117         status = acpi_bus_get_status_handle(device->handle, &sta);
 118         if (ACPI_FAILURE(status))
 119                 return -ENODEV;
 120
 121         acpi_set_device_status(device, sta);
 122
 123         if (device->status.functional && !device->status.present) {
 124                 ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Device [%s] status [%08x]: "
 125                        "functional but not present;\n",
 126                         device->pnp.bus_id, (u32)sta));
 127         }
 128
 129         ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Device [%s] status [%08x]\n",
 130                           device->pnp.bus_id, (u32)sta));
 131         return 0;
 132 }
 133 EXPORT_SYMBOL(acpi_bus_get_status);
 134
 135 void acpi_bus_private_data_handler(acpi_handle handle,
 136                                    void *context)
 137 {
 138         return;
 139 }
 140 EXPORT_SYMBOL(acpi_bus_private_data_handler);
 141
 142 int acpi_bus_attach_private_data(acpi_handle handle, void *data)
 143 {
 144         acpi_status status;
 145
 146         status = acpi_attach_data(handle,
 147                         acpi_bus_private_data_handler, data);
 148         if (ACPI_FAILURE(status)) {
 149                 acpi_handle_debug(handle, "Error attaching device data\n");
 150                 return -ENODEV;
 151         }
 152
 153         return 0;
 154 }
 155 EXPORT_SYMBOL_GPL(acpi_bus_attach_private_data);
 156
 157 int acpi_bus_get_private_data(acpi_handle handle, void **data)
 158 {
 159         acpi_status status;
 160
 161         if (!*data)
 162                 return -EINVAL;
 163
 164         status = acpi_get_data(handle, acpi_bus_private_data_handler, data);
 165         if (ACPI_FAILURE(status)) {
 166                 acpi_handle_debug(handle, "No context for object\n");
 167                 return -ENODEV;
 168         }
 169
 170         return 0;
 171 }
 172 EXPORT_SYMBOL_GPL(acpi_bus_get_private_data);
 173
 174 void acpi_bus_detach_private_data(acpi_handle handle)
 175 {
 176         acpi_detach_data(handle, acpi_bus_private_data_handler);
 177 }
 178 EXPORT_SYMBOL_GPL(acpi_bus_detach_private_data);
 179
 180 static void acpi_print_osc_error(acpi_handle handle,
 181         struct acpi_osc_context *context, char *error)
 182 {
 183         struct acpi_buffer buffer = {ACPI_ALLOCATE_BUFFER};
 184         int i;
 185
 186         if (ACPI_FAILURE(acpi_get_name(handle, ACPI_FULL_PATHNAME, &buffer)))
 187                 printk(KERN_DEBUG "%s\n", error);
 188         else {
 189                 printk(KERN_DEBUG "%s:%s\n", (char *)buffer.pointer, error);
 190                 kfree(buffer.pointer);
 191         }
 192         printk(KERN_DEBUG"_OSC request data:");
 193         for (i = 0; i < context->cap.length; i += sizeof(u32))
 194                 printk("%x ", *((u32 *)(context->cap.pointer + i)));
 195         printk("\n");
 196 }
 197
 198 acpi_status acpi_str_to_uuid(char *str, u8 *uuid)
 199 {
 200         int i;
 201         static int opc_map_to_uuid[16] = {6, 4, 2, 0, 11, 9, 16, 14, 19, 21,
 202                 24, 26, 28, 30, 32, 34};
 203
 204         if (strlen(str) != 36)
 205                 return AE_BAD_PARAMETER;
 206         for (i = 0; i < 36; i++) {
 207                 if (i == 8 || i == 13 || i == 18 || i == 23) {
 208                         if (str[i] != '-')
 209                                 return AE_BAD_PARAMETER;
 210                 } else if (!isxdigit(str[i]))
 211                         return AE_BAD_PARAMETER;
 212         }
 213         for (i = 0; i < 16; i++) {
 214                 uuid[i] = hex_to_bin(str[opc_map_to_uuid[i]]) << 4;
 215                 uuid[i] |= hex_to_bin(str[opc_map_to_uuid[i] + 1]);
 216         }
 217         return AE_OK;
 218 }
 219 EXPORT_SYMBOL_GPL(acpi_str_to_uuid);
 220
 221 acpi_status acpi_run_osc(acpi_handle handle, struct acpi_osc_context *context)
 222 {
 223         acpi_status status;
 224         struct acpi_object_list input;
 225         union acpi_object in_params[4];
 226         union acpi_object *out_obj;
 227         u8 uuid[16];
 228         u32 errors;
 229         struct acpi_buffer output = {ACPI_ALLOCATE_BUFFER, NULL};
 230
 231         if (!context)
 232                 return AE_ERROR;
 233         if (ACPI_FAILURE(acpi_str_to_uuid(context->uuid_str, uuid)))
 234                 return AE_ERROR;
 235         context->ret.length = ACPI_ALLOCATE_BUFFER;
 236         context->ret.pointer = NULL;
 237
 238         /* Setting up input parameters */
 239         input.count = 4;
 240         input.pointer = in_params;
 241         in_params[0].type               = ACPI_TYPE_BUFFER;
 242         in_params[0].buffer.length      = 16;
 243         in_params[0].buffer.pointer     = uuid;
 244         in_params[1].type               = ACPI_TYPE_INTEGER;
 245         in_params[1].integer.value      = context->rev;
 246         in_params[2].type               = ACPI_TYPE_INTEGER;
 247         in_params[2].integer.value      = context->cap.length/sizeof(u32);
 248         in_params[3].type               = ACPI_TYPE_BUFFER;
 249         in_params[3].buffer.length      = context->cap.length;
 250         in_params[3].buffer.pointer     = context->cap.pointer;
 251
 252         status = acpi_evaluate_object(handle, "_OSC", &input, &output);
 253         if (ACPI_FAILURE(status))
 254                 return status;
 255
 256         if (!output.length)
 257                 return AE_NULL_OBJECT;
 258
 259         out_obj = output.pointer;
 260         if (out_obj->type != ACPI_TYPE_BUFFER
 261                 || out_obj->buffer.length != context->cap.length) {
 262                 acpi_print_osc_error(handle, context,
 263                         "_OSC evaluation returned wrong type");
 264                 status = AE_TYPE;
 265                 goto out_kfree;
 266         }
 267         /* Need to ignore the bit0 in result code */
 268         errors = *((u32 *)out_obj->buffer.pointer) & ~(1 << 0);
 269         if (errors) {
 270                 if (errors & OSC_REQUEST_ERROR)
 271                         acpi_print_osc_error(handle, context,
 272                                 "_OSC request failed");
 273                 if (errors & OSC_INVALID_UUID_ERROR)
 274                         acpi_print_osc_error(handle, context,
 275                                 "_OSC invalid UUID");
 276                 if (errors & OSC_INVALID_REVISION_ERROR)
 277                         acpi_print_osc_error(handle, context,
 278                                 "_OSC invalid revision");
 279                 if (errors & OSC_CAPABILITIES_MASK_ERROR) {
 280                         if (((u32 *)context->cap.pointer)[OSC_QUERY_DWORD]
 281                             & OSC_QUERY_ENABLE)
 282                                 goto out_success;
 283                         status = AE_SUPPORT;
 284                         goto out_kfree;
 285                 }
 286                 status = AE_ERROR;
 287                 goto out_kfree;
 288         }
 289 out_success:
 290         context->ret.length = out_obj->buffer.length;
 291         context->ret.pointer = kmemdup(out_obj->buffer.pointer,
 292                                        context->ret.length, GFP_KERNEL);
 293         if (!context->ret.pointer) {
 294                 status =  AE_NO_MEMORY;
 295                 goto out_kfree;
 296         }
 297         status =  AE_OK;
 298
 299 out_kfree:
 300         kfree(output.pointer);
 301         if (status != AE_OK)
 302                 context->ret.pointer = NULL;
 303         return status;
 304 }
 305 EXPORT_SYMBOL(acpi_run_osc);
 306
 307 bool osc_sb_apei_support_acked;
 308 static u8 sb_uuid_str[] = "0811B06E-4A27-44F9-8D60-3CBBC22E7B48";
 309 static void acpi_bus_osc_support(void)
 310 {
 311         u32 capbuf[2];
 312         struct acpi_osc_context context = {
 313                 .uuid_str = sb_uuid_str,
 314                 .rev = 1,
 315                 .cap.length = 8,
 316                 .cap.pointer = capbuf,
 317         };
 318         acpi_handle handle;
 319
 320         capbuf[OSC_QUERY_DWORD] = OSC_QUERY_ENABLE;
 321         capbuf[OSC_SUPPORT_DWORD] = OSC_SB_PR3_SUPPORT; /* _PR3 is in use */
 322 #if defined(CONFIG_ACPI_PROCESSOR_AGGREGATOR) ||\
 323                         defined(CONFIG_ACPI_PROCESSOR_AGGREGATOR_MODULE)
 324         capbuf[OSC_SUPPORT_DWORD] |= OSC_SB_PAD_SUPPORT;
 325 #endif
 326
 327 #if defined(CONFIG_ACPI_PROCESSOR) || defined(CONFIG_ACPI_PROCESSOR_MODULE)
 328         capbuf[OSC_SUPPORT_DWORD] |= OSC_SB_PPC_OST_SUPPORT;
 329 #endif
 330
 331         capbuf[OSC_SUPPORT_DWORD] |= OSC_SB_HOTPLUG_OST_SUPPORT;
 332
 333         if (!ghes_disable)
 334                 capbuf[OSC_SUPPORT_DWORD] |= OSC_SB_APEI_SUPPORT;
 335         if (ACPI_FAILURE(acpi_get_handle(NULL, "\\_SB", &handle)))
 336                 return;
 337         if (ACPI_SUCCESS(acpi_run_osc(handle, &context))) {
 338                 u32 *capbuf_ret = context.ret.pointer;
 339                 if (context.ret.length > OSC_SUPPORT_DWORD)
 340                         osc_sb_apei_support_acked =
 341                                 capbuf_ret[OSC_SUPPORT_DWORD] & OSC_SB_APEI_SUPPORT;
 342                 kfree(context.ret.pointer);
 343         }
 344         /* do we need to check other returned cap? Sounds no */
 345 }
 346
 347 /* --------------------------------------------------------------------------
 348                              Notification Handling
 349    -------------------------------------------------------------------------- */
 350
 351 /**
 352  * acpi_bus_notify
 353  * ---------------
 354  * Callback for all 'system-level' device notifications (values 0x00-0x7F).
 355  */
 356 static void acpi_bus_notify(acpi_handle handle, u32 type, void *data)
 357 {
 358         struct acpi_device *adev;
 359         struct acpi_driver *driver;
 360         u32 ost_code = ACPI_OST_SC_NON_SPECIFIC_FAILURE;
 361         bool hotplug_event = false;
 362
 363         switch (type) {
 364         case ACPI_NOTIFY_BUS_CHECK:
 365                 acpi_handle_debug(handle, "ACPI_NOTIFY_BUS_CHECK event\n");
 366                 hotplug_event = true;
 367                 break;
 368
 369         case ACPI_NOTIFY_DEVICE_CHECK:
 370                 acpi_handle_debug(handle, "ACPI_NOTIFY_DEVICE_CHECK event\n");
 371                 hotplug_event = true;
 372                 break;
 373
 374         case ACPI_NOTIFY_DEVICE_WAKE:
 375                 acpi_handle_debug(handle, "ACPI_NOTIFY_DEVICE_WAKE event\n");
 376                 break;
 377
 378         case ACPI_NOTIFY_EJECT_REQUEST:
 379                 acpi_handle_debug(handle, "ACPI_NOTIFY_EJECT_REQUEST event\n");
 380                 hotplug_event = true;
 381                 break;
 382
 383         case ACPI_NOTIFY_DEVICE_CHECK_LIGHT:
 384                 acpi_handle_debug(handle, "ACPI_NOTIFY_DEVICE_CHECK_LIGHT event\n");
 385                 /* TBD: Exactly what does 'light' mean? */
 386                 break;
 387
 388         case ACPI_NOTIFY_FREQUENCY_MISMATCH:
 389                 acpi_handle_err(handle, "Device cannot be configured due "
 390                                 "to a frequency mismatch\n");
 391                 break;
 392
 393         case ACPI_NOTIFY_BUS_MODE_MISMATCH:
 394                 acpi_handle_err(handle, "Device cannot be configured due "
 395                                 "to a bus mode mismatch\n");
 396                 break;
 397
 398         case ACPI_NOTIFY_POWER_FAULT:
 399                 acpi_handle_err(handle, "Device has suffered a power fault\n");
 400                 break;
 401
 402         default:
 403                 acpi_handle_debug(handle, "Unknown event type 0x%x\n", type);
 404                 break;
 405         }
 406
 407         adev = acpi_bus_get_acpi_device(handle);
 408         if (!adev)
 409                 goto err;
 410
 411         driver = adev->driver;
 412         if (driver && driver->ops.notify &&
 413             (driver->flags & ACPI_DRIVER_ALL_NOTIFY_EVENTS))
 414                 driver->ops.notify(adev, type);
 415
 416         if (hotplug_event && ACPI_SUCCESS(acpi_hotplug_schedule(adev, type)))
 417                 return;
 418
 419         acpi_bus_put_acpi_device(adev);
 420         return;
 421
 422  err:
 423         acpi_evaluate_ost(handle, type, ost_code, NULL);
 424 }
 425
 426 static void acpi_device_notify(acpi_handle handle, u32 event, void *data)
 427 {
 428         struct acpi_device *device = data;
 429
 430         device->driver->ops.notify(device, event);
 431 }
 432
 433 static void acpi_device_notify_fixed(void *data)
 434 {
 435         struct acpi_device *device = data;
 436
 437         /* Fixed hardware devices have no handles */
 438         acpi_device_notify(NULL, ACPI_FIXED_HARDWARE_EVENT, device);
 439 }
 440
 441 static u32 acpi_device_fixed_event(void *data)
 442 {
 443         acpi_os_execute(OSL_NOTIFY_HANDLER, acpi_device_notify_fixed, data);
 444         return ACPI_INTERRUPT_HANDLED;
 445 }
 446
 447 static int acpi_device_install_notify_handler(struct acpi_device *device)
 448 {
 449         acpi_status status;
 450
 451         if (device->device_type == ACPI_BUS_TYPE_POWER_BUTTON)
 452                 status =
 453                     acpi_install_fixed_event_handler(ACPI_EVENT_POWER_BUTTON,
 454                                                      acpi_device_fixed_event,
 455                                                      device);
 456         else if (device->device_type == ACPI_BUS_TYPE_SLEEP_BUTTON)
 457                 status =
 458                     acpi_install_fixed_event_handler(ACPI_EVENT_SLEEP_BUTTON,
 459                                                      acpi_device_fixed_event,
 460                                                      device);
 461         else
 462                 status = acpi_install_notify_handler(device->handle,
 463                                                      ACPI_DEVICE_NOTIFY,
 464                                                      acpi_device_notify,
 465                                                      device);
 466
 467         if (ACPI_FAILURE(status))
 468                 return -EINVAL;
 469         return 0;
 470 }
 471
 472 static void acpi_device_remove_notify_handler(struct acpi_device *device)
 473 {
 474         if (device->device_type == ACPI_BUS_TYPE_POWER_BUTTON)
 475                 acpi_remove_fixed_event_handler(ACPI_EVENT_POWER_BUTTON,
 476                                                 acpi_device_fixed_event);
 477         else if (device->device_type == ACPI_BUS_TYPE_SLEEP_BUTTON)
 478                 acpi_remove_fixed_event_handler(ACPI_EVENT_SLEEP_BUTTON,
 479                                                 acpi_device_fixed_event);
 480         else
 481                 acpi_remove_notify_handler(device->handle, ACPI_DEVICE_NOTIFY,
 482                                            acpi_device_notify);
 483 }
 484
 485 /* --------------------------------------------------------------------------
 486                              Device Matching
 487    -------------------------------------------------------------------------- */
 488
 489 static struct acpi_device *acpi_primary_dev_companion(struct acpi_device *adev,
 490                                                       const struct device *dev)
 491 {
 492         struct mutex *physical_node_lock = &adev->physical_node_lock;
 493
 494         mutex_lock(physical_node_lock);
 495         if (list_empty(&adev->physical_node_list)) {
 496                 adev = NULL;
 497         } else {
 498                 const struct acpi_device_physical_node *node;
 499
 500                 node = list_first_entry(&adev->physical_node_list,
 501                                         struct acpi_device_physical_node, node);
 502                 if (node->dev != dev)
 503                         adev = NULL;
 504         }
 505         mutex_unlock(physical_node_lock);
 506         return adev;
 507 }
 508
 509 /**
 510  * acpi_device_is_first_physical_node - Is given dev first physical node
 511  * @adev: ACPI companion device
 512  * @dev: Physical device to check
 513  *
 514  * Function checks if given @dev is the first physical devices attached to
 515  * the ACPI companion device. This distinction is needed in some cases
 516  * where the same companion device is shared between many physical devices.
 517  *
 518  * Note that the caller have to provide valid @adev pointer.
 519  */
 520 bool acpi_device_is_first_physical_node(struct acpi_device *adev,
 521                                         const struct device *dev)
 522 {
 523         return !!acpi_primary_dev_companion(adev, dev);
 524 }
 525
 526 /*
 527  * acpi_companion_match() - Can we match via ACPI companion device
 528  * @dev: Device in question
 529  *
 530  * Check if the given device has an ACPI companion and if that companion has
 531  * a valid list of PNP IDs, and if the device is the first (primary) physical
 532  * device associated with it.  Return the companion pointer if that's the case
 533  * or NULL otherwise.
 534  *
 535  * If multiple physical devices are attached to a single ACPI companion, we need
 536  * to be careful.  The usage scenario for this kind of relationship is that all
 537  * of the physical devices in question use resources provided by the ACPI
 538  * companion.  A typical case is an MFD device where all the sub-devices share
 539  * the parent's ACPI companion.  In such cases we can only allow the primary
 540  * (first) physical device to be matched with the help of the companion's PNP
 541  * IDs.
 542  *
 543  * Additional physical devices sharing the ACPI companion can still use
 544  * resources available from it but they will be matched normally using functions
 545  * provided by their bus types (and analogously for their modalias).
 546  */
 547 struct acpi_device *acpi_companion_match(const struct device *dev)
 548 {
 549         struct acpi_device *adev;
 550
 551         adev = ACPI_COMPANION(dev);
 552         if (!adev)
 553                 return NULL;
 554
 555         if (list_empty(&adev->pnp.ids))
 556                 return NULL;
 557
 558         return acpi_primary_dev_companion(adev, dev);
 559 }
 560
 561 /**
 562  * acpi_of_match_device - Match device object using the "compatible" property.
 563  * @adev: ACPI device object to match.
 564  * @of_match_table: List of device IDs to match against.
 565  *
 566  * If @dev has an ACPI companion which has ACPI_DT_NAMESPACE_HID in its list of
 567  * identifiers and a _DSD object with the "compatible" property, use that
 568  * property to match against the given list of identifiers.
 569  */
 570 static bool acpi_of_match_device(struct acpi_device *adev,
 571                                  const struct of_device_id *of_match_table)
 572 {
 573         const union acpi_object *of_compatible, *obj;
 574         int i, nval;
 575
 576         if (!adev)
 577                 return false;
 578
 579         of_compatible = adev->data.of_compatible;
 580         if (!of_match_table || !of_compatible)
 581                 return false;
 582
 583         if (of_compatible->type == ACPI_TYPE_PACKAGE) {
 584                 nval = of_compatible->package.count;
 585                 obj = of_compatible->package.elements;
 586         } else { /* Must be ACPI_TYPE_STRING. */
 587                 nval = 1;
 588                 obj = of_compatible;
 589         }
 590         /* Now we can look for the driver DT compatible strings */
 591         for (i = 0; i < nval; i++, obj++) {
 592                 const struct of_device_id *id;
 593
 594                 for (id = of_match_table; id->compatible[0]; id++)
 595                         if (!strcasecmp(obj->string.pointer, id->compatible))
 596                                 return true;
 597         }
 598
 599         return false;
 600 }
 601
 602 static bool __acpi_match_device_cls(const struct acpi_device_id *id,
 603                                     struct acpi_hardware_id *hwid)
 604 {
 605         int i, msk, byte_shift;
 606         char buf[3];
 607
 608         if (!id->cls)
 609                 return false;
 610
 611         /* Apply class-code bitmask, before checking each class-code byte */
 612         for (i = 1; i <= 3; i++) {
 613                 byte_shift = 8 * (3 - i);
 614                 msk = (id->cls_msk >> byte_shift) & 0xFF;
 615                 if (!msk)
 616                         continue;
 617
 618                 sprintf(buf, "%02x", (id->cls >> byte_shift) & msk);
 619                 if (strncmp(buf, &hwid->id[(i - 1) * 2], 2))
 620                         return false;
 621         }
 622         return true;
 623 }
 624
 625 static const struct acpi_device_id *__acpi_match_device(
 626         struct acpi_device *device,
 627         const struct acpi_device_id *ids,
 628         const struct of_device_id *of_ids)
 629 {
 630         const struct acpi_device_id *id;
 631         struct acpi_hardware_id *hwid;
 632
 633         /*
 634          * If the device is not present, it is unnecessary to load device
 635          * driver for it.
 636          */
 637         if (!device || !device->status.present)
 638                 return NULL;
 639
 640         list_for_each_entry(hwid, &device->pnp.ids, list) {
 641                 /* First, check the ACPI/PNP IDs provided by the caller. */
 642                 for (id = ids; id->id[0] || id->cls; id++) {
 643                         if (id->id[0] && !strcmp((char *) id->id, hwid->id))
 644                                 return id;
 645                         else if (id->cls && __acpi_match_device_cls(id, hwid))
 646                                 return id;
 647                 }
 648
 649                 /*
 650                  * Next, check ACPI_DT_NAMESPACE_HID and try to match the
 651                  * "compatible" property if found.
 652                  *
 653                  * The id returned by the below is not valid, but the only
 654                  * caller passing non-NULL of_ids here is only interested in
 655                  * whether or not the return value is NULL.
 656                  */
 657                 if (!strcmp(ACPI_DT_NAMESPACE_HID, hwid->id)
 658                     && acpi_of_match_device(device, of_ids))
 659                         return id;
 660         }
 661         return NULL;
 662 }
 663
 664 /**
 665  * acpi_match_device - Match a struct device against a given list of ACPI IDs
 666  * @ids: Array of struct acpi_device_id object to match against.
 667  * @dev: The device structure to match.
 668  *
 669  * Check if @dev has a valid ACPI handle and if there is a struct acpi_device
 670  * object for that handle and use that object to match against a given list of
 671  * device IDs.
 672  *
 673  * Return a pointer to the first matching ID on success or %NULL on failure.
 674  */
 675 const struct acpi_device_id *acpi_match_device(const struct acpi_device_id *ids,
 676                                                const struct device *dev)
 677 {
 678         return __acpi_match_device(acpi_companion_match(dev), ids, NULL);
 679 }
 680 EXPORT_SYMBOL_GPL(acpi_match_device);
 681
 682 int acpi_match_device_ids(struct acpi_device *device,
 683                           const struct acpi_device_id *ids)
 684 {
 685         return __acpi_match_device(device, ids, NULL) ? 0 : -ENOENT;
 686 }
 687 EXPORT_SYMBOL(acpi_match_device_ids);
 688
 689 bool acpi_driver_match_device(struct device *dev,
 690                               const struct device_driver *drv)
 691 {
 692         if (!drv->acpi_match_table)
 693                 return acpi_of_match_device(ACPI_COMPANION(dev),
 694                                             drv->of_match_table);
 695
 696         return !!__acpi_match_device(acpi_companion_match(dev),
 697                                      drv->acpi_match_table, drv->of_match_table);
 698 }
 699 EXPORT_SYMBOL_GPL(acpi_driver_match_device);
 700
 701 /* --------------------------------------------------------------------------
 702                               ACPI Driver Management
 703    -------------------------------------------------------------------------- */
 704
 705 /**
 706  * acpi_bus_register_driver - register a driver with the ACPI bus
 707  * @driver: driver being registered
 708  *
 709  * Registers a driver with the ACPI bus.  Searches the namespace for all
 710  * devices that match the driver's criteria and binds.  Returns zero for
 711  * success or a negative error status for failure.
 712  */
 713 int acpi_bus_register_driver(struct acpi_driver *driver)
 714 {
 715         int ret;
 716
 717         if (acpi_disabled)
 718                 return -ENODEV;
 719         driver->drv.name = driver->name;
 720         driver->drv.bus = &acpi_bus_type;
 721         driver->drv.owner = driver->owner;
 722
 723         ret = driver_register(&driver->drv);
 724         return ret;
 725 }
 726
 727 EXPORT_SYMBOL(acpi_bus_register_driver);
 728
 729 /**
 730  * acpi_bus_unregister_driver - unregisters a driver with the ACPI bus
 731  * @driver: driver to unregister
 732  *
 733  * Unregisters a driver with the ACPI bus.  Searches the namespace for all
 734  * devices that match the driver's criteria and unbinds.
 735  */
 736 void acpi_bus_unregister_driver(struct acpi_driver *driver)
 737 {
 738         driver_unregister(&driver->drv);
 739 }
 740
 741 EXPORT_SYMBOL(acpi_bus_unregister_driver);
 742
 743 /* --------------------------------------------------------------------------
 744                               ACPI Bus operations
 745    -------------------------------------------------------------------------- */
 746
 747 static int acpi_bus_match(struct device *dev, struct device_driver *drv)
 748 {
 749         struct acpi_device *acpi_dev = to_acpi_device(dev);
 750         struct acpi_driver *acpi_drv = to_acpi_driver(drv);
 751
 752         return acpi_dev->flags.match_driver
 753                 && !acpi_match_device_ids(acpi_dev, acpi_drv->ids);
 754 }
 755
 756 static int acpi_device_uevent(struct device *dev, struct kobj_uevent_env *env)
 757 {
 758         return __acpi_device_uevent_modalias(to_acpi_device(dev), env);
 759 }
 760
 761 static int acpi_device_probe(struct device *dev)
 762 {
 763         struct acpi_device *acpi_dev = to_acpi_device(dev);
 764         struct acpi_driver *acpi_drv = to_acpi_driver(dev->driver);
 765         int ret;
 766
 767         if (acpi_dev->handler && !acpi_is_pnp_device(acpi_dev))
 768                 return -EINVAL;
 769
 770         if (!acpi_drv->ops.add)
 771                 return -ENOSYS;
 772
 773         ret = acpi_drv->ops.add(acpi_dev);
 774         if (ret)
 775                 return ret;
 776
 777         acpi_dev->driver = acpi_drv;
 778         ACPI_DEBUG_PRINT((ACPI_DB_INFO,
 779                           "Driver [%s] successfully bound to device [%s]\n",
 780                           acpi_drv->name, acpi_dev->pnp.bus_id));
 781
 782         if (acpi_drv->ops.notify) {
 783                 ret = acpi_device_install_notify_handler(acpi_dev);
 784                 if (ret) {
 785                         if (acpi_drv->ops.remove)
 786                                 acpi_drv->ops.remove(acpi_dev);
 787
 788                         acpi_dev->driver = NULL;
 789                         acpi_dev->driver_data = NULL;
 790                         return ret;
 791                 }
 792         }
 793
 794         ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Found driver [%s] for device [%s]\n",
 795                           acpi_drv->name, acpi_dev->pnp.bus_id));
 796         get_device(dev);
 797         return 0;
 798 }
 799
 800 static int acpi_device_remove(struct device * dev)
 801 {
 802         struct acpi_device *acpi_dev = to_acpi_device(dev);
 803         struct acpi_driver *acpi_drv = acpi_dev->driver;
 804
 805         if (acpi_drv) {
 806                 if (acpi_drv->ops.notify)
 807                         acpi_device_remove_notify_handler(acpi_dev);
 808                 if (acpi_drv->ops.remove)
 809                         acpi_drv->ops.remove(acpi_dev);
 810         }
 811         acpi_dev->driver = NULL;
 812         acpi_dev->driver_data = NULL;
 813
 814         put_device(dev);
 815         return 0;
 816 }
 817
 818 struct bus_type acpi_bus_type = {
 819         .name           = "acpi",
 820         .match          = acpi_bus_match,
 821         .probe          = acpi_device_probe,
 822         .remove         = acpi_device_remove,
 823         .uevent         = acpi_device_uevent,
 824 };
 825
 826 /* --------------------------------------------------------------------------
 827                              Initialization/Cleanup
 828    -------------------------------------------------------------------------- */
 829
 830 static int __init acpi_bus_init_irq(void)
 831 {
 832         acpi_status status;
 833         char *message = NULL;
 834
 835
 836         /*
 837          * Let the system know what interrupt model we are using by
 838          * evaluating the \_PIC object, if exists.
 839          */
 840
 841         switch (acpi_irq_model) {
 842         case ACPI_IRQ_MODEL_PIC:
 843                 message = "PIC";
 844                 break;
 845         case ACPI_IRQ_MODEL_IOAPIC:
 846                 message = "IOAPIC";
 847                 break;
 848         case ACPI_IRQ_MODEL_IOSAPIC:
 849                 message = "IOSAPIC";
 850                 break;
 851         case ACPI_IRQ_MODEL_GIC:
 852                 message = "GIC";
 853                 break;
 854         case ACPI_IRQ_MODEL_PLATFORM:
 855                 message = "platform specific model";
 856                 break;
 857         default:
 858                 printk(KERN_WARNING PREFIX "Unknown interrupt routing model\n");
 859                 return -ENODEV;
 860         }
 861
 862         printk(KERN_INFO PREFIX "Using %s for interrupt routing\n", message);
 863
 864         status = acpi_execute_simple_method(NULL, "\\_PIC", acpi_irq_model);
 865         if (ACPI_FAILURE(status) && (status != AE_NOT_FOUND)) {
 866                 ACPI_EXCEPTION((AE_INFO, status, "Evaluating _PIC"));
 867                 return -ENODEV;
 868         }
 869
 870         return 0;
 871 }
 872
 873 /**
 874  * acpi_early_init - Initialize ACPICA and populate the ACPI namespace.
 875  *
 876  * The ACPI tables are accessible after this, but the handling of events has not
 877  * been initialized and the global lock is not available yet, so AML should not
 878  * be executed at this point.
 879  *
 880  * Doing this before switching the EFI runtime services to virtual mode allows
 881  * the EfiBootServices memory to be freed slightly earlier on boot.
 882  */
 883 void __init acpi_early_init(void)
 884 {
 885         acpi_status status;
 886
 887         if (acpi_disabled)
 888                 return;
 889
 890         printk(KERN_INFO PREFIX "Core revision %08x\n", ACPI_CA_VERSION);
 891
 892         /* It's safe to verify table checksums during late stage */
 893         acpi_gbl_verify_table_checksum = TRUE;
 894
 895         /* enable workarounds, unless strict ACPI spec. compliance */
 896         if (!acpi_strict)
 897                 acpi_gbl_enable_interpreter_slack = TRUE;
 898
 899         acpi_gbl_permanent_mmap = 1;
 900
 901         /*
 902          * If the machine falls into the DMI check table,
 903          * DSDT will be copied to memory
 904          */
 905         dmi_check_system(dsdt_dmi_table);
 906
 907         status = acpi_reallocate_root_table();
 908         if (ACPI_FAILURE(status)) {
 909                 printk(KERN_ERR PREFIX
 910                        "Unable to reallocate ACPI tables\n");
 911                 goto error0;
 912         }
 913
 914         status = acpi_initialize_subsystem();
 915         if (ACPI_FAILURE(status)) {
 916                 printk(KERN_ERR PREFIX
 917                        "Unable to initialize the ACPI Interpreter\n");
 918                 goto error0;
 919         }
 920
 921         status = acpi_load_tables();
 922         if (ACPI_FAILURE(status)) {
 923                 printk(KERN_ERR PREFIX
 924                        "Unable to load the System Description Tables\n");
 925                 goto error0;
 926         }
 927
 928 #ifdef CONFIG_X86
 929         if (!acpi_ioapic) {
 930                 /* compatible (0) means level (3) */
 931                 if (!(acpi_sci_flags & ACPI_MADT_TRIGGER_MASK)) {
 932                         acpi_sci_flags &= ~ACPI_MADT_TRIGGER_MASK;
 933                         acpi_sci_flags |= ACPI_MADT_TRIGGER_LEVEL;
 934                 }
 935                 /* Set PIC-mode SCI trigger type */
 936                 acpi_pic_sci_set_trigger(acpi_gbl_FADT.sci_interrupt,
 937                                          (acpi_sci_flags & ACPI_MADT_TRIGGER_MASK) >> 2);
 938         } else {
 939                 /*
 940                  * now that acpi_gbl_FADT is initialized,
 941                  * update it with result from INT_SRC_OVR parsing
 942                  */
 943                 acpi_gbl_FADT.sci_interrupt = acpi_sci_override_gsi;
 944         }
 945 #endif
 946         return;
 947
 948  error0:
 949         disable_acpi();
 950 }
 951
 952 /**
 953  * acpi_subsystem_init - Finalize the early initialization of ACPI.
 954  *
 955  * Switch over the platform to the ACPI mode (if possible), initialize the
 956  * handling of ACPI events, install the interrupt and global lock handlers.
 957  *
 958  * Doing this too early is generally unsafe, but at the same time it needs to be
 959  * done before all things that really depend on ACPI.  The right spot appears to
 960  * be before finalizing the EFI initialization.
 961  */
 962 void __init acpi_subsystem_init(void)
 963 {
 964         acpi_status status;
 965
 966         if (acpi_disabled)
 967                 return;
 968
 969         status = acpi_enable_subsystem(~ACPI_NO_ACPI_ENABLE);
 970         if (ACPI_FAILURE(status)) {
 971                 printk(KERN_ERR PREFIX "Unable to enable ACPI\n");
 972                 disable_acpi();
 973         } else {
 974                 /*
 975                  * If the system is using ACPI then we can be reasonably
 976                  * confident that any regulators are managed by the firmware
 977                  * so tell the regulator core it has everything it needs to
 978                  * know.
 979                  */
 980                 regulator_has_full_constraints();
 981         }
 982 }
 983
 984 static int __init acpi_bus_init(void)
 985 {
 986         int result;
 987         acpi_status status;
 988
 989         acpi_os_initialize1();
 990
 991         status = acpi_enable_subsystem(ACPI_NO_ACPI_ENABLE);
 992         if (ACPI_FAILURE(status)) {
 993                 printk(KERN_ERR PREFIX
 994                        "Unable to start the ACPI Interpreter\n");
 995                 goto error1;
 996         }
 997
 998         /*
 999          * ACPI 2.0 requires the EC driver to be loaded and work before
1000          * the EC device is found in the namespace (i.e. before acpi_initialize_objects()
1001          * is called).
1002          *
1003          * This is accomplished by looking for the ECDT table, and getting
1004          * the EC parameters out of that.
1005          */
1006         status = acpi_ec_ecdt_probe();
1007         /* Ignore result. Not having an ECDT is not fatal. */
1008
1009         status = acpi_initialize_objects(ACPI_FULL_INITIALIZATION);
1010         if (ACPI_FAILURE(status)) {
1011                 printk(KERN_ERR PREFIX "Unable to initialize ACPI objects\n");
1012                 goto error1;
1013         }
1014
1015         /*
1016          * _OSC method may exist in module level code,
1017          * so it must be run after ACPI_FULL_INITIALIZATION
1018          */
1019         acpi_bus_osc_support();
1020
1021         /*
1022          * _PDC control method may load dynamic SSDT tables,
1023          * and we need to install the table handler before that.
1024          */
1025         acpi_sysfs_init();
1026
1027         acpi_early_processor_set_pdc();
1028
1029         /*
1030          * Maybe EC region is required at bus_scan/acpi_get_devices. So it
1031          * is necessary to enable it as early as possible.
1032          */
1033         acpi_boot_ec_enable();
1034
1035         printk(KERN_INFO PREFIX "Interpreter enabled\n");
1036
1037         /* Initialize sleep structures */
1038         acpi_sleep_init();
1039
1040         /*
1041          * Get the system interrupt model and evaluate \_PIC.
1042          */
1043         result = acpi_bus_init_irq();
1044         if (result)
1045                 goto error1;
1046
1047         /*
1048          * Register the for all standard device notifications.
1049          */
1050         status =
1051             acpi_install_notify_handler(ACPI_ROOT_OBJECT, ACPI_SYSTEM_NOTIFY,
1052                                         &acpi_bus_notify, NULL);
1053         if (ACPI_FAILURE(status)) {
1054                 printk(KERN_ERR PREFIX
1055                        "Unable to register for device notifications\n");
1056                 goto error1;
1057         }
1058
1059         /*
1060          * Create the top ACPI proc directory
1061          */
1062         acpi_root_dir = proc_mkdir(ACPI_BUS_FILE_ROOT, NULL);
1063
1064         result = bus_register(&acpi_bus_type);
1065         if (!result)
1066                 return 0;
1067
1068         /* Mimic structured exception handling */
1069       error1:
1070         acpi_terminate();
1071         return -ENODEV;
1072 }
1073
1074 struct kobject *acpi_kobj;
1075 EXPORT_SYMBOL_GPL(acpi_kobj);
1076
1077 static int __init acpi_init(void)
1078 {
1079         int result;
1080
1081         if (acpi_disabled) {
1082                 printk(KERN_INFO PREFIX "Interpreter disabled.\n");
1083                 return -ENODEV;
1084         }
1085
1086         acpi_kobj = kobject_create_and_add("acpi", firmware_kobj);
1087         if (!acpi_kobj) {
1088                 printk(KERN_WARNING "%s: kset create error\n", __func__);
1089                 acpi_kobj = NULL;
1090         }
1091
1092         init_acpi_device_notify();
1093         result = acpi_bus_init();
1094         if (result) {
1095                 disable_acpi();
1096                 return result;
1097         }
1098
1099         pci_mmcfg_late_init();
1100         acpi_scan_init();
1101         acpi_ec_init();
1102         acpi_debugfs_init();
1103         acpi_sleep_proc_init();
1104         acpi_wakeup_device_init();
1105         return 0;
1106 }
1107
1108 subsys_initcall(acpi_init);