Loading...
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
56static LIST_HEAD(bridge_list);
57
58#define MY_NAME "acpiphp_glue"
59
60static void handle_hotplug_event_bridge (acpi_handle, u32, void *);
61static void acpiphp_sanitize_bus(struct pci_bus *bus);
62static void acpiphp_set_hpp_values(struct pci_bus *bus);
63static 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 */
66static acpi_status
67is_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 */
86static 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->secondary) {
104 buses = (buses & 0xff000000)
105 | ((unsigned int)(bus->primary) << 0)
106 | ((unsigned int)(bus->secondary) << 8)
107 | ((unsigned int)(bus->subordinate) << 16);
108 pci_write_config_dword(bus->self, PCI_PRIMARY_BUS, buses);
109 }
110 return NOTIFY_OK;
111}
112
113
114static const struct acpi_dock_ops acpiphp_dock_ops = {
115 .handler = handle_hotplug_event_func,
116};
117
118/* callback routine to register each ACPI PCI slot object */
119static acpi_status
120register_slot(acpi_handle handle, u32 lvl, void *context, void **rv)
121{
122 struct acpiphp_bridge *bridge = (struct acpiphp_bridge *)context;
123 struct acpiphp_slot *slot;
124 struct acpiphp_func *newfunc;
125 acpi_handle tmp;
126 acpi_status status = AE_OK;
127 unsigned long long adr, sun;
128 int device, function, retval;
129 struct pci_bus *pbus = bridge->pci_bus;
130 struct pci_dev *pdev;
131
132 if (!acpi_pci_check_ejectable(pbus, handle) && !is_dock_device(handle))
133 return AE_OK;
134
135 pdev = pbus->self;
136 if (pdev && pci_is_pcie(pdev)) {
137 tmp = acpi_find_root_bridge_handle(pdev);
138 if (tmp) {
139 struct acpi_pci_root *root = acpi_pci_find_root(tmp);
140
141 if (root && (root->osc_control_set &
142 OSC_PCI_EXPRESS_NATIVE_HP_CONTROL))
143 return AE_OK;
144 }
145 }
146
147 acpi_evaluate_integer(handle, "_ADR", NULL, &adr);
148 device = (adr >> 16) & 0xffff;
149 function = adr & 0xffff;
150
151 newfunc = kzalloc(sizeof(struct acpiphp_func), GFP_KERNEL);
152 if (!newfunc)
153 return AE_NO_MEMORY;
154
155 INIT_LIST_HEAD(&newfunc->sibling);
156 newfunc->handle = handle;
157 newfunc->function = function;
158
159 if (ACPI_SUCCESS(acpi_get_handle(handle, "_EJ0", &tmp)))
160 newfunc->flags = FUNC_HAS_EJ0;
161
162 if (ACPI_SUCCESS(acpi_get_handle(handle, "_STA", &tmp)))
163 newfunc->flags |= FUNC_HAS_STA;
164
165 if (ACPI_SUCCESS(acpi_get_handle(handle, "_PS0", &tmp)))
166 newfunc->flags |= FUNC_HAS_PS0;
167
168 if (ACPI_SUCCESS(acpi_get_handle(handle, "_PS3", &tmp)))
169 newfunc->flags |= FUNC_HAS_PS3;
170
171 if (ACPI_SUCCESS(acpi_get_handle(handle, "_DCK", &tmp)))
172 newfunc->flags |= FUNC_HAS_DCK;
173
174 status = acpi_evaluate_integer(handle, "_SUN", NULL, &sun);
175 if (ACPI_FAILURE(status)) {
176 /*
177 * use the count of the number of slots we've found
178 * for the number of the slot
179 */
180 sun = bridge->nr_slots+1;
181 }
182
183 /* search for objects that share the same slot */
184 for (slot = bridge->slots; slot; slot = slot->next)
185 if (slot->device == device) {
186 if (slot->sun != sun)
187 warn("sibling found, but _SUN doesn't match!\n");
188 break;
189 }
190
191 if (!slot) {
192 slot = kzalloc(sizeof(struct acpiphp_slot), GFP_KERNEL);
193 if (!slot) {
194 kfree(newfunc);
195 return AE_NO_MEMORY;
196 }
197
198 slot->bridge = bridge;
199 slot->device = device;
200 slot->sun = sun;
201 INIT_LIST_HEAD(&slot->funcs);
202 mutex_init(&slot->crit_sect);
203
204 slot->next = bridge->slots;
205 bridge->slots = slot;
206
207 bridge->nr_slots++;
208
209 dbg("found ACPI PCI Hotplug slot %llu at PCI %04x:%02x:%02x\n",
210 slot->sun, pci_domain_nr(pbus), pbus->number, device);
211 retval = acpiphp_register_hotplug_slot(slot);
212 if (retval) {
213 if (retval == -EBUSY)
214 warn("Slot %llu already registered by another "
215 "hotplug driver\n", slot->sun);
216 else
217 warn("acpiphp_register_hotplug_slot failed "
218 "(err code = 0x%x)\n", retval);
219 goto err_exit;
220 }
221 }
222
223 newfunc->slot = slot;
224 list_add_tail(&newfunc->sibling, &slot->funcs);
225
226 pdev = pci_get_slot(pbus, PCI_DEVFN(device, function));
227 if (pdev) {
228 slot->flags |= (SLOT_ENABLED | SLOT_POWEREDON);
229 pci_dev_put(pdev);
230 }
231
232 if (is_dock_device(handle)) {
233 /* we don't want to call this device's _EJ0
234 * because we want the dock notify handler
235 * to call it after it calls _DCK
236 */
237 newfunc->flags &= ~FUNC_HAS_EJ0;
238 if (register_hotplug_dock_device(handle,
239 &acpiphp_dock_ops, newfunc))
240 dbg("failed to register dock device\n");
241
242 /* we need to be notified when dock events happen
243 * outside of the hotplug operation, since we may
244 * need to do fixups before we can hotplug.
245 */
246 newfunc->nb.notifier_call = post_dock_fixups;
247 if (register_dock_notifier(&newfunc->nb))
248 dbg("failed to register a dock notifier");
249 }
250
251 /* install notify handler */
252 if (!(newfunc->flags & FUNC_HAS_DCK)) {
253 status = acpi_install_notify_handler(handle,
254 ACPI_SYSTEM_NOTIFY,
255 handle_hotplug_event_func,
256 newfunc);
257
258 if (ACPI_FAILURE(status))
259 err("failed to register interrupt notify handler\n");
260 } else
261 status = AE_OK;
262
263 return status;
264
265 err_exit:
266 bridge->nr_slots--;
267 bridge->slots = slot->next;
268 kfree(slot);
269 kfree(newfunc);
270
271 return AE_OK;
272}
273
274
275/* see if it's worth looking at this bridge */
276static int detect_ejectable_slots(acpi_handle handle)
277{
278 int found = acpi_pci_detect_ejectable(handle);
279 if (!found) {
280 acpi_walk_namespace(ACPI_TYPE_DEVICE, handle, (u32)1,
281 is_pci_dock_device, NULL, (void *)&found, NULL);
282 }
283 return found;
284}
285
286/* initialize miscellaneous stuff for both root and PCI-to-PCI bridge */
287static void init_bridge_misc(struct acpiphp_bridge *bridge)
288{
289 acpi_status status;
290
291 /* must be added to the list prior to calling register_slot */
292 list_add(&bridge->list, &bridge_list);
293
294 /* register all slot objects under this bridge */
295 status = acpi_walk_namespace(ACPI_TYPE_DEVICE, bridge->handle, (u32)1,
296 register_slot, NULL, bridge, NULL);
297 if (ACPI_FAILURE(status)) {
298 list_del(&bridge->list);
299 return;
300 }
301
302 /* install notify handler */
303 if (bridge->type != BRIDGE_TYPE_HOST) {
304 if ((bridge->flags & BRIDGE_HAS_EJ0) && bridge->func) {
305 status = acpi_remove_notify_handler(bridge->func->handle,
306 ACPI_SYSTEM_NOTIFY,
307 handle_hotplug_event_func);
308 if (ACPI_FAILURE(status))
309 err("failed to remove notify handler\n");
310 }
311 status = acpi_install_notify_handler(bridge->handle,
312 ACPI_SYSTEM_NOTIFY,
313 handle_hotplug_event_bridge,
314 bridge);
315
316 if (ACPI_FAILURE(status)) {
317 err("failed to register interrupt notify handler\n");
318 }
319 }
320}
321
322
323/* find acpiphp_func from acpiphp_bridge */
324static struct acpiphp_func *acpiphp_bridge_handle_to_function(acpi_handle handle)
325{
326 struct acpiphp_bridge *bridge;
327 struct acpiphp_slot *slot;
328 struct acpiphp_func *func;
329
330 list_for_each_entry(bridge, &bridge_list, list) {
331 for (slot = bridge->slots; slot; slot = slot->next) {
332 list_for_each_entry(func, &slot->funcs, sibling) {
333 if (func->handle == handle)
334 return func;
335 }
336 }
337 }
338
339 return NULL;
340}
341
342
343static inline void config_p2p_bridge_flags(struct acpiphp_bridge *bridge)
344{
345 acpi_handle dummy_handle;
346
347 if (ACPI_SUCCESS(acpi_get_handle(bridge->handle,
348 "_STA", &dummy_handle)))
349 bridge->flags |= BRIDGE_HAS_STA;
350
351 if (ACPI_SUCCESS(acpi_get_handle(bridge->handle,
352 "_EJ0", &dummy_handle)))
353 bridge->flags |= BRIDGE_HAS_EJ0;
354
355 if (ACPI_SUCCESS(acpi_get_handle(bridge->handle,
356 "_PS0", &dummy_handle)))
357 bridge->flags |= BRIDGE_HAS_PS0;
358
359 if (ACPI_SUCCESS(acpi_get_handle(bridge->handle,
360 "_PS3", &dummy_handle)))
361 bridge->flags |= BRIDGE_HAS_PS3;
362
363 /* is this ejectable p2p bridge? */
364 if (bridge->flags & BRIDGE_HAS_EJ0) {
365 struct acpiphp_func *func;
366
367 dbg("found ejectable p2p bridge\n");
368
369 /* make link between PCI bridge and PCI function */
370 func = acpiphp_bridge_handle_to_function(bridge->handle);
371 if (!func)
372 return;
373 bridge->func = func;
374 func->bridge = bridge;
375 }
376}
377
378
379/* allocate and initialize host bridge data structure */
380static void add_host_bridge(acpi_handle *handle)
381{
382 struct acpiphp_bridge *bridge;
383 struct acpi_pci_root *root = acpi_pci_find_root(handle);
384
385 bridge = kzalloc(sizeof(struct acpiphp_bridge), GFP_KERNEL);
386 if (bridge == NULL)
387 return;
388
389 bridge->type = BRIDGE_TYPE_HOST;
390 bridge->handle = handle;
391
392 bridge->pci_bus = root->bus;
393
394 spin_lock_init(&bridge->res_lock);
395
396 init_bridge_misc(bridge);
397}
398
399
400/* allocate and initialize PCI-to-PCI bridge data structure */
401static void add_p2p_bridge(acpi_handle *handle)
402{
403 struct acpiphp_bridge *bridge;
404
405 bridge = kzalloc(sizeof(struct acpiphp_bridge), GFP_KERNEL);
406 if (bridge == NULL) {
407 err("out of memory\n");
408 return;
409 }
410
411 bridge->type = BRIDGE_TYPE_P2P;
412 bridge->handle = handle;
413 config_p2p_bridge_flags(bridge);
414
415 bridge->pci_dev = acpi_get_pci_dev(handle);
416 bridge->pci_bus = bridge->pci_dev->subordinate;
417 if (!bridge->pci_bus) {
418 err("This is not a PCI-to-PCI bridge!\n");
419 goto err;
420 }
421
422 /*
423 * Grab a ref to the subordinate PCI bus in case the bus is
424 * removed via PCI core logical hotplug. The ref pins the bus
425 * (which we access during module unload).
426 */
427 get_device(&bridge->pci_bus->dev);
428 spin_lock_init(&bridge->res_lock);
429
430 init_bridge_misc(bridge);
431 return;
432 err:
433 pci_dev_put(bridge->pci_dev);
434 kfree(bridge);
435 return;
436}
437
438
439/* callback routine to find P2P bridges */
440static acpi_status
441find_p2p_bridge(acpi_handle handle, u32 lvl, void *context, void **rv)
442{
443 acpi_status status;
444 struct pci_dev *dev;
445
446 dev = acpi_get_pci_dev(handle);
447 if (!dev || !dev->subordinate)
448 goto out;
449
450 /* check if this bridge has ejectable slots */
451 if ((detect_ejectable_slots(handle) > 0)) {
452 dbg("found PCI-to-PCI bridge at PCI %s\n", pci_name(dev));
453 add_p2p_bridge(handle);
454 }
455
456 /* search P2P bridges under this p2p bridge */
457 status = acpi_walk_namespace(ACPI_TYPE_DEVICE, handle, (u32)1,
458 find_p2p_bridge, NULL, NULL, NULL);
459 if (ACPI_FAILURE(status))
460 warn("find_p2p_bridge failed (error code = 0x%x)\n", status);
461
462 out:
463 pci_dev_put(dev);
464 return AE_OK;
465}
466
467
468/* find hot-pluggable slots, and then find P2P bridge */
469static int add_bridge(acpi_handle handle)
470{
471 acpi_status status;
472 unsigned long long tmp;
473 acpi_handle dummy_handle;
474
475 /* if the bridge doesn't have _STA, we assume it is always there */
476 status = acpi_get_handle(handle, "_STA", &dummy_handle);
477 if (ACPI_SUCCESS(status)) {
478 status = acpi_evaluate_integer(handle, "_STA", NULL, &tmp);
479 if (ACPI_FAILURE(status)) {
480 dbg("%s: _STA evaluation failure\n", __func__);
481 return 0;
482 }
483 if ((tmp & ACPI_STA_FUNCTIONING) == 0)
484 /* don't register this object */
485 return 0;
486 }
487
488 /* check if this bridge has ejectable slots */
489 if (detect_ejectable_slots(handle) > 0) {
490 dbg("found PCI host-bus bridge with hot-pluggable slots\n");
491 add_host_bridge(handle);
492 }
493
494 /* search P2P bridges under this host bridge */
495 status = acpi_walk_namespace(ACPI_TYPE_DEVICE, handle, (u32)1,
496 find_p2p_bridge, NULL, NULL, NULL);
497
498 if (ACPI_FAILURE(status))
499 warn("find_p2p_bridge failed (error code = 0x%x)\n", status);
500
501 return 0;
502}
503
504static struct acpiphp_bridge *acpiphp_handle_to_bridge(acpi_handle handle)
505{
506 struct acpiphp_bridge *bridge;
507
508 list_for_each_entry(bridge, &bridge_list, list)
509 if (bridge->handle == handle)
510 return bridge;
511
512 return NULL;
513}
514
515static void cleanup_bridge(struct acpiphp_bridge *bridge)
516{
517 struct acpiphp_slot *slot, *next;
518 struct acpiphp_func *func, *tmp;
519 acpi_status status;
520 acpi_handle handle = bridge->handle;
521
522 status = acpi_remove_notify_handler(handle, ACPI_SYSTEM_NOTIFY,
523 handle_hotplug_event_bridge);
524 if (ACPI_FAILURE(status))
525 err("failed to remove notify handler\n");
526
527 if ((bridge->type != BRIDGE_TYPE_HOST) &&
528 ((bridge->flags & BRIDGE_HAS_EJ0) && bridge->func)) {
529 status = acpi_install_notify_handler(bridge->func->handle,
530 ACPI_SYSTEM_NOTIFY,
531 handle_hotplug_event_func,
532 bridge->func);
533 if (ACPI_FAILURE(status))
534 err("failed to install interrupt notify handler\n");
535 }
536
537 slot = bridge->slots;
538 while (slot) {
539 next = slot->next;
540 list_for_each_entry_safe(func, tmp, &slot->funcs, sibling) {
541 if (is_dock_device(func->handle)) {
542 unregister_hotplug_dock_device(func->handle);
543 unregister_dock_notifier(&func->nb);
544 }
545 if (!(func->flags & FUNC_HAS_DCK)) {
546 status = acpi_remove_notify_handler(func->handle,
547 ACPI_SYSTEM_NOTIFY,
548 handle_hotplug_event_func);
549 if (ACPI_FAILURE(status))
550 err("failed to remove notify handler\n");
551 }
552 list_del(&func->sibling);
553 kfree(func);
554 }
555 acpiphp_unregister_hotplug_slot(slot);
556 list_del(&slot->funcs);
557 kfree(slot);
558 slot = next;
559 }
560
561 /*
562 * Only P2P bridges have a pci_dev
563 */
564 if (bridge->pci_dev)
565 put_device(&bridge->pci_bus->dev);
566
567 pci_dev_put(bridge->pci_dev);
568 list_del(&bridge->list);
569 kfree(bridge);
570}
571
572static acpi_status
573cleanup_p2p_bridge(acpi_handle handle, u32 lvl, void *context, void **rv)
574{
575 struct acpiphp_bridge *bridge;
576
577 /* cleanup p2p bridges under this P2P bridge
578 in a depth-first manner */
579 acpi_walk_namespace(ACPI_TYPE_DEVICE, handle, (u32)1,
580 cleanup_p2p_bridge, NULL, NULL, NULL);
581
582 bridge = acpiphp_handle_to_bridge(handle);
583 if (bridge)
584 cleanup_bridge(bridge);
585
586 return AE_OK;
587}
588
589static void remove_bridge(acpi_handle handle)
590{
591 struct acpiphp_bridge *bridge;
592
593 /* cleanup p2p bridges under this host bridge
594 in a depth-first manner */
595 acpi_walk_namespace(ACPI_TYPE_DEVICE, handle,
596 (u32)1, cleanup_p2p_bridge, NULL, NULL, NULL);
597
598 /*
599 * On root bridges with hotplug slots directly underneath (ie,
600 * no p2p bridge between), we call cleanup_bridge().
601 *
602 * The else clause cleans up root bridges that either had no
603 * hotplug slots at all, or had a p2p bridge underneath.
604 */
605 bridge = acpiphp_handle_to_bridge(handle);
606 if (bridge)
607 cleanup_bridge(bridge);
608 else
609 acpi_remove_notify_handler(handle, ACPI_SYSTEM_NOTIFY,
610 handle_hotplug_event_bridge);
611}
612
613static int power_on_slot(struct acpiphp_slot *slot)
614{
615 acpi_status status;
616 struct acpiphp_func *func;
617 int retval = 0;
618
619 /* if already enabled, just skip */
620 if (slot->flags & SLOT_POWEREDON)
621 goto err_exit;
622
623 list_for_each_entry(func, &slot->funcs, sibling) {
624 if (func->flags & FUNC_HAS_PS0) {
625 dbg("%s: executing _PS0\n", __func__);
626 status = acpi_evaluate_object(func->handle, "_PS0", NULL, NULL);
627 if (ACPI_FAILURE(status)) {
628 warn("%s: _PS0 failed\n", __func__);
629 retval = -1;
630 goto err_exit;
631 } else
632 break;
633 }
634 }
635
636 /* TBD: evaluate _STA to check if the slot is enabled */
637
638 slot->flags |= SLOT_POWEREDON;
639
640 err_exit:
641 return retval;
642}
643
644
645static int power_off_slot(struct acpiphp_slot *slot)
646{
647 acpi_status status;
648 struct acpiphp_func *func;
649
650 int retval = 0;
651
652 /* if already disabled, just skip */
653 if ((slot->flags & SLOT_POWEREDON) == 0)
654 goto err_exit;
655
656 list_for_each_entry(func, &slot->funcs, sibling) {
657 if (func->flags & FUNC_HAS_PS3) {
658 status = acpi_evaluate_object(func->handle, "_PS3", NULL, NULL);
659 if (ACPI_FAILURE(status)) {
660 warn("%s: _PS3 failed\n", __func__);
661 retval = -1;
662 goto err_exit;
663 } else
664 break;
665 }
666 }
667
668 /* TBD: evaluate _STA to check if the slot is disabled */
669
670 slot->flags &= (~SLOT_POWEREDON);
671
672 err_exit:
673 return retval;
674}
675
676
677
678/**
679 * acpiphp_max_busnr - return the highest reserved bus number under the given bus.
680 * @bus: bus to start search with
681 */
682static unsigned char acpiphp_max_busnr(struct pci_bus *bus)
683{
684 struct list_head *tmp;
685 unsigned char max, n;
686
687 /*
688 * pci_bus_max_busnr will return the highest
689 * reserved busnr for all these children.
690 * that is equivalent to the bus->subordinate
691 * value. We don't want to use the parent's
692 * bus->subordinate value because it could have
693 * padding in it.
694 */
695 max = bus->secondary;
696
697 list_for_each(tmp, &bus->children) {
698 n = pci_bus_max_busnr(pci_bus_b(tmp));
699 if (n > max)
700 max = n;
701 }
702 return max;
703}
704
705
706/**
707 * acpiphp_bus_add - add a new bus to acpi subsystem
708 * @func: acpiphp_func of the bridge
709 */
710static int acpiphp_bus_add(struct acpiphp_func *func)
711{
712 acpi_handle phandle;
713 struct acpi_device *device, *pdevice;
714 int ret_val;
715
716 acpi_get_parent(func->handle, &phandle);
717 if (acpi_bus_get_device(phandle, &pdevice)) {
718 dbg("no parent device, assuming NULL\n");
719 pdevice = NULL;
720 }
721 if (!acpi_bus_get_device(func->handle, &device)) {
722 dbg("bus exists... trim\n");
723 /* this shouldn't be in here, so remove
724 * the bus then re-add it...
725 */
726 ret_val = acpi_bus_trim(device, 1);
727 dbg("acpi_bus_trim return %x\n", ret_val);
728 }
729
730 ret_val = acpi_bus_add(&device, pdevice, func->handle,
731 ACPI_BUS_TYPE_DEVICE);
732 if (ret_val) {
733 dbg("error adding bus, %x\n",
734 -ret_val);
735 goto acpiphp_bus_add_out;
736 }
737 ret_val = acpi_bus_start(device);
738
739acpiphp_bus_add_out:
740 return ret_val;
741}
742
743
744/**
745 * acpiphp_bus_trim - trim a bus from acpi subsystem
746 * @handle: handle to acpi namespace
747 */
748static int acpiphp_bus_trim(acpi_handle handle)
749{
750 struct acpi_device *device;
751 int retval;
752
753 retval = acpi_bus_get_device(handle, &device);
754 if (retval) {
755 dbg("acpi_device not found\n");
756 return retval;
757 }
758
759 retval = acpi_bus_trim(device, 1);
760 if (retval)
761 err("cannot remove from acpi list\n");
762
763 return retval;
764}
765
766static void acpiphp_set_acpi_region(struct acpiphp_slot *slot)
767{
768 struct acpiphp_func *func;
769 union acpi_object params[2];
770 struct acpi_object_list arg_list;
771
772 list_for_each_entry(func, &slot->funcs, sibling) {
773 arg_list.count = 2;
774 arg_list.pointer = params;
775 params[0].type = ACPI_TYPE_INTEGER;
776 params[0].integer.value = ACPI_ADR_SPACE_PCI_CONFIG;
777 params[1].type = ACPI_TYPE_INTEGER;
778 params[1].integer.value = 1;
779 /* _REG is optional, we don't care about if there is failure */
780 acpi_evaluate_object(func->handle, "_REG", &arg_list, NULL);
781 }
782}
783
784/**
785 * enable_device - enable, configure a slot
786 * @slot: slot to be enabled
787 *
788 * This function should be called per *physical slot*,
789 * not per each slot object in ACPI namespace.
790 */
791static int __ref enable_device(struct acpiphp_slot *slot)
792{
793 struct pci_dev *dev;
794 struct pci_bus *bus = slot->bridge->pci_bus;
795 struct acpiphp_func *func;
796 int retval = 0;
797 int num, max, pass;
798 acpi_status status;
799
800 if (slot->flags & SLOT_ENABLED)
801 goto err_exit;
802
803 num = pci_scan_slot(bus, PCI_DEVFN(slot->device, 0));
804 if (num == 0) {
805 /* Maybe only part of funcs are added. */
806 dbg("No new device found\n");
807 goto err_exit;
808 }
809
810 max = acpiphp_max_busnr(bus);
811 for (pass = 0; pass < 2; pass++) {
812 list_for_each_entry(dev, &bus->devices, bus_list) {
813 if (PCI_SLOT(dev->devfn) != slot->device)
814 continue;
815 if (dev->hdr_type == PCI_HEADER_TYPE_BRIDGE ||
816 dev->hdr_type == PCI_HEADER_TYPE_CARDBUS) {
817 max = pci_scan_bridge(bus, dev, max, pass);
818 if (pass && dev->subordinate)
819 pci_bus_size_bridges(dev->subordinate);
820 }
821 }
822 }
823
824 list_for_each_entry(func, &slot->funcs, sibling)
825 acpiphp_bus_add(func);
826
827 pci_bus_assign_resources(bus);
828 acpiphp_sanitize_bus(bus);
829 acpiphp_set_hpp_values(bus);
830 acpiphp_set_acpi_region(slot);
831 pci_enable_bridges(bus);
832
833 list_for_each_entry(dev, &bus->devices, bus_list) {
834 /* Assume that newly added devices are powered on already. */
835 if (!dev->is_added)
836 dev->current_state = PCI_D0;
837 }
838
839 pci_bus_add_devices(bus);
840
841 slot->flags |= SLOT_ENABLED;
842 list_for_each_entry(func, &slot->funcs, sibling) {
843 dev = pci_get_slot(bus, PCI_DEVFN(slot->device,
844 func->function));
845 if (!dev) {
846 /* Do not set SLOT_ENABLED flag if some funcs
847 are not added. */
848 slot->flags &= (~SLOT_ENABLED);
849 continue;
850 }
851
852 if (dev->hdr_type != PCI_HEADER_TYPE_BRIDGE &&
853 dev->hdr_type != PCI_HEADER_TYPE_CARDBUS) {
854 pci_dev_put(dev);
855 continue;
856 }
857
858 status = find_p2p_bridge(func->handle, (u32)1, bus, NULL);
859 if (ACPI_FAILURE(status))
860 warn("find_p2p_bridge failed (error code = 0x%x)\n",
861 status);
862 pci_dev_put(dev);
863 }
864
865
866 err_exit:
867 return retval;
868}
869
870static void disable_bridges(struct pci_bus *bus)
871{
872 struct pci_dev *dev;
873 list_for_each_entry(dev, &bus->devices, bus_list) {
874 if (dev->subordinate) {
875 disable_bridges(dev->subordinate);
876 pci_disable_device(dev);
877 }
878 }
879}
880
881/**
882 * disable_device - disable a slot
883 * @slot: ACPI PHP slot
884 */
885static int disable_device(struct acpiphp_slot *slot)
886{
887 struct acpiphp_func *func;
888 struct pci_dev *pdev;
889 struct pci_bus *bus = slot->bridge->pci_bus;
890
891 /* The slot will be enabled when func 0 is added, so check
892 func 0 before disable the slot. */
893 pdev = pci_get_slot(bus, PCI_DEVFN(slot->device, 0));
894 if (!pdev)
895 goto err_exit;
896
897 list_for_each_entry(func, &slot->funcs, sibling) {
898 if (func->bridge) {
899 /* cleanup p2p bridges under this P2P bridge */
900 cleanup_p2p_bridge(func->bridge->handle,
901 (u32)1, NULL, NULL);
902 func->bridge = NULL;
903 }
904
905 pdev = pci_get_slot(slot->bridge->pci_bus,
906 PCI_DEVFN(slot->device, func->function));
907 if (pdev) {
908 pci_stop_bus_device(pdev);
909 if (pdev->subordinate) {
910 disable_bridges(pdev->subordinate);
911 pci_disable_device(pdev);
912 }
913 __pci_remove_bus_device(pdev);
914 pci_dev_put(pdev);
915 }
916 }
917
918 list_for_each_entry(func, &slot->funcs, sibling) {
919 acpiphp_bus_trim(func->handle);
920 }
921
922 slot->flags &= (~SLOT_ENABLED);
923
924err_exit:
925 return 0;
926}
927
928
929/**
930 * get_slot_status - get ACPI slot status
931 * @slot: ACPI PHP slot
932 *
933 * If a slot has _STA for each function and if any one of them
934 * returned non-zero status, return it.
935 *
936 * If a slot doesn't have _STA and if any one of its functions'
937 * configuration space is configured, return 0x0f as a _STA.
938 *
939 * Otherwise return 0.
940 */
941static unsigned int get_slot_status(struct acpiphp_slot *slot)
942{
943 acpi_status status;
944 unsigned long long sta = 0;
945 u32 dvid;
946 struct acpiphp_func *func;
947
948 list_for_each_entry(func, &slot->funcs, sibling) {
949 if (func->flags & FUNC_HAS_STA) {
950 status = acpi_evaluate_integer(func->handle, "_STA", NULL, &sta);
951 if (ACPI_SUCCESS(status) && sta)
952 break;
953 } else {
954 pci_bus_read_config_dword(slot->bridge->pci_bus,
955 PCI_DEVFN(slot->device,
956 func->function),
957 PCI_VENDOR_ID, &dvid);
958 if (dvid != 0xffffffff) {
959 sta = ACPI_STA_ALL;
960 break;
961 }
962 }
963 }
964
965 return (unsigned int)sta;
966}
967
968/**
969 * acpiphp_eject_slot - physically eject the slot
970 * @slot: ACPI PHP slot
971 */
972int acpiphp_eject_slot(struct acpiphp_slot *slot)
973{
974 acpi_status status;
975 struct acpiphp_func *func;
976 struct acpi_object_list arg_list;
977 union acpi_object arg;
978
979 list_for_each_entry(func, &slot->funcs, sibling) {
980 /* We don't want to call _EJ0 on non-existing functions. */
981 if ((func->flags & FUNC_HAS_EJ0)) {
982 /* _EJ0 method take one argument */
983 arg_list.count = 1;
984 arg_list.pointer = &arg;
985 arg.type = ACPI_TYPE_INTEGER;
986 arg.integer.value = 1;
987
988 status = acpi_evaluate_object(func->handle, "_EJ0", &arg_list, NULL);
989 if (ACPI_FAILURE(status)) {
990 warn("%s: _EJ0 failed\n", __func__);
991 return -1;
992 } else
993 break;
994 }
995 }
996 return 0;
997}
998
999/**
1000 * acpiphp_check_bridge - re-enumerate devices
1001 * @bridge: where to begin re-enumeration
1002 *
1003 * Iterate over all slots under this bridge and make sure that if a
1004 * card is present they are enabled, and if not they are disabled.
1005 */
1006static int acpiphp_check_bridge(struct acpiphp_bridge *bridge)
1007{
1008 struct acpiphp_slot *slot;
1009 int retval = 0;
1010 int enabled, disabled;
1011
1012 enabled = disabled = 0;
1013
1014 for (slot = bridge->slots; slot; slot = slot->next) {
1015 unsigned int status = get_slot_status(slot);
1016 if (slot->flags & SLOT_ENABLED) {
1017 if (status == ACPI_STA_ALL)
1018 continue;
1019 retval = acpiphp_disable_slot(slot);
1020 if (retval) {
1021 err("Error occurred in disabling\n");
1022 goto err_exit;
1023 } else {
1024 acpiphp_eject_slot(slot);
1025 }
1026 disabled++;
1027 } else {
1028 if (status != ACPI_STA_ALL)
1029 continue;
1030 retval = acpiphp_enable_slot(slot);
1031 if (retval) {
1032 err("Error occurred in enabling\n");
1033 goto err_exit;
1034 }
1035 enabled++;
1036 }
1037 }
1038
1039 dbg("%s: %d enabled, %d disabled\n", __func__, enabled, disabled);
1040
1041 err_exit:
1042 return retval;
1043}
1044
1045static void acpiphp_set_hpp_values(struct pci_bus *bus)
1046{
1047 struct pci_dev *dev;
1048
1049 list_for_each_entry(dev, &bus->devices, bus_list)
1050 pci_configure_slot(dev);
1051}
1052
1053/*
1054 * Remove devices for which we could not assign resources, call
1055 * arch specific code to fix-up the bus
1056 */
1057static void acpiphp_sanitize_bus(struct pci_bus *bus)
1058{
1059 struct pci_dev *dev;
1060 int i;
1061 unsigned long type_mask = IORESOURCE_IO | IORESOURCE_MEM;
1062
1063 list_for_each_entry(dev, &bus->devices, bus_list) {
1064 for (i=0; i<PCI_BRIDGE_RESOURCES; i++) {
1065 struct resource *res = &dev->resource[i];
1066 if ((res->flags & type_mask) && !res->start &&
1067 res->end) {
1068 /* Could not assign a required resources
1069 * for this device, remove it */
1070 pci_stop_and_remove_bus_device(dev);
1071 break;
1072 }
1073 }
1074 }
1075}
1076
1077/* Program resources in newly inserted bridge */
1078static int acpiphp_configure_bridge (acpi_handle handle)
1079{
1080 struct pci_bus *bus;
1081
1082 if (acpi_is_root_bridge(handle)) {
1083 struct acpi_pci_root *root = acpi_pci_find_root(handle);
1084 bus = root->bus;
1085 } else {
1086 struct pci_dev *pdev = acpi_get_pci_dev(handle);
1087 bus = pdev->subordinate;
1088 pci_dev_put(pdev);
1089 }
1090
1091 pci_bus_size_bridges(bus);
1092 pci_bus_assign_resources(bus);
1093 acpiphp_sanitize_bus(bus);
1094 acpiphp_set_hpp_values(bus);
1095 pci_enable_bridges(bus);
1096 return 0;
1097}
1098
1099static void handle_bridge_insertion(acpi_handle handle, u32 type)
1100{
1101 struct acpi_device *device, *pdevice;
1102 acpi_handle phandle;
1103
1104 if ((type != ACPI_NOTIFY_BUS_CHECK) &&
1105 (type != ACPI_NOTIFY_DEVICE_CHECK)) {
1106 err("unexpected notification type %d\n", type);
1107 return;
1108 }
1109
1110 acpi_get_parent(handle, &phandle);
1111 if (acpi_bus_get_device(phandle, &pdevice)) {
1112 dbg("no parent device, assuming NULL\n");
1113 pdevice = NULL;
1114 }
1115 if (acpi_bus_add(&device, pdevice, handle, ACPI_BUS_TYPE_DEVICE)) {
1116 err("cannot add bridge to acpi list\n");
1117 return;
1118 }
1119 if (!acpiphp_configure_bridge(handle) &&
1120 !acpi_bus_start(device))
1121 add_bridge(handle);
1122 else
1123 err("cannot configure and start bridge\n");
1124
1125}
1126
1127/*
1128 * ACPI event handlers
1129 */
1130
1131static acpi_status
1132count_sub_bridges(acpi_handle handle, u32 lvl, void *context, void **rv)
1133{
1134 int *count = (int *)context;
1135 struct acpiphp_bridge *bridge;
1136
1137 bridge = acpiphp_handle_to_bridge(handle);
1138 if (bridge)
1139 (*count)++;
1140 return AE_OK ;
1141}
1142
1143static acpi_status
1144check_sub_bridges(acpi_handle handle, u32 lvl, void *context, void **rv)
1145{
1146 struct acpiphp_bridge *bridge;
1147 char objname[64];
1148 struct acpi_buffer buffer = { .length = sizeof(objname),
1149 .pointer = objname };
1150
1151 bridge = acpiphp_handle_to_bridge(handle);
1152 if (bridge) {
1153 acpi_get_name(handle, ACPI_FULL_PATHNAME, &buffer);
1154 dbg("%s: re-enumerating slots under %s\n",
1155 __func__, objname);
1156 acpiphp_check_bridge(bridge);
1157 }
1158 return AE_OK ;
1159}
1160
1161struct acpiphp_hp_work {
1162 struct work_struct work;
1163 acpi_handle handle;
1164 u32 type;
1165 void *context;
1166};
1167
1168static void alloc_acpiphp_hp_work(acpi_handle handle, u32 type,
1169 void *context,
1170 void (*func)(struct work_struct *work))
1171{
1172 struct acpiphp_hp_work *hp_work;
1173 int ret;
1174
1175 hp_work = kmalloc(sizeof(*hp_work), GFP_KERNEL);
1176 if (!hp_work)
1177 return;
1178
1179 hp_work->handle = handle;
1180 hp_work->type = type;
1181 hp_work->context = context;
1182
1183 INIT_WORK(&hp_work->work, func);
1184 ret = queue_work(kacpi_hotplug_wq, &hp_work->work);
1185 if (!ret)
1186 kfree(hp_work);
1187}
1188
1189static void _handle_hotplug_event_bridge(struct work_struct *work)
1190{
1191 struct acpiphp_bridge *bridge;
1192 char objname[64];
1193 struct acpi_buffer buffer = { .length = sizeof(objname),
1194 .pointer = objname };
1195 struct acpi_device *device;
1196 int num_sub_bridges = 0;
1197 struct acpiphp_hp_work *hp_work;
1198 acpi_handle handle;
1199 u32 type;
1200
1201 hp_work = container_of(work, struct acpiphp_hp_work, work);
1202 handle = hp_work->handle;
1203 type = hp_work->type;
1204
1205 if (acpi_bus_get_device(handle, &device)) {
1206 /* This bridge must have just been physically inserted */
1207 handle_bridge_insertion(handle, type);
1208 goto out;
1209 }
1210
1211 bridge = acpiphp_handle_to_bridge(handle);
1212 if (type == ACPI_NOTIFY_BUS_CHECK) {
1213 acpi_walk_namespace(ACPI_TYPE_DEVICE, handle, ACPI_UINT32_MAX,
1214 count_sub_bridges, NULL, &num_sub_bridges, NULL);
1215 }
1216
1217 if (!bridge && !num_sub_bridges) {
1218 err("cannot get bridge info\n");
1219 goto out;
1220 }
1221
1222 acpi_get_name(handle, ACPI_FULL_PATHNAME, &buffer);
1223
1224 switch (type) {
1225 case ACPI_NOTIFY_BUS_CHECK:
1226 /* bus re-enumerate */
1227 dbg("%s: Bus check notify on %s\n", __func__, objname);
1228 if (bridge) {
1229 dbg("%s: re-enumerating slots under %s\n",
1230 __func__, objname);
1231 acpiphp_check_bridge(bridge);
1232 }
1233 if (num_sub_bridges)
1234 acpi_walk_namespace(ACPI_TYPE_DEVICE, handle,
1235 ACPI_UINT32_MAX, check_sub_bridges, NULL, NULL, NULL);
1236 break;
1237
1238 case ACPI_NOTIFY_DEVICE_CHECK:
1239 /* device check */
1240 dbg("%s: Device check notify on %s\n", __func__, objname);
1241 acpiphp_check_bridge(bridge);
1242 break;
1243
1244 case ACPI_NOTIFY_DEVICE_WAKE:
1245 /* wake event */
1246 dbg("%s: Device wake notify on %s\n", __func__, objname);
1247 break;
1248
1249 case ACPI_NOTIFY_EJECT_REQUEST:
1250 /* request device eject */
1251 dbg("%s: Device eject notify on %s\n", __func__, objname);
1252 if ((bridge->type != BRIDGE_TYPE_HOST) &&
1253 (bridge->flags & BRIDGE_HAS_EJ0)) {
1254 struct acpiphp_slot *slot;
1255 slot = bridge->func->slot;
1256 if (!acpiphp_disable_slot(slot))
1257 acpiphp_eject_slot(slot);
1258 }
1259 break;
1260
1261 case ACPI_NOTIFY_FREQUENCY_MISMATCH:
1262 printk(KERN_ERR "Device %s cannot be configured due"
1263 " to a frequency mismatch\n", objname);
1264 break;
1265
1266 case ACPI_NOTIFY_BUS_MODE_MISMATCH:
1267 printk(KERN_ERR "Device %s cannot be configured due"
1268 " to a bus mode mismatch\n", objname);
1269 break;
1270
1271 case ACPI_NOTIFY_POWER_FAULT:
1272 printk(KERN_ERR "Device %s has suffered a power fault\n",
1273 objname);
1274 break;
1275
1276 default:
1277 warn("notify_handler: unknown event type 0x%x for %s\n", type, objname);
1278 break;
1279 }
1280
1281out:
1282 kfree(hp_work); /* allocated in handle_hotplug_event_bridge */
1283}
1284
1285/**
1286 * handle_hotplug_event_bridge - handle ACPI event on bridges
1287 * @handle: Notify()'ed acpi_handle
1288 * @type: Notify code
1289 * @context: pointer to acpiphp_bridge structure
1290 *
1291 * Handles ACPI event notification on {host,p2p} bridges.
1292 */
1293static void handle_hotplug_event_bridge(acpi_handle handle, u32 type,
1294 void *context)
1295{
1296 /*
1297 * Currently the code adds all hotplug events to the kacpid_wq
1298 * queue when it should add hotplug events to the kacpi_hotplug_wq.
1299 * The proper way to fix this is to reorganize the code so that
1300 * drivers (dock, etc.) do not call acpi_os_execute(), etc.
1301 * For now just re-add this work to the kacpi_hotplug_wq so we
1302 * don't deadlock on hotplug actions.
1303 */
1304 alloc_acpiphp_hp_work(handle, type, context,
1305 _handle_hotplug_event_bridge);
1306}
1307
1308static void _handle_hotplug_event_func(struct work_struct *work)
1309{
1310 struct acpiphp_func *func;
1311 char objname[64];
1312 struct acpi_buffer buffer = { .length = sizeof(objname),
1313 .pointer = objname };
1314 struct acpiphp_hp_work *hp_work;
1315 acpi_handle handle;
1316 u32 type;
1317 void *context;
1318
1319 hp_work = container_of(work, struct acpiphp_hp_work, work);
1320 handle = hp_work->handle;
1321 type = hp_work->type;
1322 context = hp_work->context;
1323
1324 acpi_get_name(handle, ACPI_FULL_PATHNAME, &buffer);
1325
1326 func = (struct acpiphp_func *)context;
1327
1328 switch (type) {
1329 case ACPI_NOTIFY_BUS_CHECK:
1330 /* bus re-enumerate */
1331 dbg("%s: Bus check notify on %s\n", __func__, objname);
1332 acpiphp_enable_slot(func->slot);
1333 break;
1334
1335 case ACPI_NOTIFY_DEVICE_CHECK:
1336 /* device check : re-enumerate from parent bus */
1337 dbg("%s: Device check notify on %s\n", __func__, objname);
1338 acpiphp_check_bridge(func->slot->bridge);
1339 break;
1340
1341 case ACPI_NOTIFY_DEVICE_WAKE:
1342 /* wake event */
1343 dbg("%s: Device wake notify on %s\n", __func__, objname);
1344 break;
1345
1346 case ACPI_NOTIFY_EJECT_REQUEST:
1347 /* request device eject */
1348 dbg("%s: Device eject notify on %s\n", __func__, objname);
1349 if (!(acpiphp_disable_slot(func->slot)))
1350 acpiphp_eject_slot(func->slot);
1351 break;
1352
1353 default:
1354 warn("notify_handler: unknown event type 0x%x for %s\n", type, objname);
1355 break;
1356 }
1357
1358 kfree(hp_work); /* allocated in handle_hotplug_event_func */
1359}
1360
1361/**
1362 * handle_hotplug_event_func - handle ACPI event on functions (i.e. slots)
1363 * @handle: Notify()'ed acpi_handle
1364 * @type: Notify code
1365 * @context: pointer to acpiphp_func structure
1366 *
1367 * Handles ACPI event notification on slots.
1368 */
1369static void handle_hotplug_event_func(acpi_handle handle, u32 type,
1370 void *context)
1371{
1372 /*
1373 * Currently the code adds all hotplug events to the kacpid_wq
1374 * queue when it should add hotplug events to the kacpi_hotplug_wq.
1375 * The proper way to fix this is to reorganize the code so that
1376 * drivers (dock, etc.) do not call acpi_os_execute(), etc.
1377 * For now just re-add this work to the kacpi_hotplug_wq so we
1378 * don't deadlock on hotplug actions.
1379 */
1380 alloc_acpiphp_hp_work(handle, type, context,
1381 _handle_hotplug_event_func);
1382}
1383
1384static acpi_status
1385find_root_bridges(acpi_handle handle, u32 lvl, void *context, void **rv)
1386{
1387 int *count = (int *)context;
1388
1389 if (!acpi_is_root_bridge(handle))
1390 return AE_OK;
1391
1392 (*count)++;
1393 acpi_install_notify_handler(handle, ACPI_SYSTEM_NOTIFY,
1394 handle_hotplug_event_bridge, NULL);
1395
1396 return AE_OK ;
1397}
1398
1399static struct acpi_pci_driver acpi_pci_hp_driver = {
1400 .add = add_bridge,
1401 .remove = remove_bridge,
1402};
1403
1404/**
1405 * acpiphp_glue_init - initializes all PCI hotplug - ACPI glue data structures
1406 */
1407int __init acpiphp_glue_init(void)
1408{
1409 int num = 0;
1410
1411 acpi_walk_namespace(ACPI_TYPE_DEVICE, ACPI_ROOT_OBJECT,
1412 ACPI_UINT32_MAX, find_root_bridges, NULL, &num, NULL);
1413
1414 if (num <= 0)
1415 return -1;
1416 else
1417 acpi_pci_register_driver(&acpi_pci_hp_driver);
1418
1419 return 0;
1420}
1421
1422
1423/**
1424 * acpiphp_glue_exit - terminates all PCI hotplug - ACPI glue data structures
1425 *
1426 * This function frees all data allocated in acpiphp_glue_init().
1427 */
1428void acpiphp_glue_exit(void)
1429{
1430 acpi_pci_unregister_driver(&acpi_pci_hp_driver);
1431}
1432
1433
1434/**
1435 * acpiphp_get_num_slots - count number of slots in a system
1436 */
1437int __init acpiphp_get_num_slots(void)
1438{
1439 struct acpiphp_bridge *bridge;
1440 int num_slots = 0;
1441
1442 list_for_each_entry(bridge, &bridge_list, list) {
1443 dbg("Bus %04x:%02x has %d slot%s\n",
1444 pci_domain_nr(bridge->pci_bus),
1445 bridge->pci_bus->number, bridge->nr_slots,
1446 bridge->nr_slots == 1 ? "" : "s");
1447 num_slots += bridge->nr_slots;
1448 }
1449
1450 dbg("Total %d slots\n", num_slots);
1451 return num_slots;
1452}
1453
1454
1455#if 0
1456/**
1457 * acpiphp_for_each_slot - call function for each slot
1458 * @fn: callback function
1459 * @data: context to be passed to callback function
1460 */
1461static int acpiphp_for_each_slot(acpiphp_callback fn, void *data)
1462{
1463 struct list_head *node;
1464 struct acpiphp_bridge *bridge;
1465 struct acpiphp_slot *slot;
1466 int retval = 0;
1467
1468 list_for_each (node, &bridge_list) {
1469 bridge = (struct acpiphp_bridge *)node;
1470 for (slot = bridge->slots; slot; slot = slot->next) {
1471 retval = fn(slot, data);
1472 if (!retval)
1473 goto err_exit;
1474 }
1475 }
1476
1477 err_exit:
1478 return retval;
1479}
1480#endif
1481
1482
1483/**
1484 * acpiphp_enable_slot - power on slot
1485 * @slot: ACPI PHP slot
1486 */
1487int acpiphp_enable_slot(struct acpiphp_slot *slot)
1488{
1489 int retval;
1490
1491 mutex_lock(&slot->crit_sect);
1492
1493 /* wake up all functions */
1494 retval = power_on_slot(slot);
1495 if (retval)
1496 goto err_exit;
1497
1498 if (get_slot_status(slot) == ACPI_STA_ALL) {
1499 /* configure all functions */
1500 retval = enable_device(slot);
1501 if (retval)
1502 power_off_slot(slot);
1503 } else {
1504 dbg("%s: Slot status is not ACPI_STA_ALL\n", __func__);
1505 power_off_slot(slot);
1506 }
1507
1508 err_exit:
1509 mutex_unlock(&slot->crit_sect);
1510 return retval;
1511}
1512
1513/**
1514 * acpiphp_disable_slot - power off slot
1515 * @slot: ACPI PHP slot
1516 */
1517int acpiphp_disable_slot(struct acpiphp_slot *slot)
1518{
1519 int retval = 0;
1520
1521 mutex_lock(&slot->crit_sect);
1522
1523 /* unconfigure all functions */
1524 retval = disable_device(slot);
1525 if (retval)
1526 goto err_exit;
1527
1528 /* power off all functions */
1529 retval = power_off_slot(slot);
1530 if (retval)
1531 goto err_exit;
1532
1533 err_exit:
1534 mutex_unlock(&slot->crit_sect);
1535 return retval;
1536}
1537
1538
1539/*
1540 * slot enabled: 1
1541 * slot disabled: 0
1542 */
1543u8 acpiphp_get_power_status(struct acpiphp_slot *slot)
1544{
1545 return (slot->flags & SLOT_POWEREDON);
1546}
1547
1548
1549/*
1550 * latch open: 1
1551 * latch closed: 0
1552 */
1553u8 acpiphp_get_latch_status(struct acpiphp_slot *slot)
1554{
1555 unsigned int sta;
1556
1557 sta = get_slot_status(slot);
1558
1559 return (sta & ACPI_STA_SHOW_IN_UI) ? 0 : 1;
1560}
1561
1562
1563/*
1564 * adapter presence : 1
1565 * absence : 0
1566 */
1567u8 acpiphp_get_adapter_status(struct acpiphp_slot *slot)
1568{
1569 unsigned int sta;
1570
1571 sta = get_slot_status(slot);
1572
1573 return (sta == 0) ? 0 : 1;
1574}
1// SPDX-License-Identifier: GPL-2.0+
2/*
3 * ACPI PCI HotPlug glue functions to ACPI CA subsystem
4 *
5 * Copyright (C) 2002,2003 Takayoshi Kochi (t-kochi@bq.jp.nec.com)
6 * Copyright (C) 2002 Hiroshi Aono (h-aono@ap.jp.nec.com)
7 * Copyright (C) 2002,2003 NEC Corporation
8 * Copyright (C) 2003-2005 Matthew Wilcox (willy@infradead.org)
9 * Copyright (C) 2003-2005 Hewlett Packard
10 * Copyright (C) 2005 Rajesh Shah (rajesh.shah@intel.com)
11 * Copyright (C) 2005 Intel Corporation
12 *
13 * All rights reserved.
14 *
15 * Send feedback to <kristen.c.accardi@intel.com>
16 *
17 */
18
19/*
20 * Lifetime rules for pci_dev:
21 * - The one in acpiphp_bridge has its refcount elevated by pci_get_slot()
22 * when the bridge is scanned and it loses a refcount when the bridge
23 * is removed.
24 * - When a P2P bridge is present, we elevate the refcount on the subordinate
25 * bus. It loses the refcount when the driver unloads.
26 */
27
28#define pr_fmt(fmt) "acpiphp_glue: " fmt
29
30#include <linux/module.h>
31
32#include <linux/kernel.h>
33#include <linux/pci.h>
34#include <linux/pci_hotplug.h>
35#include <linux/pci-acpi.h>
36#include <linux/pm_runtime.h>
37#include <linux/mutex.h>
38#include <linux/slab.h>
39#include <linux/acpi.h>
40
41#include "../pci.h"
42#include "acpiphp.h"
43
44static LIST_HEAD(bridge_list);
45static DEFINE_MUTEX(bridge_mutex);
46
47static int acpiphp_hotplug_notify(struct acpi_device *adev, u32 type);
48static void acpiphp_post_dock_fixup(struct acpi_device *adev);
49static void acpiphp_sanitize_bus(struct pci_bus *bus);
50static void hotplug_event(u32 type, struct acpiphp_context *context);
51static void free_bridge(struct kref *kref);
52
53/**
54 * acpiphp_init_context - Create hotplug context and grab a reference to it.
55 * @adev: ACPI device object to create the context for.
56 *
57 * Call under acpi_hp_context_lock.
58 */
59static struct acpiphp_context *acpiphp_init_context(struct acpi_device *adev)
60{
61 struct acpiphp_context *context;
62
63 context = kzalloc(sizeof(*context), GFP_KERNEL);
64 if (!context)
65 return NULL;
66
67 context->refcount = 1;
68 context->hp.notify = acpiphp_hotplug_notify;
69 context->hp.fixup = acpiphp_post_dock_fixup;
70 acpi_set_hp_context(adev, &context->hp);
71 return context;
72}
73
74/**
75 * acpiphp_get_context - Get hotplug context and grab a reference to it.
76 * @adev: ACPI device object to get the context for.
77 *
78 * Call under acpi_hp_context_lock.
79 */
80static struct acpiphp_context *acpiphp_get_context(struct acpi_device *adev)
81{
82 struct acpiphp_context *context;
83
84 if (!adev->hp)
85 return NULL;
86
87 context = to_acpiphp_context(adev->hp);
88 context->refcount++;
89 return context;
90}
91
92/**
93 * acpiphp_put_context - Drop a reference to ACPI hotplug context.
94 * @context: ACPI hotplug context to drop a reference to.
95 *
96 * The context object is removed if there are no more references to it.
97 *
98 * Call under acpi_hp_context_lock.
99 */
100static void acpiphp_put_context(struct acpiphp_context *context)
101{
102 if (--context->refcount)
103 return;
104
105 WARN_ON(context->bridge);
106 context->hp.self->hp = NULL;
107 kfree(context);
108}
109
110static inline void get_bridge(struct acpiphp_bridge *bridge)
111{
112 kref_get(&bridge->ref);
113}
114
115static inline void put_bridge(struct acpiphp_bridge *bridge)
116{
117 kref_put(&bridge->ref, free_bridge);
118}
119
120static struct acpiphp_context *acpiphp_grab_context(struct acpi_device *adev)
121{
122 struct acpiphp_context *context;
123
124 acpi_lock_hp_context();
125
126 context = acpiphp_get_context(adev);
127 if (!context)
128 goto unlock;
129
130 if (context->func.parent->is_going_away) {
131 acpiphp_put_context(context);
132 context = NULL;
133 goto unlock;
134 }
135
136 get_bridge(context->func.parent);
137 acpiphp_put_context(context);
138
139unlock:
140 acpi_unlock_hp_context();
141 return context;
142}
143
144static void acpiphp_let_context_go(struct acpiphp_context *context)
145{
146 put_bridge(context->func.parent);
147}
148
149static void free_bridge(struct kref *kref)
150{
151 struct acpiphp_context *context;
152 struct acpiphp_bridge *bridge;
153 struct acpiphp_slot *slot, *next;
154 struct acpiphp_func *func, *tmp;
155
156 acpi_lock_hp_context();
157
158 bridge = container_of(kref, struct acpiphp_bridge, ref);
159
160 list_for_each_entry_safe(slot, next, &bridge->slots, node) {
161 list_for_each_entry_safe(func, tmp, &slot->funcs, sibling)
162 acpiphp_put_context(func_to_context(func));
163
164 kfree(slot);
165 }
166
167 context = bridge->context;
168 /* Root bridges will not have hotplug context. */
169 if (context) {
170 /* Release the reference taken by acpiphp_enumerate_slots(). */
171 put_bridge(context->func.parent);
172 context->bridge = NULL;
173 acpiphp_put_context(context);
174 }
175
176 put_device(&bridge->pci_bus->dev);
177 pci_dev_put(bridge->pci_dev);
178 kfree(bridge);
179
180 acpi_unlock_hp_context();
181}
182
183/**
184 * acpiphp_post_dock_fixup - Post-dock fixups for PCI devices.
185 * @adev: ACPI device object corresponding to a PCI device.
186 *
187 * TBD - figure out a way to only call fixups for systems that require them.
188 */
189static void acpiphp_post_dock_fixup(struct acpi_device *adev)
190{
191 struct acpiphp_context *context = acpiphp_grab_context(adev);
192 struct pci_bus *bus;
193 u32 buses;
194
195 if (!context)
196 return;
197
198 bus = context->func.slot->bus;
199 if (!bus->self)
200 goto out;
201
202 /* fixup bad _DCK function that rewrites
203 * secondary bridge on slot
204 */
205 pci_read_config_dword(bus->self, PCI_PRIMARY_BUS, &buses);
206
207 if (((buses >> 8) & 0xff) != bus->busn_res.start) {
208 buses = (buses & 0xff000000)
209 | ((unsigned int)(bus->primary) << 0)
210 | ((unsigned int)(bus->busn_res.start) << 8)
211 | ((unsigned int)(bus->busn_res.end) << 16);
212 pci_write_config_dword(bus->self, PCI_PRIMARY_BUS, buses);
213 }
214
215 out:
216 acpiphp_let_context_go(context);
217}
218
219/**
220 * acpiphp_add_context - Add ACPIPHP context to an ACPI device object.
221 * @handle: ACPI handle of the object to add a context to.
222 * @lvl: Not used.
223 * @data: The object's parent ACPIPHP bridge.
224 * @rv: Not used.
225 */
226static acpi_status acpiphp_add_context(acpi_handle handle, u32 lvl, void *data,
227 void **rv)
228{
229 struct acpi_device *adev = acpi_fetch_acpi_dev(handle);
230 struct acpiphp_bridge *bridge = data;
231 struct acpiphp_context *context;
232 struct acpiphp_slot *slot;
233 struct acpiphp_func *newfunc;
234 acpi_status status = AE_OK;
235 unsigned long long adr;
236 int device, function;
237 struct pci_bus *pbus = bridge->pci_bus;
238 struct pci_dev *pdev = bridge->pci_dev;
239 u32 val;
240
241 if (!adev)
242 return AE_OK;
243
244 status = acpi_evaluate_integer(handle, "_ADR", NULL, &adr);
245 if (ACPI_FAILURE(status)) {
246 if (status != AE_NOT_FOUND)
247 acpi_handle_warn(handle,
248 "can't evaluate _ADR (%#x)\n", status);
249 return AE_OK;
250 }
251
252 device = (adr >> 16) & 0xffff;
253 function = adr & 0xffff;
254
255 acpi_lock_hp_context();
256 context = acpiphp_init_context(adev);
257 if (!context) {
258 acpi_unlock_hp_context();
259 acpi_handle_err(handle, "No hotplug context\n");
260 return AE_NOT_EXIST;
261 }
262 newfunc = &context->func;
263 newfunc->function = function;
264 newfunc->parent = bridge;
265 acpi_unlock_hp_context();
266
267 /*
268 * If this is a dock device, its _EJ0 should be executed by the dock
269 * notify handler after calling _DCK.
270 */
271 if (!is_dock_device(adev) && acpi_has_method(handle, "_EJ0"))
272 newfunc->flags = FUNC_HAS_EJ0;
273
274 if (acpi_has_method(handle, "_STA"))
275 newfunc->flags |= FUNC_HAS_STA;
276
277 /* search for objects that share the same slot */
278 list_for_each_entry(slot, &bridge->slots, node)
279 if (slot->device == device)
280 goto slot_found;
281
282 slot = kzalloc(sizeof(struct acpiphp_slot), GFP_KERNEL);
283 if (!slot) {
284 acpi_lock_hp_context();
285 acpiphp_put_context(context);
286 acpi_unlock_hp_context();
287 return AE_NO_MEMORY;
288 }
289
290 slot->bus = bridge->pci_bus;
291 slot->device = device;
292 INIT_LIST_HEAD(&slot->funcs);
293
294 list_add_tail(&slot->node, &bridge->slots);
295
296 /*
297 * Expose slots to user space for functions that have _EJ0 or _RMV or
298 * are located in dock stations. Do not expose them for devices handled
299 * by the native PCIe hotplug (PCIeHP) or standard PCI hotplug
300 * (SHPCHP), because that code is supposed to expose slots to user
301 * space in those cases.
302 */
303 if ((acpi_pci_check_ejectable(pbus, handle) || is_dock_device(adev))
304 && !(pdev && hotplug_is_native(pdev))) {
305 unsigned long long sun;
306 int retval;
307
308 bridge->nr_slots++;
309 status = acpi_evaluate_integer(handle, "_SUN", NULL, &sun);
310 if (ACPI_FAILURE(status))
311 sun = bridge->nr_slots;
312
313 pr_debug("found ACPI PCI Hotplug slot %llu at PCI %04x:%02x:%02x\n",
314 sun, pci_domain_nr(pbus), pbus->number, device);
315
316 retval = acpiphp_register_hotplug_slot(slot, sun);
317 if (retval) {
318 slot->slot = NULL;
319 bridge->nr_slots--;
320 if (retval == -EBUSY)
321 pr_warn("Slot %llu already registered by another hotplug driver\n", sun);
322 else
323 pr_warn("acpiphp_register_hotplug_slot failed (err code = 0x%x)\n", retval);
324 }
325 /* Even if the slot registration fails, we can still use it. */
326 }
327
328 slot_found:
329 newfunc->slot = slot;
330 list_add_tail(&newfunc->sibling, &slot->funcs);
331
332 if (pci_bus_read_dev_vendor_id(pbus, PCI_DEVFN(device, function),
333 &val, 60*1000))
334 slot->flags |= SLOT_ENABLED;
335
336 return AE_OK;
337}
338
339static void cleanup_bridge(struct acpiphp_bridge *bridge)
340{
341 struct acpiphp_slot *slot;
342 struct acpiphp_func *func;
343
344 list_for_each_entry(slot, &bridge->slots, node) {
345 list_for_each_entry(func, &slot->funcs, sibling) {
346 struct acpi_device *adev = func_to_acpi_device(func);
347
348 acpi_lock_hp_context();
349 adev->hp->notify = NULL;
350 adev->hp->fixup = NULL;
351 acpi_unlock_hp_context();
352 }
353 slot->flags |= SLOT_IS_GOING_AWAY;
354 if (slot->slot)
355 acpiphp_unregister_hotplug_slot(slot);
356 }
357
358 mutex_lock(&bridge_mutex);
359 list_del(&bridge->list);
360 mutex_unlock(&bridge_mutex);
361
362 acpi_lock_hp_context();
363 bridge->is_going_away = true;
364 acpi_unlock_hp_context();
365}
366
367/**
368 * acpiphp_max_busnr - return the highest reserved bus number under the given bus.
369 * @bus: bus to start search with
370 */
371static unsigned char acpiphp_max_busnr(struct pci_bus *bus)
372{
373 struct pci_bus *tmp;
374 unsigned char max, n;
375
376 /*
377 * pci_bus_max_busnr will return the highest
378 * reserved busnr for all these children.
379 * that is equivalent to the bus->subordinate
380 * value. We don't want to use the parent's
381 * bus->subordinate value because it could have
382 * padding in it.
383 */
384 max = bus->busn_res.start;
385
386 list_for_each_entry(tmp, &bus->children, node) {
387 n = pci_bus_max_busnr(tmp);
388 if (n > max)
389 max = n;
390 }
391 return max;
392}
393
394static void acpiphp_set_acpi_region(struct acpiphp_slot *slot)
395{
396 struct acpiphp_func *func;
397
398 list_for_each_entry(func, &slot->funcs, sibling) {
399 /* _REG is optional, we don't care about if there is failure */
400 acpi_evaluate_reg(func_to_handle(func),
401 ACPI_ADR_SPACE_PCI_CONFIG,
402 ACPI_REG_CONNECT);
403 }
404}
405
406static void check_hotplug_bridge(struct acpiphp_slot *slot, struct pci_dev *dev)
407{
408 struct acpiphp_func *func;
409
410 /* quirk, or pcie could set it already */
411 if (dev->is_hotplug_bridge)
412 return;
413
414 /*
415 * In the PCIe case, only Root Ports and Downstream Ports are capable of
416 * accommodating hotplug devices, so avoid marking Upstream Ports as
417 * "hotplug bridges".
418 */
419 if (pci_is_pcie(dev) && pci_pcie_type(dev) == PCI_EXP_TYPE_UPSTREAM)
420 return;
421
422 list_for_each_entry(func, &slot->funcs, sibling) {
423 if (PCI_FUNC(dev->devfn) == func->function) {
424 dev->is_hotplug_bridge = 1;
425 break;
426 }
427 }
428}
429
430static int acpiphp_rescan_slot(struct acpiphp_slot *slot)
431{
432 struct acpiphp_func *func;
433
434 list_for_each_entry(func, &slot->funcs, sibling) {
435 struct acpi_device *adev = func_to_acpi_device(func);
436
437 acpi_bus_scan(adev->handle);
438 if (acpi_device_enumerated(adev))
439 acpi_device_set_power(adev, ACPI_STATE_D0);
440 }
441 return pci_scan_slot(slot->bus, PCI_DEVFN(slot->device, 0));
442}
443
444static void acpiphp_native_scan_bridge(struct pci_dev *bridge)
445{
446 struct pci_bus *bus = bridge->subordinate;
447 struct pci_dev *dev;
448 int max;
449
450 if (!bus)
451 return;
452
453 max = bus->busn_res.start;
454 /* Scan already configured non-hotplug bridges */
455 for_each_pci_bridge(dev, bus) {
456 if (!hotplug_is_native(dev))
457 max = pci_scan_bridge(bus, dev, max, 0);
458 }
459
460 /* Scan non-hotplug bridges that need to be reconfigured */
461 for_each_pci_bridge(dev, bus) {
462 if (hotplug_is_native(dev))
463 continue;
464
465 max = pci_scan_bridge(bus, dev, max, 1);
466 if (dev->subordinate) {
467 pcibios_resource_survey_bus(dev->subordinate);
468 pci_bus_size_bridges(dev->subordinate);
469 pci_bus_assign_resources(dev->subordinate);
470 }
471 }
472}
473
474/**
475 * enable_slot - enable, configure a slot
476 * @slot: slot to be enabled
477 * @bridge: true if enable is for the whole bridge (not a single slot)
478 *
479 * This function should be called per *physical slot*,
480 * not per each slot object in ACPI namespace.
481 */
482static void enable_slot(struct acpiphp_slot *slot, bool bridge)
483{
484 struct pci_dev *dev;
485 struct pci_bus *bus = slot->bus;
486 struct acpiphp_func *func;
487
488 if (bridge && bus->self && hotplug_is_native(bus->self)) {
489 /*
490 * If native hotplug is used, it will take care of hotplug
491 * slot management and resource allocation for hotplug
492 * bridges. However, ACPI hotplug may still be used for
493 * non-hotplug bridges to bring in additional devices such
494 * as a Thunderbolt host controller.
495 */
496 for_each_pci_bridge(dev, bus) {
497 if (PCI_SLOT(dev->devfn) == slot->device)
498 acpiphp_native_scan_bridge(dev);
499 }
500 } else {
501 LIST_HEAD(add_list);
502 int max, pass;
503
504 acpiphp_rescan_slot(slot);
505 max = acpiphp_max_busnr(bus);
506 for (pass = 0; pass < 2; pass++) {
507 for_each_pci_bridge(dev, bus) {
508 if (PCI_SLOT(dev->devfn) != slot->device)
509 continue;
510
511 max = pci_scan_bridge(bus, dev, max, pass);
512 if (pass && dev->subordinate) {
513 check_hotplug_bridge(slot, dev);
514 pcibios_resource_survey_bus(dev->subordinate);
515 __pci_bus_size_bridges(dev->subordinate,
516 &add_list);
517 }
518 }
519 }
520 __pci_bus_assign_resources(bus, &add_list, NULL);
521 }
522
523 acpiphp_sanitize_bus(bus);
524 pcie_bus_configure_settings(bus);
525 acpiphp_set_acpi_region(slot);
526
527 list_for_each_entry(dev, &bus->devices, bus_list) {
528 /* Assume that newly added devices are powered on already. */
529 if (!pci_dev_is_added(dev))
530 dev->current_state = PCI_D0;
531 }
532
533 pci_bus_add_devices(bus);
534
535 slot->flags |= SLOT_ENABLED;
536 list_for_each_entry(func, &slot->funcs, sibling) {
537 dev = pci_get_slot(bus, PCI_DEVFN(slot->device,
538 func->function));
539 if (!dev) {
540 /* Do not set SLOT_ENABLED flag if some funcs
541 are not added. */
542 slot->flags &= ~SLOT_ENABLED;
543 continue;
544 }
545 pci_dev_put(dev);
546 }
547}
548
549/**
550 * disable_slot - disable a slot
551 * @slot: ACPI PHP slot
552 */
553static void disable_slot(struct acpiphp_slot *slot)
554{
555 struct pci_bus *bus = slot->bus;
556 struct pci_dev *dev, *prev;
557 struct acpiphp_func *func;
558
559 /*
560 * enable_slot() enumerates all functions in this device via
561 * pci_scan_slot(), whether they have associated ACPI hotplug
562 * methods (_EJ0, etc.) or not. Therefore, we remove all functions
563 * here.
564 */
565 list_for_each_entry_safe_reverse(dev, prev, &bus->devices, bus_list)
566 if (PCI_SLOT(dev->devfn) == slot->device)
567 pci_stop_and_remove_bus_device(dev);
568
569 list_for_each_entry(func, &slot->funcs, sibling)
570 acpi_bus_trim(func_to_acpi_device(func));
571
572 slot->flags &= ~SLOT_ENABLED;
573}
574
575static bool slot_no_hotplug(struct acpiphp_slot *slot)
576{
577 struct pci_bus *bus = slot->bus;
578 struct pci_dev *dev;
579
580 list_for_each_entry(dev, &bus->devices, bus_list) {
581 if (PCI_SLOT(dev->devfn) == slot->device && dev->ignore_hotplug)
582 return true;
583 }
584 return false;
585}
586
587/**
588 * get_slot_status - get ACPI slot status
589 * @slot: ACPI PHP slot
590 *
591 * If a slot has _STA for each function and if any one of them
592 * returned non-zero status, return it.
593 *
594 * If a slot doesn't have _STA and if any one of its functions'
595 * configuration space is configured, return 0x0f as a _STA.
596 *
597 * Otherwise return 0.
598 */
599static unsigned int get_slot_status(struct acpiphp_slot *slot)
600{
601 unsigned long long sta = 0;
602 struct acpiphp_func *func;
603 u32 dvid;
604
605 list_for_each_entry(func, &slot->funcs, sibling) {
606 if (func->flags & FUNC_HAS_STA) {
607 acpi_status status;
608
609 status = acpi_evaluate_integer(func_to_handle(func),
610 "_STA", NULL, &sta);
611 if (ACPI_SUCCESS(status) && sta)
612 break;
613 } else {
614 if (pci_bus_read_dev_vendor_id(slot->bus,
615 PCI_DEVFN(slot->device, func->function),
616 &dvid, 0)) {
617 sta = ACPI_STA_ALL;
618 break;
619 }
620 }
621 }
622
623 if (!sta) {
624 /*
625 * Check for the slot itself since it may be that the
626 * ACPI slot is a device below PCIe upstream port so in
627 * that case it may not even be reachable yet.
628 */
629 if (pci_bus_read_dev_vendor_id(slot->bus,
630 PCI_DEVFN(slot->device, 0), &dvid, 0)) {
631 sta = ACPI_STA_ALL;
632 }
633 }
634
635 return (unsigned int)sta;
636}
637
638static inline bool device_status_valid(unsigned int sta)
639{
640 /*
641 * ACPI spec says that _STA may return bit 0 clear with bit 3 set
642 * if the device is valid but does not require a device driver to be
643 * loaded (Section 6.3.7 of ACPI 5.0A).
644 */
645 unsigned int mask = ACPI_STA_DEVICE_ENABLED | ACPI_STA_DEVICE_FUNCTIONING;
646 return (sta & mask) == mask;
647}
648
649/**
650 * trim_stale_devices - remove PCI devices that are not responding.
651 * @dev: PCI device to start walking the hierarchy from.
652 */
653static void trim_stale_devices(struct pci_dev *dev)
654{
655 struct acpi_device *adev = ACPI_COMPANION(&dev->dev);
656 struct pci_bus *bus = dev->subordinate;
657 bool alive = dev->ignore_hotplug;
658
659 if (adev) {
660 acpi_status status;
661 unsigned long long sta;
662
663 status = acpi_evaluate_integer(adev->handle, "_STA", NULL, &sta);
664 alive = alive || (ACPI_SUCCESS(status) && device_status_valid(sta));
665 }
666 if (!alive)
667 alive = pci_device_is_present(dev);
668
669 if (!alive) {
670 pci_dev_set_disconnected(dev, NULL);
671 if (pci_has_subordinate(dev))
672 pci_walk_bus(dev->subordinate, pci_dev_set_disconnected,
673 NULL);
674
675 pci_stop_and_remove_bus_device(dev);
676 if (adev)
677 acpi_bus_trim(adev);
678 } else if (bus) {
679 struct pci_dev *child, *tmp;
680
681 /* The device is a bridge. so check the bus below it. */
682 pm_runtime_get_sync(&dev->dev);
683 list_for_each_entry_safe_reverse(child, tmp, &bus->devices, bus_list)
684 trim_stale_devices(child);
685
686 pm_runtime_put(&dev->dev);
687 }
688}
689
690/**
691 * acpiphp_check_bridge - re-enumerate devices
692 * @bridge: where to begin re-enumeration
693 *
694 * Iterate over all slots under this bridge and make sure that if a
695 * card is present they are enabled, and if not they are disabled.
696 */
697static void acpiphp_check_bridge(struct acpiphp_bridge *bridge)
698{
699 struct acpiphp_slot *slot;
700
701 /* Bail out if the bridge is going away. */
702 if (bridge->is_going_away)
703 return;
704
705 if (bridge->pci_dev)
706 pm_runtime_get_sync(&bridge->pci_dev->dev);
707
708 list_for_each_entry(slot, &bridge->slots, node) {
709 struct pci_bus *bus = slot->bus;
710 struct pci_dev *dev, *tmp;
711
712 if (slot_no_hotplug(slot)) {
713 ; /* do nothing */
714 } else if (device_status_valid(get_slot_status(slot))) {
715 /* remove stale devices if any */
716 list_for_each_entry_safe_reverse(dev, tmp,
717 &bus->devices, bus_list)
718 if (PCI_SLOT(dev->devfn) == slot->device)
719 trim_stale_devices(dev);
720
721 /* configure all functions */
722 enable_slot(slot, true);
723 } else {
724 disable_slot(slot);
725 }
726 }
727
728 if (bridge->pci_dev)
729 pm_runtime_put(&bridge->pci_dev->dev);
730}
731
732/*
733 * Remove devices for which we could not assign resources, call
734 * arch specific code to fix-up the bus
735 */
736static void acpiphp_sanitize_bus(struct pci_bus *bus)
737{
738 struct pci_dev *dev, *tmp;
739 int i;
740 unsigned long type_mask = IORESOURCE_IO | IORESOURCE_MEM;
741
742 list_for_each_entry_safe_reverse(dev, tmp, &bus->devices, bus_list) {
743 for (i = 0; i < PCI_BRIDGE_RESOURCES; i++) {
744 struct resource *res = &dev->resource[i];
745 if ((res->flags & type_mask) && !res->start &&
746 res->end) {
747 /* Could not assign a required resources
748 * for this device, remove it */
749 pci_stop_and_remove_bus_device(dev);
750 break;
751 }
752 }
753 }
754}
755
756/*
757 * ACPI event handlers
758 */
759
760void acpiphp_check_host_bridge(struct acpi_device *adev)
761{
762 struct acpiphp_bridge *bridge = NULL;
763
764 acpi_lock_hp_context();
765 if (adev->hp) {
766 bridge = to_acpiphp_root_context(adev->hp)->root_bridge;
767 if (bridge)
768 get_bridge(bridge);
769 }
770 acpi_unlock_hp_context();
771 if (bridge) {
772 pci_lock_rescan_remove();
773
774 acpiphp_check_bridge(bridge);
775
776 pci_unlock_rescan_remove();
777 put_bridge(bridge);
778 }
779}
780
781static int acpiphp_disable_and_eject_slot(struct acpiphp_slot *slot);
782
783static void hotplug_event(u32 type, struct acpiphp_context *context)
784{
785 acpi_handle handle = context->hp.self->handle;
786 struct acpiphp_func *func = &context->func;
787 struct acpiphp_slot *slot = func->slot;
788 struct acpiphp_bridge *bridge;
789
790 acpi_lock_hp_context();
791 bridge = context->bridge;
792 if (bridge)
793 get_bridge(bridge);
794
795 acpi_unlock_hp_context();
796
797 pci_lock_rescan_remove();
798
799 switch (type) {
800 case ACPI_NOTIFY_BUS_CHECK:
801 /* bus re-enumerate */
802 acpi_handle_debug(handle, "Bus check in %s()\n", __func__);
803 if (bridge)
804 acpiphp_check_bridge(bridge);
805 else if (!(slot->flags & SLOT_IS_GOING_AWAY))
806 enable_slot(slot, false);
807
808 break;
809
810 case ACPI_NOTIFY_DEVICE_CHECK:
811 /* device check */
812 acpi_handle_debug(handle, "Device check in %s()\n", __func__);
813 if (bridge) {
814 acpiphp_check_bridge(bridge);
815 } else if (!(slot->flags & SLOT_IS_GOING_AWAY)) {
816 /*
817 * Check if anything has changed in the slot and rescan
818 * from the parent if that's the case.
819 */
820 if (acpiphp_rescan_slot(slot))
821 acpiphp_check_bridge(func->parent);
822 }
823 break;
824
825 case ACPI_NOTIFY_EJECT_REQUEST:
826 /* request device eject */
827 acpi_handle_debug(handle, "Eject request in %s()\n", __func__);
828 acpiphp_disable_and_eject_slot(slot);
829 break;
830 }
831
832 pci_unlock_rescan_remove();
833 if (bridge)
834 put_bridge(bridge);
835}
836
837static int acpiphp_hotplug_notify(struct acpi_device *adev, u32 type)
838{
839 struct acpiphp_context *context;
840
841 context = acpiphp_grab_context(adev);
842 if (!context)
843 return -ENODATA;
844
845 hotplug_event(type, context);
846 acpiphp_let_context_go(context);
847 return 0;
848}
849
850/**
851 * acpiphp_enumerate_slots - Enumerate PCI slots for a given bus.
852 * @bus: PCI bus to enumerate the slots for.
853 *
854 * A "slot" is an object associated with a PCI device number. All functions
855 * (PCI devices) with the same bus and device number belong to the same slot.
856 */
857void acpiphp_enumerate_slots(struct pci_bus *bus)
858{
859 struct acpiphp_bridge *bridge;
860 struct acpi_device *adev;
861 acpi_handle handle;
862 acpi_status status;
863
864 if (acpiphp_disabled)
865 return;
866
867 adev = ACPI_COMPANION(bus->bridge);
868 if (!adev)
869 return;
870
871 handle = adev->handle;
872 bridge = kzalloc(sizeof(struct acpiphp_bridge), GFP_KERNEL);
873 if (!bridge)
874 return;
875
876 INIT_LIST_HEAD(&bridge->slots);
877 kref_init(&bridge->ref);
878 bridge->pci_dev = pci_dev_get(bus->self);
879 bridge->pci_bus = bus;
880
881 /*
882 * Grab a ref to the subordinate PCI bus in case the bus is
883 * removed via PCI core logical hotplug. The ref pins the bus
884 * (which we access during module unload).
885 */
886 get_device(&bus->dev);
887
888 acpi_lock_hp_context();
889 if (pci_is_root_bus(bridge->pci_bus)) {
890 struct acpiphp_root_context *root_context;
891
892 root_context = kzalloc(sizeof(*root_context), GFP_KERNEL);
893 if (!root_context)
894 goto err;
895
896 root_context->root_bridge = bridge;
897 acpi_set_hp_context(adev, &root_context->hp);
898 } else {
899 struct acpiphp_context *context;
900
901 /*
902 * This bridge should have been registered as a hotplug function
903 * under its parent, so the context should be there, unless the
904 * parent is going to be handled by pciehp, in which case this
905 * bridge is not interesting to us either.
906 */
907 context = acpiphp_get_context(adev);
908 if (!context)
909 goto err;
910
911 bridge->context = context;
912 context->bridge = bridge;
913 /* Get a reference to the parent bridge. */
914 get_bridge(context->func.parent);
915 }
916 acpi_unlock_hp_context();
917
918 /* Must be added to the list prior to calling acpiphp_add_context(). */
919 mutex_lock(&bridge_mutex);
920 list_add(&bridge->list, &bridge_list);
921 mutex_unlock(&bridge_mutex);
922
923 /* register all slot objects under this bridge */
924 status = acpi_walk_namespace(ACPI_TYPE_DEVICE, handle, 1,
925 acpiphp_add_context, NULL, bridge, NULL);
926 if (ACPI_FAILURE(status)) {
927 acpi_handle_err(handle, "failed to register slots\n");
928 cleanup_bridge(bridge);
929 put_bridge(bridge);
930 }
931 return;
932
933 err:
934 acpi_unlock_hp_context();
935 put_device(&bus->dev);
936 pci_dev_put(bridge->pci_dev);
937 kfree(bridge);
938}
939
940static void acpiphp_drop_bridge(struct acpiphp_bridge *bridge)
941{
942 if (pci_is_root_bus(bridge->pci_bus)) {
943 struct acpiphp_root_context *root_context;
944 struct acpi_device *adev;
945
946 acpi_lock_hp_context();
947 adev = ACPI_COMPANION(bridge->pci_bus->bridge);
948 root_context = to_acpiphp_root_context(adev->hp);
949 adev->hp = NULL;
950 acpi_unlock_hp_context();
951 kfree(root_context);
952 }
953 cleanup_bridge(bridge);
954 put_bridge(bridge);
955}
956
957/**
958 * acpiphp_remove_slots - Remove slot objects associated with a given bus.
959 * @bus: PCI bus to remove the slot objects for.
960 */
961void acpiphp_remove_slots(struct pci_bus *bus)
962{
963 struct acpiphp_bridge *bridge;
964
965 if (acpiphp_disabled)
966 return;
967
968 mutex_lock(&bridge_mutex);
969 list_for_each_entry(bridge, &bridge_list, list)
970 if (bridge->pci_bus == bus) {
971 mutex_unlock(&bridge_mutex);
972 acpiphp_drop_bridge(bridge);
973 return;
974 }
975
976 mutex_unlock(&bridge_mutex);
977}
978
979/**
980 * acpiphp_enable_slot - power on slot
981 * @slot: ACPI PHP slot
982 */
983int acpiphp_enable_slot(struct acpiphp_slot *slot)
984{
985 pci_lock_rescan_remove();
986
987 if (slot->flags & SLOT_IS_GOING_AWAY) {
988 pci_unlock_rescan_remove();
989 return -ENODEV;
990 }
991
992 /* configure all functions */
993 if (!(slot->flags & SLOT_ENABLED))
994 enable_slot(slot, false);
995
996 pci_unlock_rescan_remove();
997 return 0;
998}
999
1000/**
1001 * acpiphp_disable_and_eject_slot - power off and eject slot
1002 * @slot: ACPI PHP slot
1003 */
1004static int acpiphp_disable_and_eject_slot(struct acpiphp_slot *slot)
1005{
1006 struct acpiphp_func *func;
1007
1008 if (slot->flags & SLOT_IS_GOING_AWAY)
1009 return -ENODEV;
1010
1011 /* unconfigure all functions */
1012 disable_slot(slot);
1013
1014 list_for_each_entry(func, &slot->funcs, sibling)
1015 if (func->flags & FUNC_HAS_EJ0) {
1016 acpi_handle handle = func_to_handle(func);
1017
1018 if (ACPI_FAILURE(acpi_evaluate_ej0(handle)))
1019 acpi_handle_err(handle, "_EJ0 failed\n");
1020
1021 break;
1022 }
1023
1024 return 0;
1025}
1026
1027int acpiphp_disable_slot(struct acpiphp_slot *slot)
1028{
1029 int ret;
1030
1031 /*
1032 * Acquire acpi_scan_lock to ensure that the execution of _EJ0 in
1033 * acpiphp_disable_and_eject_slot() will be synchronized properly.
1034 */
1035 acpi_scan_lock_acquire();
1036 pci_lock_rescan_remove();
1037 ret = acpiphp_disable_and_eject_slot(slot);
1038 pci_unlock_rescan_remove();
1039 acpi_scan_lock_release();
1040 return ret;
1041}
1042
1043/*
1044 * slot enabled: 1
1045 * slot disabled: 0
1046 */
1047u8 acpiphp_get_power_status(struct acpiphp_slot *slot)
1048{
1049 return (slot->flags & SLOT_ENABLED);
1050}
1051
1052/*
1053 * latch open: 1
1054 * latch closed: 0
1055 */
1056u8 acpiphp_get_latch_status(struct acpiphp_slot *slot)
1057{
1058 return !(get_slot_status(slot) & ACPI_STA_DEVICE_UI);
1059}
1060
1061/*
1062 * adapter presence : 1
1063 * absence : 0
1064 */
1065u8 acpiphp_get_adapter_status(struct acpiphp_slot *slot)
1066{
1067 return !!get_slot_status(slot);
1068}