Commit | Line | Data |
---|---|---|
1da177e4 LT |
1 | /* |
2 | * CompactPCI Hot Plug Driver PCI functions | |
3 | * | |
bcc488ab | 4 | * Copyright (C) 2002,2005 by SOMA Networks, Inc. |
1da177e4 LT |
5 | * |
6 | * All rights reserved. | |
7 | * | |
8 | * This program is free software; you can redistribute it and/or modify | |
9 | * it under the terms of the GNU General Public License as published by | |
10 | * the Free Software Foundation; either version 2 of the License, or (at | |
11 | * your option) any later version. | |
12 | * | |
13 | * This program is distributed in the hope that it will be useful, but | |
14 | * WITHOUT ANY WARRANTY; without even the implied warranty of | |
15 | * MERCHANTABILITY OR FITNESS FOR A PARTICULAR PURPOSE, GOOD TITLE or | |
16 | * NON INFRINGEMENT. See the GNU General Public License for more | |
17 | * details. | |
18 | * | |
19 | * You should have received a copy of the GNU General Public License | |
20 | * along with this program; if not, write to the Free Software | |
21 | * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. | |
22 | * | |
23 | * Send feedback to <scottm@somanetworks.com> | |
24 | */ | |
25 | ||
1da177e4 LT |
26 | #include <linux/module.h> |
27 | #include <linux/kernel.h> | |
28 | #include <linux/pci.h> | |
29 | #include <linux/proc_fs.h> | |
30 | #include "../pci.h" | |
31 | #include "pci_hotplug.h" | |
32 | #include "cpci_hotplug.h" | |
33 | ||
1da177e4 | 34 | #define MY_NAME "cpci_hotplug" |
1da177e4 LT |
35 | |
36 | extern int cpci_debug; | |
37 | ||
38 | #define dbg(format, arg...) \ | |
39 | do { \ | |
bcc488ab | 40 | if (cpci_debug) \ |
1da177e4 LT |
41 | printk (KERN_DEBUG "%s: " format "\n", \ |
42 | MY_NAME , ## arg); \ | |
bcc488ab | 43 | } while (0) |
1da177e4 LT |
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 | #define ROUND_UP(x, a) (((x) + (a) - 1) & ~((a) - 1)) | |
49 | ||
50 | ||
51 | u8 cpci_get_attention_status(struct slot* slot) | |
52 | { | |
53 | int hs_cap; | |
54 | u16 hs_csr; | |
55 | ||
56 | hs_cap = pci_bus_find_capability(slot->bus, | |
57 | slot->devfn, | |
58 | PCI_CAP_ID_CHSWP); | |
bcc488ab | 59 | if (!hs_cap) |
1da177e4 | 60 | return 0; |
1da177e4 | 61 | |
bcc488ab | 62 | if (pci_bus_read_config_word(slot->bus, |
1da177e4 LT |
63 | slot->devfn, |
64 | hs_cap + 2, | |
bcc488ab | 65 | &hs_csr)) |
1da177e4 | 66 | return 0; |
bcc488ab | 67 | |
1da177e4 LT |
68 | return hs_csr & 0x0008 ? 1 : 0; |
69 | } | |
70 | ||
71 | int cpci_set_attention_status(struct slot* slot, int status) | |
72 | { | |
73 | int hs_cap; | |
74 | u16 hs_csr; | |
75 | ||
76 | hs_cap = pci_bus_find_capability(slot->bus, | |
77 | slot->devfn, | |
78 | PCI_CAP_ID_CHSWP); | |
bcc488ab | 79 | if (!hs_cap) |
1da177e4 | 80 | return 0; |
bcc488ab | 81 | if (pci_bus_read_config_word(slot->bus, |
1da177e4 LT |
82 | slot->devfn, |
83 | hs_cap + 2, | |
bcc488ab | 84 | &hs_csr)) |
1da177e4 | 85 | return 0; |
bcc488ab | 86 | if (status) |
1da177e4 | 87 | hs_csr |= HS_CSR_LOO; |
bcc488ab | 88 | else |
1da177e4 | 89 | hs_csr &= ~HS_CSR_LOO; |
bcc488ab | 90 | if (pci_bus_write_config_word(slot->bus, |
1da177e4 LT |
91 | slot->devfn, |
92 | hs_cap + 2, | |
bcc488ab | 93 | hs_csr)) |
1da177e4 | 94 | return 0; |
1da177e4 LT |
95 | return 1; |
96 | } | |
97 | ||
98 | u16 cpci_get_hs_csr(struct slot* slot) | |
99 | { | |
100 | int hs_cap; | |
101 | u16 hs_csr; | |
102 | ||
103 | hs_cap = pci_bus_find_capability(slot->bus, | |
104 | slot->devfn, | |
105 | PCI_CAP_ID_CHSWP); | |
bcc488ab | 106 | if (!hs_cap) |
1da177e4 | 107 | return 0xFFFF; |
bcc488ab | 108 | if (pci_bus_read_config_word(slot->bus, |
1da177e4 LT |
109 | slot->devfn, |
110 | hs_cap + 2, | |
bcc488ab | 111 | &hs_csr)) |
1da177e4 | 112 | return 0xFFFF; |
1da177e4 LT |
113 | return hs_csr; |
114 | } | |
115 | ||
1da177e4 LT |
116 | int cpci_check_and_clear_ins(struct slot* slot) |
117 | { | |
118 | int hs_cap; | |
119 | u16 hs_csr; | |
120 | int ins = 0; | |
121 | ||
122 | hs_cap = pci_bus_find_capability(slot->bus, | |
123 | slot->devfn, | |
124 | PCI_CAP_ID_CHSWP); | |
bcc488ab | 125 | if (!hs_cap) |
1da177e4 | 126 | return 0; |
bcc488ab | 127 | if (pci_bus_read_config_word(slot->bus, |
1da177e4 LT |
128 | slot->devfn, |
129 | hs_cap + 2, | |
bcc488ab | 130 | &hs_csr)) |
1da177e4 | 131 | return 0; |
bcc488ab | 132 | if (hs_csr & HS_CSR_INS) { |
1da177e4 | 133 | /* Clear INS (by setting it) */ |
bcc488ab | 134 | if (pci_bus_write_config_word(slot->bus, |
1da177e4 LT |
135 | slot->devfn, |
136 | hs_cap + 2, | |
bcc488ab | 137 | hs_csr)) |
1da177e4 | 138 | ins = 0; |
bcc488ab SM |
139 | else |
140 | ins = 1; | |
1da177e4 LT |
141 | } |
142 | return ins; | |
143 | } | |
144 | ||
145 | int cpci_check_ext(struct slot* slot) | |
146 | { | |
147 | int hs_cap; | |
148 | u16 hs_csr; | |
149 | int ext = 0; | |
150 | ||
151 | hs_cap = pci_bus_find_capability(slot->bus, | |
152 | slot->devfn, | |
153 | PCI_CAP_ID_CHSWP); | |
bcc488ab | 154 | if (!hs_cap) |
1da177e4 | 155 | return 0; |
bcc488ab | 156 | if (pci_bus_read_config_word(slot->bus, |
1da177e4 LT |
157 | slot->devfn, |
158 | hs_cap + 2, | |
bcc488ab | 159 | &hs_csr)) |
1da177e4 | 160 | return 0; |
bcc488ab | 161 | if (hs_csr & HS_CSR_EXT) |
1da177e4 | 162 | ext = 1; |
1da177e4 LT |
163 | return ext; |
164 | } | |
165 | ||
166 | int cpci_clear_ext(struct slot* slot) | |
167 | { | |
168 | int hs_cap; | |
169 | u16 hs_csr; | |
170 | ||
171 | hs_cap = pci_bus_find_capability(slot->bus, | |
172 | slot->devfn, | |
173 | PCI_CAP_ID_CHSWP); | |
bcc488ab | 174 | if (!hs_cap) |
1da177e4 | 175 | return -ENODEV; |
bcc488ab | 176 | if (pci_bus_read_config_word(slot->bus, |
1da177e4 LT |
177 | slot->devfn, |
178 | hs_cap + 2, | |
bcc488ab | 179 | &hs_csr)) |
1da177e4 | 180 | return -ENODEV; |
bcc488ab | 181 | if (hs_csr & HS_CSR_EXT) { |
1da177e4 | 182 | /* Clear EXT (by setting it) */ |
bcc488ab | 183 | if (pci_bus_write_config_word(slot->bus, |
1da177e4 LT |
184 | slot->devfn, |
185 | hs_cap + 2, | |
bcc488ab | 186 | hs_csr)) |
1da177e4 | 187 | return -ENODEV; |
1da177e4 LT |
188 | } |
189 | return 0; | |
190 | } | |
191 | ||
192 | int cpci_led_on(struct slot* slot) | |
193 | { | |
194 | int hs_cap; | |
195 | u16 hs_csr; | |
196 | ||
197 | hs_cap = pci_bus_find_capability(slot->bus, | |
198 | slot->devfn, | |
199 | PCI_CAP_ID_CHSWP); | |
bcc488ab | 200 | if (!hs_cap) |
1da177e4 | 201 | return -ENODEV; |
bcc488ab | 202 | if (pci_bus_read_config_word(slot->bus, |
1da177e4 LT |
203 | slot->devfn, |
204 | hs_cap + 2, | |
bcc488ab | 205 | &hs_csr)) |
1da177e4 | 206 | return -ENODEV; |
bcc488ab | 207 | if ((hs_csr & HS_CSR_LOO) != HS_CSR_LOO) { |
1da177e4 | 208 | hs_csr |= HS_CSR_LOO; |
bcc488ab | 209 | if (pci_bus_write_config_word(slot->bus, |
1da177e4 LT |
210 | slot->devfn, |
211 | hs_cap + 2, | |
212 | hs_csr)) { | |
213 | err("Could not set LOO for slot %s", | |
214 | slot->hotplug_slot->name); | |
215 | return -ENODEV; | |
216 | } | |
217 | } | |
218 | return 0; | |
219 | } | |
220 | ||
221 | int cpci_led_off(struct slot* slot) | |
222 | { | |
223 | int hs_cap; | |
224 | u16 hs_csr; | |
225 | ||
226 | hs_cap = pci_bus_find_capability(slot->bus, | |
227 | slot->devfn, | |
228 | PCI_CAP_ID_CHSWP); | |
bcc488ab | 229 | if (!hs_cap) |
1da177e4 | 230 | return -ENODEV; |
bcc488ab | 231 | if (pci_bus_read_config_word(slot->bus, |
1da177e4 LT |
232 | slot->devfn, |
233 | hs_cap + 2, | |
bcc488ab | 234 | &hs_csr)) |
1da177e4 | 235 | return -ENODEV; |
bcc488ab | 236 | if (hs_csr & HS_CSR_LOO) { |
1da177e4 | 237 | hs_csr &= ~HS_CSR_LOO; |
bcc488ab | 238 | if (pci_bus_write_config_word(slot->bus, |
1da177e4 LT |
239 | slot->devfn, |
240 | hs_cap + 2, | |
241 | hs_csr)) { | |
242 | err("Could not clear LOO for slot %s", | |
243 | slot->hotplug_slot->name); | |
244 | return -ENODEV; | |
245 | } | |
246 | } | |
247 | return 0; | |
248 | } | |
249 | ||
250 | ||
251 | /* | |
252 | * Device configuration functions | |
253 | */ | |
254 | ||
1da177e4 LT |
255 | int cpci_configure_slot(struct slot* slot) |
256 | { | |
cc702c2c SM |
257 | struct pci_bus *parent; |
258 | int fn; | |
1da177e4 LT |
259 | |
260 | dbg("%s - enter", __FUNCTION__); | |
261 | ||
bcc488ab | 262 | if (slot->dev == NULL) { |
1da177e4 LT |
263 | dbg("pci_dev null, finding %02x:%02x:%x", |
264 | slot->bus->number, PCI_SLOT(slot->devfn), PCI_FUNC(slot->devfn)); | |
bcc488ab | 265 | slot->dev = pci_get_slot(slot->bus, slot->devfn); |
1da177e4 LT |
266 | } |
267 | ||
268 | /* Still NULL? Well then scan for it! */ | |
bcc488ab | 269 | if (slot->dev == NULL) { |
1da177e4 LT |
270 | int n; |
271 | dbg("pci_dev still null"); | |
272 | ||
273 | /* | |
274 | * This will generate pci_dev structures for all functions, but | |
275 | * we will only call this case when lookup fails. | |
276 | */ | |
277 | n = pci_scan_slot(slot->bus, slot->devfn); | |
278 | dbg("%s: pci_scan_slot returned %d", __FUNCTION__, n); | |
bcc488ab SM |
279 | slot->dev = pci_get_slot(slot->bus, slot->devfn); |
280 | if (slot->dev == NULL) { | |
1da177e4 | 281 | err("Could not find PCI device for slot %02x", slot->number); |
cc702c2c | 282 | return -ENODEV; |
1da177e4 LT |
283 | } |
284 | } | |
cc702c2c SM |
285 | parent = slot->dev->bus; |
286 | ||
287 | for (fn = 0; fn < 8; fn++) { | |
288 | struct pci_dev *dev; | |
289 | ||
290 | dev = pci_get_slot(parent, PCI_DEVFN(PCI_SLOT(slot->devfn), fn)); | |
291 | if (!dev) | |
292 | continue; | |
293 | if ((dev->hdr_type == PCI_HEADER_TYPE_BRIDGE) || | |
294 | (dev->hdr_type == PCI_HEADER_TYPE_CARDBUS)) { | |
295 | /* Find an unused bus number for the new bridge */ | |
296 | struct pci_bus *child; | |
297 | unsigned char busnr, start = parent->secondary; | |
298 | unsigned char end = parent->subordinate; | |
299 | ||
300 | for (busnr = start; busnr <= end; busnr++) { | |
301 | if (!pci_find_bus(pci_domain_nr(parent), | |
302 | busnr)) | |
303 | break; | |
304 | } | |
305 | if (busnr >= end) { | |
306 | err("No free bus for hot-added bridge\n"); | |
307 | pci_dev_put(dev); | |
308 | continue; | |
309 | } | |
310 | child = pci_add_new_bus(parent, dev, busnr); | |
311 | if (!child) { | |
312 | err("Cannot add new bus for %s\n", | |
313 | pci_name(dev)); | |
314 | pci_dev_put(dev); | |
315 | continue; | |
316 | } | |
317 | child->subordinate = pci_do_scan_bus(child); | |
318 | pci_bus_size_bridges(child); | |
319 | } | |
320 | pci_dev_put(dev); | |
1da177e4 LT |
321 | } |
322 | ||
cc702c2c SM |
323 | pci_bus_assign_resources(parent); |
324 | pci_bus_add_devices(parent); | |
325 | pci_enable_bridges(parent); | |
43b7d7cf | 326 | |
43b7d7cf SM |
327 | dbg("%s - exit", __FUNCTION__); |
328 | return 0; | |
1da177e4 LT |
329 | } |
330 | ||
331 | int cpci_unconfigure_slot(struct slot* slot) | |
332 | { | |
1da177e4 | 333 | int i; |
1da177e4 LT |
334 | struct pci_dev *dev; |
335 | ||
336 | dbg("%s - enter", __FUNCTION__); | |
bcc488ab | 337 | if (!slot->dev) { |
1da177e4 LT |
338 | err("No device for slot %02x\n", slot->number); |
339 | return -ENODEV; | |
340 | } | |
341 | ||
1da177e4 | 342 | for (i = 0; i < 8; i++) { |
bcc488ab | 343 | dev = pci_get_slot(slot->bus, |
1da177e4 | 344 | PCI_DEVFN(PCI_SLOT(slot->devfn), i)); |
bcc488ab | 345 | if (dev) { |
43b7d7cf | 346 | pci_remove_bus_device(dev); |
03e49d40 | 347 | pci_dev_put(dev); |
1da177e4 LT |
348 | } |
349 | } | |
03e49d40 SM |
350 | pci_dev_put(slot->dev); |
351 | slot->dev = NULL; | |
352 | ||
43b7d7cf SM |
353 | dbg("%s - exit", __FUNCTION__); |
354 | return 0; | |
1da177e4 | 355 | } |