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