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; | |
ba518e3c | 42 | int num; |
7f2feec1 | 43 | struct controller *ctrl = p_slot->ctrl; |
71b720c0 | 44 | |
d689f7eb | 45 | dev = pci_get_slot(parent, PCI_DEVFN(0, 0)); |
71b720c0 | 46 | if (dev) { |
18b341b7 | 47 | ctrl_err(ctrl, "Device %s already exists " |
d689f7eb KK |
48 | "at %04x:%02x:00, cannot hot-add\n", pci_name(dev), |
49 | pci_domain_nr(parent), parent->number); | |
56bfada3 | 50 | pci_dev_put(dev); |
71b720c0 | 51 | return -EINVAL; |
1da177e4 LT |
52 | } |
53 | ||
d689f7eb | 54 | num = pci_scan_slot(parent, PCI_DEVFN(0, 0)); |
71b720c0 | 55 | if (num == 0) { |
7f2feec1 | 56 | ctrl_err(ctrl, "No new device found\n"); |
71b720c0 | 57 | return -ENODEV; |
58 | } | |
1da177e4 | 59 | |
ba518e3c | 60 | list_for_each_entry(dev, &parent->devices, bus_list) |
71b720c0 | 61 | if ((dev->hdr_type == PCI_HEADER_TYPE_BRIDGE) || |
c6da81a4 YL |
62 | (dev->hdr_type == PCI_HEADER_TYPE_CARDBUS)) |
63 | pci_hp_add_bridge(dev); | |
9789ac97 YL |
64 | |
65 | pci_assign_unassigned_bridge_resources(bridge); | |
66 | ||
ba518e3c YW |
67 | list_for_each_entry(dev, &parent->devices, bus_list) { |
68 | if ((dev->class >> 16) == PCI_BASE_CLASS_DISPLAY) | |
9789ac97 | 69 | continue; |
ba518e3c | 70 | |
d569c74d | 71 | pci_configure_slot(dev); |
1da177e4 LT |
72 | } |
73 | ||
71b720c0 | 74 | pci_bus_add_devices(parent); |
9789ac97 | 75 | |
1da177e4 LT |
76 | return 0; |
77 | } | |
78 | ||
ca22a5e4 | 79 | int pciehp_unconfigure_device(struct slot *p_slot) |
1da177e4 | 80 | { |
1cf53d5d | 81 | int ret, rc = 0; |
ca22a5e4 | 82 | u8 bctl = 0; |
1cf53d5d | 83 | u8 presence = 0; |
ba518e3c | 84 | struct pci_dev *dev, *temp; |
385e2491 | 85 | struct pci_bus *parent = p_slot->ctrl->pcie->port->subordinate; |
2326e2b9 | 86 | u16 command; |
7f2feec1 | 87 | struct controller *ctrl = p_slot->ctrl; |
1da177e4 | 88 | |
d689f7eb KK |
89 | ctrl_dbg(ctrl, "%s: domain:bus:dev = %04x:%02x:00\n", |
90 | __func__, pci_domain_nr(parent), parent->number); | |
82a9e79e | 91 | ret = pciehp_get_adapter_status(p_slot, &presence); |
2326e2b9 KK |
92 | if (ret) |
93 | presence = 0; | |
1da177e4 | 94 | |
29ed1f29 YL |
95 | /* |
96 | * Stopping an SR-IOV PF device removes all the associated VFs, | |
97 | * which will update the bus->devices list and confuse the | |
98 | * iterator. Therefore, iterate in reverse so we remove the VFs | |
99 | * first, then the PF. We do the same in pci_stop_bus_device(). | |
100 | */ | |
101 | list_for_each_entry_safe_reverse(dev, temp, &parent->devices, | |
102 | bus_list) { | |
ba518e3c YW |
103 | pci_dev_get(dev); |
104 | if (dev->hdr_type == PCI_HEADER_TYPE_BRIDGE && presence) { | |
105 | pci_read_config_byte(dev, PCI_BRIDGE_CONTROL, &bctl); | |
2326e2b9 | 106 | if (bctl & PCI_BRIDGE_CTL_VGA) { |
7f2feec1 TI |
107 | ctrl_err(ctrl, |
108 | "Cannot remove display device %s\n", | |
ba518e3c YW |
109 | pci_name(dev)); |
110 | pci_dev_put(dev); | |
01b666df | 111 | rc = -EINVAL; |
ac81860e | 112 | break; |
ca22a5e4 | 113 | } |
1da177e4 | 114 | } |
ba518e3c | 115 | pci_stop_and_remove_bus_device(dev); |
2326e2b9 KK |
116 | /* |
117 | * Ensure that no new Requests will be generated from | |
118 | * the device. | |
119 | */ | |
120 | if (presence) { | |
ba518e3c | 121 | pci_read_config_word(dev, PCI_COMMAND, &command); |
2326e2b9 KK |
122 | command &= ~(PCI_COMMAND_MASTER | PCI_COMMAND_SERR); |
123 | command |= PCI_COMMAND_INTX_DISABLE; | |
ba518e3c | 124 | pci_write_config_word(dev, PCI_COMMAND, command); |
2326e2b9 | 125 | } |
ba518e3c | 126 | pci_dev_put(dev); |
1da177e4 | 127 | } |
9fe81645 | 128 | |
1da177e4 LT |
129 | return rc; |
130 | } |