1 /* 2 * ACPI PCI HotPlug glue functions to ACPI CA subsystem 3 * 4 * Copyright (C) 2002,2003 Takayoshi Kochi (t-kochi@bq.jp.nec.com) 5 * Copyright (C) 2002 Hiroshi Aono (h-aono@ap.jp.nec.com) 6 * Copyright (C) 2002,2003 NEC Corporation 7 * Copyright (C) 2003-2005 Matthew Wilcox (matthew.wilcox@hp.com) 8 * Copyright (C) 2003-2005 Hewlett Packard 9 * Copyright (C) 2005 Rajesh Shah (rajesh.shah@intel.com) 10 * Copyright (C) 2005 Intel Corporation 11 * 12 * All rights reserved. 13 * 14 * This program is free software; you can redistribute it and/or modify 15 * it under the terms of the GNU General Public License as published by 16 * the Free Software Foundation; either version 2 of the License, or (at 17 * your option) any later version. 18 * 19 * This program is distributed in the hope that it will be useful, but 20 * WITHOUT ANY WARRANTY; without even the implied warranty of 21 * MERCHANTABILITY OR FITNESS FOR A PARTICULAR PURPOSE, GOOD TITLE or 22 * NON INFRINGEMENT. See the GNU General Public License for more 23 * details. 24 * 25 * You should have received a copy of the GNU General Public License 26 * along with this program; if not, write to the Free Software 27 * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. 28 * 29 * Send feedback to <kristen.c.accardi@intel.com> 30 * 31 */ 32 33 /* 34 * Lifetime rules for pci_dev: 35 * - The one in acpiphp_bridge has its refcount elevated by pci_get_slot() 36 * when the bridge is scanned and it loses a refcount when the bridge 37 * is removed. 38 * - When a P2P bridge is present, we elevate the refcount on the subordinate 39 * bus. It loses the refcount when the the driver unloads. 40 */ 41 42 #include <linux/init.h> 43 #include <linux/module.h> 44 45 #include <linux/kernel.h> 46 #include <linux/pci.h> 47 #include <linux/pci_hotplug.h> 48 #include <linux/pci-acpi.h> 49 #include <linux/mutex.h> 50 #include <linux/slab.h> 51 #include <linux/acpi.h> 52 53 #include "../pci.h" 54 #include "acpiphp.h" 55 56 static LIST_HEAD(bridge_list); 57 58 #define MY_NAME "acpiphp_glue" 59 60 static void handle_hotplug_event_bridge (acpi_handle, u32, void *); 61 static void acpiphp_sanitize_bus(struct pci_bus *bus); 62 static void acpiphp_set_hpp_values(struct pci_bus *bus); 63 static void handle_hotplug_event_func(acpi_handle handle, u32 type, void *context); 64 65 /* callback routine to check for the existence of a pci dock device */ 66 static acpi_status 67 is_pci_dock_device(acpi_handle handle, u32 lvl, void *context, void **rv) 68 { 69 int *count = (int *)context; 70 71 if (is_dock_device(handle)) { 72 (*count)++; 73 return AE_CTRL_TERMINATE; 74 } else { 75 return AE_OK; 76 } 77 } 78 79 /* 80 * the _DCK method can do funny things... and sometimes not 81 * hah-hah funny. 82 * 83 * TBD - figure out a way to only call fixups for 84 * systems that require them. 85 */ 86 static int post_dock_fixups(struct notifier_block *nb, unsigned long val, 87 void *v) 88 { 89 struct acpiphp_func *func = container_of(nb, struct acpiphp_func, nb); 90 struct pci_bus *bus = func->slot->bridge->pci_bus; 91 u32 buses; 92 93 if (!bus->self) 94 return NOTIFY_OK; 95 96 /* fixup bad _DCK function that rewrites 97 * secondary bridge on slot 98 */ 99 pci_read_config_dword(bus->self, 100 PCI_PRIMARY_BUS, 101 &buses); 102 103 if (((buses >> 8) & 0xff) != bus->busn_res.start) { 104 buses = (buses & 0xff000000) 105 | ((unsigned int)(bus->primary) << 0) 106 | ((unsigned int)(bus->busn_res.start) << 8) 107 | ((unsigned int)(bus->busn_res.end) << 16); 108 pci_write_config_dword(bus->self, PCI_PRIMARY_BUS, buses); 109 } 110 return NOTIFY_OK; 111 } 112 113 114 static const struct acpi_dock_ops acpiphp_dock_ops = { 115 .handler = handle_hotplug_event_func, 116 }; 117 118 /* Check whether the PCI device is managed by native PCIe hotplug driver */ 119 static bool device_is_managed_by_native_pciehp(struct pci_dev *pdev) 120 { 121 u32 reg32; 122 acpi_handle tmp; 123 struct acpi_pci_root *root; 124 125 /* Check whether the PCIe port supports native PCIe hotplug */ 126 if (pcie_capability_read_dword(pdev, PCI_EXP_SLTCAP, ®32)) 127 return false; 128 if (!(reg32 & PCI_EXP_SLTCAP_HPC)) 129 return false; 130 131 /* 132 * Check whether native PCIe hotplug has been enabled for 133 * this PCIe hierarchy. 134 */ 135 tmp = acpi_find_root_bridge_handle(pdev); 136 if (!tmp) 137 return false; 138 root = acpi_pci_find_root(tmp); 139 if (!root) 140 return false; 141 if (!(root->osc_control_set & OSC_PCI_EXPRESS_NATIVE_HP_CONTROL)) 142 return false; 143 144 return true; 145 } 146 147 /* callback routine to register each ACPI PCI slot object */ 148 static acpi_status 149 register_slot(acpi_handle handle, u32 lvl, void *context, void **rv) 150 { 151 struct acpiphp_bridge *bridge = (struct acpiphp_bridge *)context; 152 struct acpiphp_slot *slot; 153 struct acpiphp_func *newfunc; 154 acpi_handle tmp; 155 acpi_status status = AE_OK; 156 unsigned long long adr, sun; 157 int device, function, retval, found = 0; 158 struct pci_bus *pbus = bridge->pci_bus; 159 struct pci_dev *pdev; 160 u32 val; 161 162 if (!acpi_pci_check_ejectable(pbus, handle) && !is_dock_device(handle)) 163 return AE_OK; 164 165 status = acpi_evaluate_integer(handle, "_ADR", NULL, &adr); 166 if (ACPI_FAILURE(status)) { 167 warn("can't evaluate _ADR (%#x)\n", status); 168 return AE_OK; 169 } 170 171 device = (adr >> 16) & 0xffff; 172 function = adr & 0xffff; 173 174 pdev = pbus->self; 175 if (pdev && device_is_managed_by_native_pciehp(pdev)) 176 return AE_OK; 177 178 newfunc = kzalloc(sizeof(struct acpiphp_func), GFP_KERNEL); 179 if (!newfunc) 180 return AE_NO_MEMORY; 181 182 INIT_LIST_HEAD(&newfunc->sibling); 183 newfunc->handle = handle; 184 newfunc->function = function; 185 186 if (ACPI_SUCCESS(acpi_get_handle(handle, "_EJ0", &tmp))) 187 newfunc->flags = FUNC_HAS_EJ0; 188 189 if (ACPI_SUCCESS(acpi_get_handle(handle, "_STA", &tmp))) 190 newfunc->flags |= FUNC_HAS_STA; 191 192 if (ACPI_SUCCESS(acpi_get_handle(handle, "_PS0", &tmp))) 193 newfunc->flags |= FUNC_HAS_PS0; 194 195 if (ACPI_SUCCESS(acpi_get_handle(handle, "_PS3", &tmp))) 196 newfunc->flags |= FUNC_HAS_PS3; 197 198 if (ACPI_SUCCESS(acpi_get_handle(handle, "_DCK", &tmp))) 199 newfunc->flags |= FUNC_HAS_DCK; 200 201 status = acpi_evaluate_integer(handle, "_SUN", NULL, &sun); 202 if (ACPI_FAILURE(status)) { 203 /* 204 * use the count of the number of slots we've found 205 * for the number of the slot 206 */ 207 sun = bridge->nr_slots+1; 208 } 209 210 /* search for objects that share the same slot */ 211 list_for_each_entry(slot, &bridge->slots, node) 212 if (slot->device == device) { 213 if (slot->sun != sun) 214 warn("sibling found, but _SUN doesn't match!\n"); 215 found = 1; 216 break; 217 } 218 219 if (!found) { 220 slot = kzalloc(sizeof(struct acpiphp_slot), GFP_KERNEL); 221 if (!slot) { 222 kfree(newfunc); 223 return AE_NO_MEMORY; 224 } 225 226 slot->bridge = bridge; 227 slot->device = device; 228 slot->sun = sun; 229 INIT_LIST_HEAD(&slot->funcs); 230 mutex_init(&slot->crit_sect); 231 232 list_add_tail(&slot->node, &bridge->slots); 233 bridge->nr_slots++; 234 235 dbg("found ACPI PCI Hotplug slot %llu at PCI %04x:%02x:%02x\n", 236 slot->sun, pci_domain_nr(pbus), pbus->number, device); 237 retval = acpiphp_register_hotplug_slot(slot); 238 if (retval) { 239 if (retval == -EBUSY) 240 warn("Slot %llu already registered by another " 241 "hotplug driver\n", slot->sun); 242 else 243 warn("acpiphp_register_hotplug_slot failed " 244 "(err code = 0x%x)\n", retval); 245 goto err_exit; 246 } 247 } 248 249 newfunc->slot = slot; 250 list_add_tail(&newfunc->sibling, &slot->funcs); 251 252 if (pci_bus_read_dev_vendor_id(pbus, PCI_DEVFN(device, function), 253 &val, 60*1000)) 254 slot->flags |= (SLOT_ENABLED | SLOT_POWEREDON); 255 256 if (is_dock_device(handle)) { 257 /* we don't want to call this device's _EJ0 258 * because we want the dock notify handler 259 * to call it after it calls _DCK 260 */ 261 newfunc->flags &= ~FUNC_HAS_EJ0; 262 if (register_hotplug_dock_device(handle, 263 &acpiphp_dock_ops, newfunc)) 264 dbg("failed to register dock device\n"); 265 266 /* we need to be notified when dock events happen 267 * outside of the hotplug operation, since we may 268 * need to do fixups before we can hotplug. 269 */ 270 newfunc->nb.notifier_call = post_dock_fixups; 271 if (register_dock_notifier(&newfunc->nb)) 272 dbg("failed to register a dock notifier"); 273 } 274 275 /* install notify handler */ 276 if (!(newfunc->flags & FUNC_HAS_DCK)) { 277 status = acpi_install_notify_handler(handle, 278 ACPI_SYSTEM_NOTIFY, 279 handle_hotplug_event_func, 280 newfunc); 281 282 if (ACPI_FAILURE(status)) 283 err("failed to register interrupt notify handler\n"); 284 } else 285 status = AE_OK; 286 287 return status; 288 289 err_exit: 290 bridge->nr_slots--; 291 list_del(&slot->node); 292 kfree(slot); 293 kfree(newfunc); 294 295 return AE_OK; 296 } 297 298 299 /* see if it's worth looking at this bridge */ 300 static int detect_ejectable_slots(acpi_handle handle) 301 { 302 int found = acpi_pci_detect_ejectable(handle); 303 if (!found) { 304 acpi_walk_namespace(ACPI_TYPE_DEVICE, handle, (u32)1, 305 is_pci_dock_device, NULL, (void *)&found, NULL); 306 } 307 return found; 308 } 309 310 /* initialize miscellaneous stuff for both root and PCI-to-PCI bridge */ 311 static void init_bridge_misc(struct acpiphp_bridge *bridge) 312 { 313 acpi_status status; 314 315 /* must be added to the list prior to calling register_slot */ 316 list_add(&bridge->list, &bridge_list); 317 318 /* register all slot objects under this bridge */ 319 status = acpi_walk_namespace(ACPI_TYPE_DEVICE, bridge->handle, (u32)1, 320 register_slot, NULL, bridge, NULL); 321 if (ACPI_FAILURE(status)) { 322 list_del(&bridge->list); 323 return; 324 } 325 326 /* install notify handler for P2P bridges */ 327 if (!pci_is_root_bus(bridge->pci_bus)) { 328 if ((bridge->flags & BRIDGE_HAS_EJ0) && bridge->func) { 329 status = acpi_remove_notify_handler(bridge->func->handle, 330 ACPI_SYSTEM_NOTIFY, 331 handle_hotplug_event_func); 332 if (ACPI_FAILURE(status)) 333 err("failed to remove notify handler\n"); 334 } 335 status = acpi_install_notify_handler(bridge->handle, 336 ACPI_SYSTEM_NOTIFY, 337 handle_hotplug_event_bridge, 338 bridge); 339 340 if (ACPI_FAILURE(status)) { 341 err("failed to register interrupt notify handler\n"); 342 } 343 } 344 } 345 346 347 /* find acpiphp_func from acpiphp_bridge */ 348 static struct acpiphp_func *acpiphp_bridge_handle_to_function(acpi_handle handle) 349 { 350 struct acpiphp_bridge *bridge; 351 struct acpiphp_slot *slot; 352 struct acpiphp_func *func; 353 354 list_for_each_entry(bridge, &bridge_list, list) { 355 list_for_each_entry(slot, &bridge->slots, node) { 356 list_for_each_entry(func, &slot->funcs, sibling) { 357 if (func->handle == handle) 358 return func; 359 } 360 } 361 } 362 363 return NULL; 364 } 365 366 367 static struct acpiphp_bridge *acpiphp_handle_to_bridge(acpi_handle handle) 368 { 369 struct acpiphp_bridge *bridge; 370 371 list_for_each_entry(bridge, &bridge_list, list) 372 if (bridge->handle == handle) 373 return bridge; 374 375 return NULL; 376 } 377 378 static void cleanup_bridge(struct acpiphp_bridge *bridge) 379 { 380 struct acpiphp_slot *slot, *next; 381 struct acpiphp_func *func, *tmp; 382 acpi_status status; 383 acpi_handle handle = bridge->handle; 384 385 if (!pci_is_root_bus(bridge->pci_bus)) { 386 status = acpi_remove_notify_handler(handle, 387 ACPI_SYSTEM_NOTIFY, 388 handle_hotplug_event_bridge); 389 if (ACPI_FAILURE(status)) 390 err("failed to remove notify handler\n"); 391 } 392 393 if ((bridge->flags & BRIDGE_HAS_EJ0) && bridge->func) { 394 status = acpi_install_notify_handler(bridge->func->handle, 395 ACPI_SYSTEM_NOTIFY, 396 handle_hotplug_event_func, 397 bridge->func); 398 if (ACPI_FAILURE(status)) 399 err("failed to install interrupt notify handler\n"); 400 } 401 402 list_for_each_entry_safe(slot, next, &bridge->slots, node) { 403 list_for_each_entry_safe(func, tmp, &slot->funcs, sibling) { 404 if (is_dock_device(func->handle)) { 405 unregister_hotplug_dock_device(func->handle); 406 unregister_dock_notifier(&func->nb); 407 } 408 if (!(func->flags & FUNC_HAS_DCK)) { 409 status = acpi_remove_notify_handler(func->handle, 410 ACPI_SYSTEM_NOTIFY, 411 handle_hotplug_event_func); 412 if (ACPI_FAILURE(status)) 413 err("failed to remove notify handler\n"); 414 } 415 list_del(&func->sibling); 416 kfree(func); 417 } 418 acpiphp_unregister_hotplug_slot(slot); 419 list_del(&slot->funcs); 420 kfree(slot); 421 } 422 423 put_device(&bridge->pci_bus->dev); 424 pci_dev_put(bridge->pci_dev); 425 list_del(&bridge->list); 426 kfree(bridge); 427 } 428 429 static int power_on_slot(struct acpiphp_slot *slot) 430 { 431 acpi_status status; 432 struct acpiphp_func *func; 433 int retval = 0; 434 435 /* if already enabled, just skip */ 436 if (slot->flags & SLOT_POWEREDON) 437 goto err_exit; 438 439 list_for_each_entry(func, &slot->funcs, sibling) { 440 if (func->flags & FUNC_HAS_PS0) { 441 dbg("%s: executing _PS0\n", __func__); 442 status = acpi_evaluate_object(func->handle, "_PS0", NULL, NULL); 443 if (ACPI_FAILURE(status)) { 444 warn("%s: _PS0 failed\n", __func__); 445 retval = -1; 446 goto err_exit; 447 } else 448 break; 449 } 450 } 451 452 /* TBD: evaluate _STA to check if the slot is enabled */ 453 454 slot->flags |= SLOT_POWEREDON; 455 456 err_exit: 457 return retval; 458 } 459 460 461 static int power_off_slot(struct acpiphp_slot *slot) 462 { 463 acpi_status status; 464 struct acpiphp_func *func; 465 466 int retval = 0; 467 468 /* if already disabled, just skip */ 469 if ((slot->flags & SLOT_POWEREDON) == 0) 470 goto err_exit; 471 472 list_for_each_entry(func, &slot->funcs, sibling) { 473 if (func->flags & FUNC_HAS_PS3) { 474 status = acpi_evaluate_object(func->handle, "_PS3", NULL, NULL); 475 if (ACPI_FAILURE(status)) { 476 warn("%s: _PS3 failed\n", __func__); 477 retval = -1; 478 goto err_exit; 479 } else 480 break; 481 } 482 } 483 484 /* TBD: evaluate _STA to check if the slot is disabled */ 485 486 slot->flags &= (~SLOT_POWEREDON); 487 488 err_exit: 489 return retval; 490 } 491 492 493 494 /** 495 * acpiphp_max_busnr - return the highest reserved bus number under the given bus. 496 * @bus: bus to start search with 497 */ 498 static unsigned char acpiphp_max_busnr(struct pci_bus *bus) 499 { 500 struct list_head *tmp; 501 unsigned char max, n; 502 503 /* 504 * pci_bus_max_busnr will return the highest 505 * reserved busnr for all these children. 506 * that is equivalent to the bus->subordinate 507 * value. We don't want to use the parent's 508 * bus->subordinate value because it could have 509 * padding in it. 510 */ 511 max = bus->busn_res.start; 512 513 list_for_each(tmp, &bus->children) { 514 n = pci_bus_max_busnr(pci_bus_b(tmp)); 515 if (n > max) 516 max = n; 517 } 518 return max; 519 } 520 521 522 /** 523 * acpiphp_bus_add - add a new bus to acpi subsystem 524 * @func: acpiphp_func of the bridge 525 */ 526 static int acpiphp_bus_add(struct acpiphp_func *func) 527 { 528 struct acpi_device *device; 529 int ret_val; 530 531 if (!acpi_bus_get_device(func->handle, &device)) { 532 dbg("bus exists... trim\n"); 533 /* this shouldn't be in here, so remove 534 * the bus then re-add it... 535 */ 536 acpi_bus_trim(device); 537 } 538 539 ret_val = acpi_bus_scan(func->handle); 540 if (!ret_val) 541 ret_val = acpi_bus_get_device(func->handle, &device); 542 543 if (ret_val) 544 dbg("error adding bus, %x\n", -ret_val); 545 546 return ret_val; 547 } 548 549 550 /** 551 * acpiphp_bus_trim - trim a bus from acpi subsystem 552 * @handle: handle to acpi namespace 553 */ 554 static int acpiphp_bus_trim(acpi_handle handle) 555 { 556 struct acpi_device *device; 557 int retval; 558 559 retval = acpi_bus_get_device(handle, &device); 560 if (retval) { 561 dbg("acpi_device not found\n"); 562 return retval; 563 } 564 565 acpi_bus_trim(device); 566 return 0; 567 } 568 569 static void acpiphp_set_acpi_region(struct acpiphp_slot *slot) 570 { 571 struct acpiphp_func *func; 572 union acpi_object params[2]; 573 struct acpi_object_list arg_list; 574 575 list_for_each_entry(func, &slot->funcs, sibling) { 576 arg_list.count = 2; 577 arg_list.pointer = params; 578 params[0].type = ACPI_TYPE_INTEGER; 579 params[0].integer.value = ACPI_ADR_SPACE_PCI_CONFIG; 580 params[1].type = ACPI_TYPE_INTEGER; 581 params[1].integer.value = 1; 582 /* _REG is optional, we don't care about if there is failure */ 583 acpi_evaluate_object(func->handle, "_REG", &arg_list, NULL); 584 } 585 } 586 587 static void check_hotplug_bridge(struct acpiphp_slot *slot, struct pci_dev *dev) 588 { 589 struct acpiphp_func *func; 590 591 if (!dev->subordinate) 592 return; 593 594 /* quirk, or pcie could set it already */ 595 if (dev->is_hotplug_bridge) 596 return; 597 598 if (PCI_SLOT(dev->devfn) != slot->device) 599 return; 600 601 list_for_each_entry(func, &slot->funcs, sibling) { 602 if (PCI_FUNC(dev->devfn) == func->function) { 603 /* check if this bridge has ejectable slots */ 604 if ((detect_ejectable_slots(func->handle) > 0)) 605 dev->is_hotplug_bridge = 1; 606 break; 607 } 608 } 609 } 610 611 /** 612 * enable_device - enable, configure a slot 613 * @slot: slot to be enabled 614 * 615 * This function should be called per *physical slot*, 616 * not per each slot object in ACPI namespace. 617 */ 618 static int __ref enable_device(struct acpiphp_slot *slot) 619 { 620 struct pci_dev *dev; 621 struct pci_bus *bus = slot->bridge->pci_bus; 622 struct acpiphp_func *func; 623 int retval = 0; 624 int num, max, pass; 625 626 if (slot->flags & SLOT_ENABLED) 627 goto err_exit; 628 629 list_for_each_entry(func, &slot->funcs, sibling) 630 acpiphp_bus_add(func); 631 632 num = pci_scan_slot(bus, PCI_DEVFN(slot->device, 0)); 633 if (num == 0) { 634 /* Maybe only part of funcs are added. */ 635 dbg("No new device found\n"); 636 goto err_exit; 637 } 638 639 max = acpiphp_max_busnr(bus); 640 for (pass = 0; pass < 2; pass++) { 641 list_for_each_entry(dev, &bus->devices, bus_list) { 642 if (PCI_SLOT(dev->devfn) != slot->device) 643 continue; 644 if (dev->hdr_type == PCI_HEADER_TYPE_BRIDGE || 645 dev->hdr_type == PCI_HEADER_TYPE_CARDBUS) { 646 max = pci_scan_bridge(bus, dev, max, pass); 647 if (pass && dev->subordinate) { 648 check_hotplug_bridge(slot, dev); 649 pci_bus_size_bridges(dev->subordinate); 650 } 651 } 652 } 653 } 654 655 pci_bus_assign_resources(bus); 656 acpiphp_sanitize_bus(bus); 657 acpiphp_set_hpp_values(bus); 658 acpiphp_set_acpi_region(slot); 659 pci_enable_bridges(bus); 660 661 list_for_each_entry(dev, &bus->devices, bus_list) { 662 /* Assume that newly added devices are powered on already. */ 663 if (!dev->is_added) 664 dev->current_state = PCI_D0; 665 } 666 667 pci_bus_add_devices(bus); 668 669 slot->flags |= SLOT_ENABLED; 670 list_for_each_entry(func, &slot->funcs, sibling) { 671 dev = pci_get_slot(bus, PCI_DEVFN(slot->device, 672 func->function)); 673 if (!dev) { 674 /* Do not set SLOT_ENABLED flag if some funcs 675 are not added. */ 676 slot->flags &= (~SLOT_ENABLED); 677 continue; 678 } 679 } 680 681 682 err_exit: 683 return retval; 684 } 685 686 /* return first device in slot, acquiring a reference on it */ 687 static struct pci_dev *dev_in_slot(struct acpiphp_slot *slot) 688 { 689 struct pci_bus *bus = slot->bridge->pci_bus; 690 struct pci_dev *dev; 691 struct pci_dev *ret = NULL; 692 693 down_read(&pci_bus_sem); 694 list_for_each_entry(dev, &bus->devices, bus_list) 695 if (PCI_SLOT(dev->devfn) == slot->device) { 696 ret = pci_dev_get(dev); 697 break; 698 } 699 up_read(&pci_bus_sem); 700 701 return ret; 702 } 703 704 /** 705 * disable_device - disable a slot 706 * @slot: ACPI PHP slot 707 */ 708 static int disable_device(struct acpiphp_slot *slot) 709 { 710 struct acpiphp_func *func; 711 struct pci_dev *pdev; 712 713 /* 714 * enable_device() enumerates all functions in this device via 715 * pci_scan_slot(), whether they have associated ACPI hotplug 716 * methods (_EJ0, etc.) or not. Therefore, we remove all functions 717 * here. 718 */ 719 while ((pdev = dev_in_slot(slot))) { 720 pci_stop_and_remove_bus_device(pdev); 721 pci_dev_put(pdev); 722 } 723 724 list_for_each_entry(func, &slot->funcs, sibling) { 725 acpiphp_bus_trim(func->handle); 726 } 727 728 slot->flags &= (~SLOT_ENABLED); 729 730 return 0; 731 } 732 733 734 /** 735 * get_slot_status - get ACPI slot status 736 * @slot: ACPI PHP slot 737 * 738 * If a slot has _STA for each function and if any one of them 739 * returned non-zero status, return it. 740 * 741 * If a slot doesn't have _STA and if any one of its functions' 742 * configuration space is configured, return 0x0f as a _STA. 743 * 744 * Otherwise return 0. 745 */ 746 static unsigned int get_slot_status(struct acpiphp_slot *slot) 747 { 748 acpi_status status; 749 unsigned long long sta = 0; 750 u32 dvid; 751 struct acpiphp_func *func; 752 753 list_for_each_entry(func, &slot->funcs, sibling) { 754 if (func->flags & FUNC_HAS_STA) { 755 status = acpi_evaluate_integer(func->handle, "_STA", NULL, &sta); 756 if (ACPI_SUCCESS(status) && sta) 757 break; 758 } else { 759 pci_bus_read_config_dword(slot->bridge->pci_bus, 760 PCI_DEVFN(slot->device, 761 func->function), 762 PCI_VENDOR_ID, &dvid); 763 if (dvid != 0xffffffff) { 764 sta = ACPI_STA_ALL; 765 break; 766 } 767 } 768 } 769 770 return (unsigned int)sta; 771 } 772 773 /** 774 * acpiphp_eject_slot - physically eject the slot 775 * @slot: ACPI PHP slot 776 */ 777 int acpiphp_eject_slot(struct acpiphp_slot *slot) 778 { 779 acpi_status status; 780 struct acpiphp_func *func; 781 struct acpi_object_list arg_list; 782 union acpi_object arg; 783 784 list_for_each_entry(func, &slot->funcs, sibling) { 785 /* We don't want to call _EJ0 on non-existing functions. */ 786 if ((func->flags & FUNC_HAS_EJ0)) { 787 /* _EJ0 method take one argument */ 788 arg_list.count = 1; 789 arg_list.pointer = &arg; 790 arg.type = ACPI_TYPE_INTEGER; 791 arg.integer.value = 1; 792 793 status = acpi_evaluate_object(func->handle, "_EJ0", &arg_list, NULL); 794 if (ACPI_FAILURE(status)) { 795 warn("%s: _EJ0 failed\n", __func__); 796 return -1; 797 } else 798 break; 799 } 800 } 801 return 0; 802 } 803 804 /** 805 * acpiphp_check_bridge - re-enumerate devices 806 * @bridge: where to begin re-enumeration 807 * 808 * Iterate over all slots under this bridge and make sure that if a 809 * card is present they are enabled, and if not they are disabled. 810 */ 811 static int acpiphp_check_bridge(struct acpiphp_bridge *bridge) 812 { 813 struct acpiphp_slot *slot; 814 int retval = 0; 815 int enabled, disabled; 816 817 enabled = disabled = 0; 818 819 list_for_each_entry(slot, &bridge->slots, node) { 820 unsigned int status = get_slot_status(slot); 821 if (slot->flags & SLOT_ENABLED) { 822 if (status == ACPI_STA_ALL) 823 continue; 824 retval = acpiphp_disable_slot(slot); 825 if (retval) { 826 err("Error occurred in disabling\n"); 827 goto err_exit; 828 } else { 829 acpiphp_eject_slot(slot); 830 } 831 disabled++; 832 } else { 833 if (status != ACPI_STA_ALL) 834 continue; 835 retval = acpiphp_enable_slot(slot); 836 if (retval) { 837 err("Error occurred in enabling\n"); 838 goto err_exit; 839 } 840 enabled++; 841 } 842 } 843 844 dbg("%s: %d enabled, %d disabled\n", __func__, enabled, disabled); 845 846 err_exit: 847 return retval; 848 } 849 850 static void acpiphp_set_hpp_values(struct pci_bus *bus) 851 { 852 struct pci_dev *dev; 853 854 list_for_each_entry(dev, &bus->devices, bus_list) 855 pci_configure_slot(dev); 856 } 857 858 /* 859 * Remove devices for which we could not assign resources, call 860 * arch specific code to fix-up the bus 861 */ 862 static void acpiphp_sanitize_bus(struct pci_bus *bus) 863 { 864 struct pci_dev *dev, *tmp; 865 int i; 866 unsigned long type_mask = IORESOURCE_IO | IORESOURCE_MEM; 867 868 list_for_each_entry_safe(dev, tmp, &bus->devices, bus_list) { 869 for (i=0; i<PCI_BRIDGE_RESOURCES; i++) { 870 struct resource *res = &dev->resource[i]; 871 if ((res->flags & type_mask) && !res->start && 872 res->end) { 873 /* Could not assign a required resources 874 * for this device, remove it */ 875 pci_stop_and_remove_bus_device(dev); 876 break; 877 } 878 } 879 } 880 } 881 882 /* 883 * ACPI event handlers 884 */ 885 886 static acpi_status 887 check_sub_bridges(acpi_handle handle, u32 lvl, void *context, void **rv) 888 { 889 struct acpiphp_bridge *bridge; 890 char objname[64]; 891 struct acpi_buffer buffer = { .length = sizeof(objname), 892 .pointer = objname }; 893 894 bridge = acpiphp_handle_to_bridge(handle); 895 if (bridge) { 896 acpi_get_name(handle, ACPI_FULL_PATHNAME, &buffer); 897 dbg("%s: re-enumerating slots under %s\n", 898 __func__, objname); 899 acpiphp_check_bridge(bridge); 900 } 901 return AE_OK ; 902 } 903 904 static void _handle_hotplug_event_bridge(struct work_struct *work) 905 { 906 struct acpiphp_bridge *bridge; 907 char objname[64]; 908 struct acpi_buffer buffer = { .length = sizeof(objname), 909 .pointer = objname }; 910 struct acpi_hp_work *hp_work; 911 acpi_handle handle; 912 u32 type; 913 914 hp_work = container_of(work, struct acpi_hp_work, work); 915 handle = hp_work->handle; 916 type = hp_work->type; 917 bridge = (struct acpiphp_bridge *)hp_work->context; 918 919 acpi_scan_lock_acquire(); 920 921 acpi_get_name(handle, ACPI_FULL_PATHNAME, &buffer); 922 923 switch (type) { 924 case ACPI_NOTIFY_BUS_CHECK: 925 /* bus re-enumerate */ 926 dbg("%s: Bus check notify on %s\n", __func__, objname); 927 dbg("%s: re-enumerating slots under %s\n", __func__, objname); 928 acpiphp_check_bridge(bridge); 929 acpi_walk_namespace(ACPI_TYPE_DEVICE, handle, 930 ACPI_UINT32_MAX, check_sub_bridges, NULL, NULL, NULL); 931 break; 932 933 case ACPI_NOTIFY_DEVICE_CHECK: 934 /* device check */ 935 dbg("%s: Device check notify on %s\n", __func__, objname); 936 acpiphp_check_bridge(bridge); 937 break; 938 939 case ACPI_NOTIFY_DEVICE_WAKE: 940 /* wake event */ 941 dbg("%s: Device wake notify on %s\n", __func__, objname); 942 break; 943 944 case ACPI_NOTIFY_EJECT_REQUEST: 945 /* request device eject */ 946 dbg("%s: Device eject notify on %s\n", __func__, objname); 947 if ((bridge->flags & BRIDGE_HAS_EJ0) && bridge->func) { 948 struct acpiphp_slot *slot; 949 slot = bridge->func->slot; 950 if (!acpiphp_disable_slot(slot)) 951 acpiphp_eject_slot(slot); 952 } 953 break; 954 955 case ACPI_NOTIFY_FREQUENCY_MISMATCH: 956 printk(KERN_ERR "Device %s cannot be configured due" 957 " to a frequency mismatch\n", objname); 958 break; 959 960 case ACPI_NOTIFY_BUS_MODE_MISMATCH: 961 printk(KERN_ERR "Device %s cannot be configured due" 962 " to a bus mode mismatch\n", objname); 963 break; 964 965 case ACPI_NOTIFY_POWER_FAULT: 966 printk(KERN_ERR "Device %s has suffered a power fault\n", 967 objname); 968 break; 969 970 default: 971 warn("notify_handler: unknown event type 0x%x for %s\n", type, objname); 972 break; 973 } 974 975 acpi_scan_lock_release(); 976 kfree(hp_work); /* allocated in handle_hotplug_event_bridge */ 977 } 978 979 /** 980 * handle_hotplug_event_bridge - handle ACPI event on bridges 981 * @handle: Notify()'ed acpi_handle 982 * @type: Notify code 983 * @context: pointer to acpiphp_bridge structure 984 * 985 * Handles ACPI event notification on {host,p2p} bridges. 986 */ 987 static void handle_hotplug_event_bridge(acpi_handle handle, u32 type, 988 void *context) 989 { 990 /* 991 * Currently the code adds all hotplug events to the kacpid_wq 992 * queue when it should add hotplug events to the kacpi_hotplug_wq. 993 * The proper way to fix this is to reorganize the code so that 994 * drivers (dock, etc.) do not call acpi_os_execute(), etc. 995 * For now just re-add this work to the kacpi_hotplug_wq so we 996 * don't deadlock on hotplug actions. 997 */ 998 alloc_acpi_hp_work(handle, type, context, _handle_hotplug_event_bridge); 999 } 1000 1001 static void _handle_hotplug_event_func(struct work_struct *work) 1002 { 1003 struct acpiphp_func *func; 1004 char objname[64]; 1005 struct acpi_buffer buffer = { .length = sizeof(objname), 1006 .pointer = objname }; 1007 struct acpi_hp_work *hp_work; 1008 acpi_handle handle; 1009 u32 type; 1010 1011 hp_work = container_of(work, struct acpi_hp_work, work); 1012 handle = hp_work->handle; 1013 type = hp_work->type; 1014 func = (struct acpiphp_func *)hp_work->context; 1015 1016 acpi_scan_lock_acquire(); 1017 1018 acpi_get_name(handle, ACPI_FULL_PATHNAME, &buffer); 1019 1020 switch (type) { 1021 case ACPI_NOTIFY_BUS_CHECK: 1022 /* bus re-enumerate */ 1023 dbg("%s: Bus check notify on %s\n", __func__, objname); 1024 acpiphp_enable_slot(func->slot); 1025 break; 1026 1027 case ACPI_NOTIFY_DEVICE_CHECK: 1028 /* device check : re-enumerate from parent bus */ 1029 dbg("%s: Device check notify on %s\n", __func__, objname); 1030 acpiphp_check_bridge(func->slot->bridge); 1031 break; 1032 1033 case ACPI_NOTIFY_DEVICE_WAKE: 1034 /* wake event */ 1035 dbg("%s: Device wake notify on %s\n", __func__, objname); 1036 break; 1037 1038 case ACPI_NOTIFY_EJECT_REQUEST: 1039 /* request device eject */ 1040 dbg("%s: Device eject notify on %s\n", __func__, objname); 1041 if (!(acpiphp_disable_slot(func->slot))) 1042 acpiphp_eject_slot(func->slot); 1043 break; 1044 1045 default: 1046 warn("notify_handler: unknown event type 0x%x for %s\n", type, objname); 1047 break; 1048 } 1049 1050 acpi_scan_lock_release(); 1051 kfree(hp_work); /* allocated in handle_hotplug_event_func */ 1052 } 1053 1054 /** 1055 * handle_hotplug_event_func - handle ACPI event on functions (i.e. slots) 1056 * @handle: Notify()'ed acpi_handle 1057 * @type: Notify code 1058 * @context: pointer to acpiphp_func structure 1059 * 1060 * Handles ACPI event notification on slots. 1061 */ 1062 static void handle_hotplug_event_func(acpi_handle handle, u32 type, 1063 void *context) 1064 { 1065 /* 1066 * Currently the code adds all hotplug events to the kacpid_wq 1067 * queue when it should add hotplug events to the kacpi_hotplug_wq. 1068 * The proper way to fix this is to reorganize the code so that 1069 * drivers (dock, etc.) do not call acpi_os_execute(), etc. 1070 * For now just re-add this work to the kacpi_hotplug_wq so we 1071 * don't deadlock on hotplug actions. 1072 */ 1073 alloc_acpi_hp_work(handle, type, context, _handle_hotplug_event_func); 1074 } 1075 1076 /* 1077 * Create hotplug slots for the PCI bus. 1078 * It should always return 0 to avoid skipping following notifiers. 1079 */ 1080 void acpiphp_enumerate_slots(struct pci_bus *bus, acpi_handle handle) 1081 { 1082 acpi_handle dummy_handle; 1083 struct acpiphp_bridge *bridge; 1084 1085 if (acpiphp_disabled) 1086 return; 1087 1088 if (detect_ejectable_slots(handle) <= 0) 1089 return; 1090 1091 bridge = kzalloc(sizeof(struct acpiphp_bridge), GFP_KERNEL); 1092 if (bridge == NULL) { 1093 err("out of memory\n"); 1094 return; 1095 } 1096 1097 INIT_LIST_HEAD(&bridge->slots); 1098 bridge->handle = handle; 1099 bridge->pci_dev = pci_dev_get(bus->self); 1100 bridge->pci_bus = bus; 1101 1102 /* 1103 * Grab a ref to the subordinate PCI bus in case the bus is 1104 * removed via PCI core logical hotplug. The ref pins the bus 1105 * (which we access during module unload). 1106 */ 1107 get_device(&bus->dev); 1108 1109 if (!pci_is_root_bus(bridge->pci_bus) && 1110 ACPI_SUCCESS(acpi_get_handle(bridge->handle, 1111 "_EJ0", &dummy_handle))) { 1112 dbg("found ejectable p2p bridge\n"); 1113 bridge->flags |= BRIDGE_HAS_EJ0; 1114 bridge->func = acpiphp_bridge_handle_to_function(handle); 1115 } 1116 1117 init_bridge_misc(bridge); 1118 } 1119 1120 /* Destroy hotplug slots associated with the PCI bus */ 1121 void acpiphp_remove_slots(struct pci_bus *bus) 1122 { 1123 struct acpiphp_bridge *bridge, *tmp; 1124 1125 if (acpiphp_disabled) 1126 return; 1127 1128 list_for_each_entry_safe(bridge, tmp, &bridge_list, list) 1129 if (bridge->pci_bus == bus) { 1130 cleanup_bridge(bridge); 1131 break; 1132 } 1133 } 1134 1135 /** 1136 * acpiphp_enable_slot - power on slot 1137 * @slot: ACPI PHP slot 1138 */ 1139 int acpiphp_enable_slot(struct acpiphp_slot *slot) 1140 { 1141 int retval; 1142 1143 mutex_lock(&slot->crit_sect); 1144 1145 /* wake up all functions */ 1146 retval = power_on_slot(slot); 1147 if (retval) 1148 goto err_exit; 1149 1150 if (get_slot_status(slot) == ACPI_STA_ALL) { 1151 /* configure all functions */ 1152 retval = enable_device(slot); 1153 if (retval) 1154 power_off_slot(slot); 1155 } else { 1156 dbg("%s: Slot status is not ACPI_STA_ALL\n", __func__); 1157 power_off_slot(slot); 1158 } 1159 1160 err_exit: 1161 mutex_unlock(&slot->crit_sect); 1162 return retval; 1163 } 1164 1165 /** 1166 * acpiphp_disable_slot - power off slot 1167 * @slot: ACPI PHP slot 1168 */ 1169 int acpiphp_disable_slot(struct acpiphp_slot *slot) 1170 { 1171 int retval = 0; 1172 1173 mutex_lock(&slot->crit_sect); 1174 1175 /* unconfigure all functions */ 1176 retval = disable_device(slot); 1177 if (retval) 1178 goto err_exit; 1179 1180 /* power off all functions */ 1181 retval = power_off_slot(slot); 1182 if (retval) 1183 goto err_exit; 1184 1185 err_exit: 1186 mutex_unlock(&slot->crit_sect); 1187 return retval; 1188 } 1189 1190 1191 /* 1192 * slot enabled: 1 1193 * slot disabled: 0 1194 */ 1195 u8 acpiphp_get_power_status(struct acpiphp_slot *slot) 1196 { 1197 return (slot->flags & SLOT_POWEREDON); 1198 } 1199 1200 1201 /* 1202 * latch open: 1 1203 * latch closed: 0 1204 */ 1205 u8 acpiphp_get_latch_status(struct acpiphp_slot *slot) 1206 { 1207 unsigned int sta; 1208 1209 sta = get_slot_status(slot); 1210 1211 return (sta & ACPI_STA_DEVICE_UI) ? 0 : 1; 1212 } 1213 1214 1215 /* 1216 * adapter presence : 1 1217 * absence : 0 1218 */ 1219 u8 acpiphp_get_adapter_status(struct acpiphp_slot *slot) 1220 { 1221 unsigned int sta; 1222 1223 sta = get_slot_status(slot); 1224 1225 return (sta == 0) ? 0 : 1; 1226 } 1227