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 | |
0ab2b57f | 37 | static int __ref pciehp_add_bridge(struct pci_dev *dev) |
0eb3bcfd RS |
38 | { |
39 | struct pci_bus *parent = dev->bus; | |
40 | int pass, busnr, start = parent->secondary; | |
41 | int end = parent->subordinate; | |
42 | ||
43 | for (busnr = start; busnr <= end; busnr++) { | |
44 | if (!pci_find_bus(pci_domain_nr(parent), busnr)) | |
45 | break; | |
46 | } | |
47 | if (busnr-- > end) { | |
48 | err("No bus number available for hot-added bridge %s\n", | |
49 | pci_name(dev)); | |
50 | return -1; | |
51 | } | |
52 | for (pass = 0; pass < 2; pass++) | |
53 | busnr = pci_scan_bridge(parent, dev, busnr, pass); | |
54 | if (!dev->subordinate) | |
55 | return -1; | |
9789ac97 | 56 | |
0eb3bcfd RS |
57 | return 0; |
58 | } | |
1da177e4 | 59 | |
71b720c0 | 60 | int pciehp_configure_device(struct slot *p_slot) |
1da177e4 | 61 | { |
71b720c0 | 62 | struct pci_dev *dev; |
9789ac97 YL |
63 | struct pci_dev *bridge = p_slot->ctrl->pcie->port; |
64 | struct pci_bus *parent = bridge->subordinate; | |
71b720c0 | 65 | int num, fn; |
7f2feec1 | 66 | struct controller *ctrl = p_slot->ctrl; |
71b720c0 | 67 | |
d689f7eb | 68 | dev = pci_get_slot(parent, PCI_DEVFN(0, 0)); |
71b720c0 | 69 | if (dev) { |
18b341b7 | 70 | ctrl_err(ctrl, "Device %s already exists " |
d689f7eb KK |
71 | "at %04x:%02x:00, cannot hot-add\n", pci_name(dev), |
72 | pci_domain_nr(parent), parent->number); | |
56bfada3 | 73 | pci_dev_put(dev); |
71b720c0 | 74 | return -EINVAL; |
1da177e4 LT |
75 | } |
76 | ||
d689f7eb | 77 | num = pci_scan_slot(parent, PCI_DEVFN(0, 0)); |
71b720c0 | 78 | if (num == 0) { |
7f2feec1 | 79 | ctrl_err(ctrl, "No new device found\n"); |
71b720c0 | 80 | return -ENODEV; |
81 | } | |
1da177e4 | 82 | |
71b720c0 | 83 | for (fn = 0; fn < 8; fn++) { |
d689f7eb | 84 | dev = pci_get_slot(parent, PCI_DEVFN(0, fn)); |
0eb3bcfd | 85 | if (!dev) |
71b720c0 | 86 | continue; |
71b720c0 | 87 | if ((dev->hdr_type == PCI_HEADER_TYPE_BRIDGE) || |
88 | (dev->hdr_type == PCI_HEADER_TYPE_CARDBUS)) { | |
0eb3bcfd | 89 | pciehp_add_bridge(dev); |
71b720c0 | 90 | } |
9789ac97 YL |
91 | pci_dev_put(dev); |
92 | } | |
93 | ||
94 | pci_assign_unassigned_bridge_resources(bridge); | |
95 | ||
96 | for (fn = 0; fn < 8; fn++) { | |
97 | dev = pci_get_slot(parent, PCI_DEVFN(0, fn)); | |
98 | if (!dev) | |
99 | continue; | |
100 | if ((dev->class >> 16) == PCI_BASE_CLASS_DISPLAY) { | |
101 | pci_dev_put(dev); | |
102 | continue; | |
103 | } | |
d569c74d | 104 | pci_configure_slot(dev); |
6e33706b | 105 | pci_dev_put(dev); |
1da177e4 LT |
106 | } |
107 | ||
71b720c0 | 108 | pci_bus_add_devices(parent); |
9789ac97 | 109 | |
1da177e4 LT |
110 | return 0; |
111 | } | |
112 | ||
ca22a5e4 | 113 | int pciehp_unconfigure_device(struct slot *p_slot) |
1da177e4 | 114 | { |
1cf53d5d | 115 | int ret, rc = 0; |
1da177e4 | 116 | int j; |
ca22a5e4 | 117 | u8 bctl = 0; |
1cf53d5d | 118 | u8 presence = 0; |
385e2491 | 119 | struct pci_bus *parent = p_slot->ctrl->pcie->port->subordinate; |
2326e2b9 | 120 | u16 command; |
7f2feec1 | 121 | struct controller *ctrl = p_slot->ctrl; |
1da177e4 | 122 | |
d689f7eb KK |
123 | ctrl_dbg(ctrl, "%s: domain:bus:dev = %04x:%02x:00\n", |
124 | __func__, pci_domain_nr(parent), parent->number); | |
82a9e79e | 125 | ret = pciehp_get_adapter_status(p_slot, &presence); |
2326e2b9 KK |
126 | if (ret) |
127 | presence = 0; | |
1da177e4 | 128 | |
f07234b6 | 129 | for (j = 0; j < 8; j++) { |
ac81860e | 130 | struct pci_dev *temp = pci_get_slot(parent, PCI_DEVFN(0, j)); |
ca22a5e4 | 131 | if (!temp) |
132 | continue; | |
2326e2b9 KK |
133 | if (temp->hdr_type == PCI_HEADER_TYPE_BRIDGE && presence) { |
134 | pci_read_config_byte(temp, PCI_BRIDGE_CONTROL, &bctl); | |
135 | if (bctl & PCI_BRIDGE_CTL_VGA) { | |
7f2feec1 TI |
136 | ctrl_err(ctrl, |
137 | "Cannot remove display device %s\n", | |
138 | pci_name(temp)); | |
2326e2b9 | 139 | pci_dev_put(temp); |
01b666df | 140 | rc = -EINVAL; |
ac81860e | 141 | break; |
ca22a5e4 | 142 | } |
1da177e4 | 143 | } |
ca22a5e4 | 144 | pci_remove_bus_device(temp); |
2326e2b9 KK |
145 | /* |
146 | * Ensure that no new Requests will be generated from | |
147 | * the device. | |
148 | */ | |
149 | if (presence) { | |
150 | pci_read_config_word(temp, PCI_COMMAND, &command); | |
151 | command &= ~(PCI_COMMAND_MASTER | PCI_COMMAND_SERR); | |
152 | command |= PCI_COMMAND_INTX_DISABLE; | |
153 | pci_write_config_word(temp, PCI_COMMAND, command); | |
154 | } | |
56bfada3 | 155 | pci_dev_put(temp); |
1da177e4 | 156 | } |
9fe81645 | 157 | |
1da177e4 LT |
158 | return rc; |
159 | } |