1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26#include <linux/module.h>
27#include <linux/kernel.h>
28#include <linux/pci.h>
29#include <linux/pci_hotplug.h>
30#include <linux/proc_fs.h>
31#include "../pci.h"
32#include "cpci_hotplug.h"
33
34#define MY_NAME "cpci_hotplug"
35
36extern int cpci_debug;
37
38#define dbg(format, arg...) \
39 do { \
40 if (cpci_debug) \
41 printk(KERN_DEBUG "%s: " format "\n", \
42 MY_NAME, ## arg); \
43 } while (0)
44#define err(format, arg...) printk(KERN_ERR "%s: " format "\n", MY_NAME, ## arg)
45#define info(format, arg...) printk(KERN_INFO "%s: " format "\n", MY_NAME, ## arg)
46#define warn(format, arg...) printk(KERN_WARNING "%s: " format "\n", MY_NAME, ## arg)
47
48
49u8 cpci_get_attention_status(struct slot *slot)
50{
51 int hs_cap;
52 u16 hs_csr;
53
54 hs_cap = pci_bus_find_capability(slot->bus,
55 slot->devfn,
56 PCI_CAP_ID_CHSWP);
57 if (!hs_cap)
58 return 0;
59
60 if (pci_bus_read_config_word(slot->bus,
61 slot->devfn,
62 hs_cap + 2,
63 &hs_csr))
64 return 0;
65
66 return hs_csr & 0x0008 ? 1 : 0;
67}
68
69int cpci_set_attention_status(struct slot *slot, int status)
70{
71 int hs_cap;
72 u16 hs_csr;
73
74 hs_cap = pci_bus_find_capability(slot->bus,
75 slot->devfn,
76 PCI_CAP_ID_CHSWP);
77 if (!hs_cap)
78 return 0;
79 if (pci_bus_read_config_word(slot->bus,
80 slot->devfn,
81 hs_cap + 2,
82 &hs_csr))
83 return 0;
84 if (status)
85 hs_csr |= HS_CSR_LOO;
86 else
87 hs_csr &= ~HS_CSR_LOO;
88 if (pci_bus_write_config_word(slot->bus,
89 slot->devfn,
90 hs_cap + 2,
91 hs_csr))
92 return 0;
93 return 1;
94}
95
96u16 cpci_get_hs_csr(struct slot *slot)
97{
98 int hs_cap;
99 u16 hs_csr;
100
101 hs_cap = pci_bus_find_capability(slot->bus,
102 slot->devfn,
103 PCI_CAP_ID_CHSWP);
104 if (!hs_cap)
105 return 0xFFFF;
106 if (pci_bus_read_config_word(slot->bus,
107 slot->devfn,
108 hs_cap + 2,
109 &hs_csr))
110 return 0xFFFF;
111 return hs_csr;
112}
113
114int cpci_check_and_clear_ins(struct slot *slot)
115{
116 int hs_cap;
117 u16 hs_csr;
118 int ins = 0;
119
120 hs_cap = pci_bus_find_capability(slot->bus,
121 slot->devfn,
122 PCI_CAP_ID_CHSWP);
123 if (!hs_cap)
124 return 0;
125 if (pci_bus_read_config_word(slot->bus,
126 slot->devfn,
127 hs_cap + 2,
128 &hs_csr))
129 return 0;
130 if (hs_csr & HS_CSR_INS) {
131
132 if (pci_bus_write_config_word(slot->bus,
133 slot->devfn,
134 hs_cap + 2,
135 hs_csr))
136 ins = 0;
137 else
138 ins = 1;
139 }
140 return ins;
141}
142
143int cpci_check_ext(struct slot *slot)
144{
145 int hs_cap;
146 u16 hs_csr;
147 int ext = 0;
148
149 hs_cap = pci_bus_find_capability(slot->bus,
150 slot->devfn,
151 PCI_CAP_ID_CHSWP);
152 if (!hs_cap)
153 return 0;
154 if (pci_bus_read_config_word(slot->bus,
155 slot->devfn,
156 hs_cap + 2,
157 &hs_csr))
158 return 0;
159 if (hs_csr & HS_CSR_EXT)
160 ext = 1;
161 return ext;
162}
163
164int cpci_clear_ext(struct slot *slot)
165{
166 int hs_cap;
167 u16 hs_csr;
168
169 hs_cap = pci_bus_find_capability(slot->bus,
170 slot->devfn,
171 PCI_CAP_ID_CHSWP);
172 if (!hs_cap)
173 return -ENODEV;
174 if (pci_bus_read_config_word(slot->bus,
175 slot->devfn,
176 hs_cap + 2,
177 &hs_csr))
178 return -ENODEV;
179 if (hs_csr & HS_CSR_EXT) {
180
181 if (pci_bus_write_config_word(slot->bus,
182 slot->devfn,
183 hs_cap + 2,
184 hs_csr))
185 return -ENODEV;
186 }
187 return 0;
188}
189
190int cpci_led_on(struct slot *slot)
191{
192 int hs_cap;
193 u16 hs_csr;
194
195 hs_cap = pci_bus_find_capability(slot->bus,
196 slot->devfn,
197 PCI_CAP_ID_CHSWP);
198 if (!hs_cap)
199 return -ENODEV;
200 if (pci_bus_read_config_word(slot->bus,
201 slot->devfn,
202 hs_cap + 2,
203 &hs_csr))
204 return -ENODEV;
205 if ((hs_csr & HS_CSR_LOO) != HS_CSR_LOO) {
206 hs_csr |= HS_CSR_LOO;
207 if (pci_bus_write_config_word(slot->bus,
208 slot->devfn,
209 hs_cap + 2,
210 hs_csr)) {
211 err("Could not set LOO for slot %s",
212 hotplug_slot_name(slot->hotplug_slot));
213 return -ENODEV;
214 }
215 }
216 return 0;
217}
218
219int cpci_led_off(struct slot *slot)
220{
221 int hs_cap;
222 u16 hs_csr;
223
224 hs_cap = pci_bus_find_capability(slot->bus,
225 slot->devfn,
226 PCI_CAP_ID_CHSWP);
227 if (!hs_cap)
228 return -ENODEV;
229 if (pci_bus_read_config_word(slot->bus,
230 slot->devfn,
231 hs_cap + 2,
232 &hs_csr))
233 return -ENODEV;
234 if (hs_csr & HS_CSR_LOO) {
235 hs_csr &= ~HS_CSR_LOO;
236 if (pci_bus_write_config_word(slot->bus,
237 slot->devfn,
238 hs_cap + 2,
239 hs_csr)) {
240 err("Could not clear LOO for slot %s",
241 hotplug_slot_name(slot->hotplug_slot));
242 return -ENODEV;
243 }
244 }
245 return 0;
246}
247
248
249
250
251
252
253int cpci_configure_slot(struct slot *slot)
254{
255 struct pci_dev *dev;
256 struct pci_bus *parent;
257 int ret = 0;
258
259 dbg("%s - enter", __func__);
260
261 pci_lock_rescan_remove();
262
263 if (slot->dev == NULL) {
264 dbg("pci_dev null, finding %02x:%02x:%x",
265 slot->bus->number, PCI_SLOT(slot->devfn), PCI_FUNC(slot->devfn));
266 slot->dev = pci_get_slot(slot->bus, slot->devfn);
267 }
268
269
270 if (slot->dev == NULL) {
271 int n;
272 dbg("pci_dev still null");
273
274
275
276
277
278 n = pci_scan_slot(slot->bus, slot->devfn);
279 dbg("%s: pci_scan_slot returned %d", __func__, n);
280 slot->dev = pci_get_slot(slot->bus, slot->devfn);
281 if (slot->dev == NULL) {
282 err("Could not find PCI device for slot %02x", slot->number);
283 ret = -ENODEV;
284 goto out;
285 }
286 }
287 parent = slot->dev->bus;
288
289 list_for_each_entry(dev, &parent->devices, bus_list) {
290 if (PCI_SLOT(dev->devfn) != PCI_SLOT(slot->devfn))
291 continue;
292 if (pci_is_bridge(dev))
293 pci_hp_add_bridge(dev);
294 }
295
296
297 pci_assign_unassigned_bridge_resources(parent->self);
298
299 pci_bus_add_devices(parent);
300
301 out:
302 pci_unlock_rescan_remove();
303 dbg("%s - exit", __func__);
304 return ret;
305}
306
307int cpci_unconfigure_slot(struct slot *slot)
308{
309 struct pci_dev *dev, *temp;
310
311 dbg("%s - enter", __func__);
312 if (!slot->dev) {
313 err("No device for slot %02x\n", slot->number);
314 return -ENODEV;
315 }
316
317 pci_lock_rescan_remove();
318
319 list_for_each_entry_safe(dev, temp, &slot->bus->devices, bus_list) {
320 if (PCI_SLOT(dev->devfn) != PCI_SLOT(slot->devfn))
321 continue;
322 pci_dev_get(dev);
323 pci_stop_and_remove_bus_device(dev);
324 pci_dev_put(dev);
325 }
326 pci_dev_put(slot->dev);
327 slot->dev = NULL;
328
329 pci_unlock_rescan_remove();
330
331 dbg("%s - exit", __func__);
332 return 0;
333}
334
