change pci hotplug subsystem maintainer to Kristen
[deliverable/linux.git] / drivers / pci / hotplug / cpci_hotplug_pci.c
CommitLineData
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
36extern 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
51u8 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
71int 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
98u16 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
116int 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
145int 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
166int 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
192int 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
221int 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
255int 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
331int 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}
This page took 0.193349 seconds and 5 git commands to generate.