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