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