Commit | Line | Data |
---|---|---|
1da177e4 LT |
1 | /* |
2 | * PCI Express Hot Plug Controller Driver | |
3 | * | |
4 | * Copyright (C) 1995,2001 Compaq Computer Corporation | |
5 | * Copyright (C) 2001 Greg Kroah-Hartman (greg@kroah.com) | |
6 | * Copyright (C) 2001 IBM Corp. | |
7 | * Copyright (C) 2003-2004 Intel Corporation | |
8 | * | |
9 | * All rights reserved. | |
10 | * | |
11 | * This program is free software; you can redistribute it and/or modify | |
12 | * it under the terms of the GNU General Public License as published by | |
13 | * the Free Software Foundation; either version 2 of the License, or (at | |
14 | * your option) any later version. | |
15 | * | |
16 | * This program is distributed in the hope that it will be useful, but | |
17 | * WITHOUT ANY WARRANTY; without even the implied warranty of | |
18 | * MERCHANTABILITY OR FITNESS FOR A PARTICULAR PURPOSE, GOOD TITLE or | |
19 | * NON INFRINGEMENT. See the GNU General Public License for more | |
20 | * details. | |
21 | * | |
22 | * You should have received a copy of the GNU General Public License | |
23 | * along with this program; if not, write to the Free Software | |
24 | * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. | |
25 | * | |
8cf4c195 | 26 | * Send feedback to <greg@kroah.com>, <kristen.c.accardi@intel.com> |
1da177e4 LT |
27 | * |
28 | */ | |
29 | ||
1da177e4 LT |
30 | #include <linux/module.h> |
31 | #include <linux/kernel.h> | |
32 | #include <linux/types.h> | |
1da177e4 LT |
33 | #include <linux/pci.h> |
34 | #include "../pci.h" | |
35 | #include "pciehp.h" | |
1da177e4 | 36 | |
71b720c0 | 37 | int pciehp_configure_device(struct slot *p_slot) |
1da177e4 | 38 | { |
71b720c0 | 39 | struct pci_dev *dev; |
9789ac97 YL |
40 | struct pci_dev *bridge = p_slot->ctrl->pcie->port; |
41 | struct pci_bus *parent = bridge->subordinate; | |
c4ec84c7 | 42 | int num, ret = 0; |
7f2feec1 | 43 | struct controller *ctrl = p_slot->ctrl; |
71b720c0 | 44 | |
c4ec84c7 RW |
45 | pci_lock_rescan_remove(); |
46 | ||
d689f7eb | 47 | dev = pci_get_slot(parent, PCI_DEVFN(0, 0)); |
71b720c0 | 48 | if (dev) { |
227f0647 RD |
49 | ctrl_err(ctrl, "Device %s already exists at %04x:%02x:00, cannot hot-add\n", |
50 | pci_name(dev), pci_domain_nr(parent), parent->number); | |
56bfada3 | 51 | pci_dev_put(dev); |
50277c8b | 52 | ret = -EEXIST; |
c4ec84c7 | 53 | goto out; |
1da177e4 LT |
54 | } |
55 | ||
d689f7eb | 56 | num = pci_scan_slot(parent, PCI_DEVFN(0, 0)); |
71b720c0 | 57 | if (num == 0) { |
7f2feec1 | 58 | ctrl_err(ctrl, "No new device found\n"); |
c4ec84c7 RW |
59 | ret = -ENODEV; |
60 | goto out; | |
71b720c0 | 61 | } |
1da177e4 | 62 | |
ba518e3c | 63 | list_for_each_entry(dev, &parent->devices, bus_list) |
930067e2 | 64 | if (pci_is_bridge(dev)) |
c6da81a4 | 65 | pci_hp_add_bridge(dev); |
9789ac97 YL |
66 | |
67 | pci_assign_unassigned_bridge_resources(bridge); | |
68 | ||
ba518e3c YW |
69 | list_for_each_entry(dev, &parent->devices, bus_list) { |
70 | if ((dev->class >> 16) == PCI_BASE_CLASS_DISPLAY) | |
9789ac97 | 71 | continue; |
ba518e3c | 72 | |
d569c74d | 73 | pci_configure_slot(dev); |
1da177e4 LT |
74 | } |
75 | ||
71b720c0 | 76 | pci_bus_add_devices(parent); |
9789ac97 | 77 | |
c4ec84c7 RW |
78 | out: |
79 | pci_unlock_rescan_remove(); | |
80 | return ret; | |
1da177e4 LT |
81 | } |
82 | ||
ca22a5e4 | 83 | int pciehp_unconfigure_device(struct slot *p_slot) |
1da177e4 | 84 | { |
6dae6202 | 85 | int rc = 0; |
ca22a5e4 | 86 | u8 bctl = 0; |
1cf53d5d | 87 | u8 presence = 0; |
ba518e3c | 88 | struct pci_dev *dev, *temp; |
385e2491 | 89 | struct pci_bus *parent = p_slot->ctrl->pcie->port->subordinate; |
2326e2b9 | 90 | u16 command; |
7f2feec1 | 91 | struct controller *ctrl = p_slot->ctrl; |
1da177e4 | 92 | |
d689f7eb KK |
93 | ctrl_dbg(ctrl, "%s: domain:bus:dev = %04x:%02x:00\n", |
94 | __func__, pci_domain_nr(parent), parent->number); | |
6dae6202 | 95 | pciehp_get_adapter_status(p_slot, &presence); |
1da177e4 | 96 | |
c4ec84c7 RW |
97 | pci_lock_rescan_remove(); |
98 | ||
29ed1f29 YL |
99 | /* |
100 | * Stopping an SR-IOV PF device removes all the associated VFs, | |
101 | * which will update the bus->devices list and confuse the | |
102 | * iterator. Therefore, iterate in reverse so we remove the VFs | |
103 | * first, then the PF. We do the same in pci_stop_bus_device(). | |
104 | */ | |
105 | list_for_each_entry_safe_reverse(dev, temp, &parent->devices, | |
106 | bus_list) { | |
ba518e3c YW |
107 | pci_dev_get(dev); |
108 | if (dev->hdr_type == PCI_HEADER_TYPE_BRIDGE && presence) { | |
109 | pci_read_config_byte(dev, PCI_BRIDGE_CONTROL, &bctl); | |
2326e2b9 | 110 | if (bctl & PCI_BRIDGE_CTL_VGA) { |
7f2feec1 TI |
111 | ctrl_err(ctrl, |
112 | "Cannot remove display device %s\n", | |
ba518e3c YW |
113 | pci_name(dev)); |
114 | pci_dev_put(dev); | |
01b666df | 115 | rc = -EINVAL; |
ac81860e | 116 | break; |
ca22a5e4 | 117 | } |
1da177e4 | 118 | } |
ba518e3c | 119 | pci_stop_and_remove_bus_device(dev); |
2326e2b9 KK |
120 | /* |
121 | * Ensure that no new Requests will be generated from | |
122 | * the device. | |
123 | */ | |
124 | if (presence) { | |
ba518e3c | 125 | pci_read_config_word(dev, PCI_COMMAND, &command); |
2326e2b9 KK |
126 | command &= ~(PCI_COMMAND_MASTER | PCI_COMMAND_SERR); |
127 | command |= PCI_COMMAND_INTX_DISABLE; | |
ba518e3c | 128 | pci_write_config_word(dev, PCI_COMMAND, command); |
2326e2b9 | 129 | } |
ba518e3c | 130 | pci_dev_put(dev); |
1da177e4 | 131 | } |
9fe81645 | 132 | |
c4ec84c7 | 133 | pci_unlock_rescan_remove(); |
1da177e4 LT |
134 | return rc; |
135 | } |