Commit | Line | Data |
---|---|---|
1da177e4 LT |
1 | /* |
2 | * pci_dn.c | |
3 | * | |
4 | * Copyright (C) 2001 Todd Inglett, IBM Corporation | |
5 | * | |
6 | * PCI manipulation via device_nodes. | |
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 | |
11 | * (at your option) any later version. | |
12 | * | |
13 | * This program is distributed in the hope that it will be useful, | |
14 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | |
15 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
16 | * GNU General Public License for more details. | |
17 | * | |
18 | * You should have received a copy of the GNU General Public License | |
19 | * along with this program; if not, write to the Free Software | |
20 | * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA | |
21 | */ | |
22 | #include <linux/kernel.h> | |
23 | #include <linux/pci.h> | |
24 | #include <linux/string.h> | |
66b15db6 | 25 | #include <linux/export.h> |
1da177e4 | 26 | #include <linux/init.h> |
5a0e3ad6 | 27 | #include <linux/gfp.h> |
1da177e4 LT |
28 | |
29 | #include <asm/io.h> | |
30 | #include <asm/prom.h> | |
31 | #include <asm/pci-bridge.h> | |
d387899f | 32 | #include <asm/ppc-pci.h> |
095eed4f | 33 | #include <asm/firmware.h> |
d468fcaf | 34 | #include <asm/eeh.h> |
1da177e4 | 35 | |
cca87d30 GS |
36 | /* |
37 | * The function is used to find the firmware data of one | |
38 | * specific PCI device, which is attached to the indicated | |
39 | * PCI bus. For VFs, their firmware data is linked to that | |
40 | * one of PF's bridge. For other devices, their firmware | |
41 | * data is linked to that of their bridge. | |
42 | */ | |
43 | static struct pci_dn *pci_bus_to_pdn(struct pci_bus *bus) | |
44 | { | |
45 | struct pci_bus *pbus; | |
46 | struct device_node *dn; | |
47 | struct pci_dn *pdn; | |
48 | ||
49 | /* | |
50 | * We probably have virtual bus which doesn't | |
51 | * have associated bridge. | |
52 | */ | |
53 | pbus = bus; | |
54 | while (pbus) { | |
55 | if (pci_is_root_bus(pbus) || pbus->self) | |
56 | break; | |
57 | ||
58 | pbus = pbus->parent; | |
59 | } | |
60 | ||
61 | /* | |
62 | * Except virtual bus, all PCI buses should | |
63 | * have device nodes. | |
64 | */ | |
65 | dn = pci_bus_to_OF_node(pbus); | |
66 | pdn = dn ? PCI_DN(dn) : NULL; | |
67 | ||
68 | return pdn; | |
69 | } | |
70 | ||
71 | struct pci_dn *pci_get_pdn_by_devfn(struct pci_bus *bus, | |
72 | int devfn) | |
73 | { | |
74 | struct device_node *dn = NULL; | |
75 | struct pci_dn *parent, *pdn; | |
76 | struct pci_dev *pdev = NULL; | |
77 | ||
78 | /* Fast path: fetch from PCI device */ | |
79 | list_for_each_entry(pdev, &bus->devices, bus_list) { | |
80 | if (pdev->devfn == devfn) { | |
81 | if (pdev->dev.archdata.pci_data) | |
82 | return pdev->dev.archdata.pci_data; | |
83 | ||
84 | dn = pci_device_to_OF_node(pdev); | |
85 | break; | |
86 | } | |
87 | } | |
88 | ||
89 | /* Fast path: fetch from device node */ | |
90 | pdn = dn ? PCI_DN(dn) : NULL; | |
91 | if (pdn) | |
92 | return pdn; | |
93 | ||
94 | /* Slow path: fetch from firmware data hierarchy */ | |
95 | parent = pci_bus_to_pdn(bus); | |
96 | if (!parent) | |
97 | return NULL; | |
98 | ||
99 | list_for_each_entry(pdn, &parent->child_list, list) { | |
100 | if (pdn->busno == bus->number && | |
101 | pdn->devfn == devfn) | |
102 | return pdn; | |
103 | } | |
104 | ||
105 | return NULL; | |
106 | } | |
107 | ||
b72c1f65 BH |
108 | struct pci_dn *pci_get_pdn(struct pci_dev *pdev) |
109 | { | |
cca87d30 GS |
110 | struct device_node *dn; |
111 | struct pci_dn *parent, *pdn; | |
112 | ||
113 | /* Search device directly */ | |
114 | if (pdev->dev.archdata.pci_data) | |
115 | return pdev->dev.archdata.pci_data; | |
116 | ||
117 | /* Check device node */ | |
118 | dn = pci_device_to_OF_node(pdev); | |
119 | pdn = dn ? PCI_DN(dn) : NULL; | |
120 | if (pdn) | |
121 | return pdn; | |
122 | ||
123 | /* | |
124 | * VFs don't have device nodes. We hook their | |
125 | * firmware data to PF's bridge. | |
126 | */ | |
127 | parent = pci_bus_to_pdn(pdev->bus); | |
128 | if (!parent) | |
b72c1f65 | 129 | return NULL; |
cca87d30 GS |
130 | |
131 | list_for_each_entry(pdn, &parent->child_list, list) { | |
132 | if (pdn->busno == pdev->bus->number && | |
133 | pdn->devfn == pdev->devfn) | |
134 | return pdn; | |
135 | } | |
136 | ||
137 | return NULL; | |
b72c1f65 BH |
138 | } |
139 | ||
a8b2f828 GS |
140 | #ifdef CONFIG_PCI_IOV |
141 | static struct pci_dn *add_one_dev_pci_data(struct pci_dn *parent, | |
142 | struct pci_dev *pdev, | |
67086e32 | 143 | int vf_index, |
a8b2f828 GS |
144 | int busno, int devfn) |
145 | { | |
146 | struct pci_dn *pdn; | |
147 | ||
148 | /* Except PHB, we always have the parent */ | |
149 | if (!parent) | |
150 | return NULL; | |
151 | ||
152 | pdn = kzalloc(sizeof(*pdn), GFP_KERNEL); | |
153 | if (!pdn) { | |
154 | dev_warn(&pdev->dev, "%s: Out of memory!\n", __func__); | |
155 | return NULL; | |
156 | } | |
157 | ||
158 | pdn->phb = parent->phb; | |
159 | pdn->parent = parent; | |
160 | pdn->busno = busno; | |
161 | pdn->devfn = devfn; | |
162 | #ifdef CONFIG_PPC_POWERNV | |
67086e32 | 163 | pdn->vf_index = vf_index; |
a8b2f828 GS |
164 | pdn->pe_number = IODA_INVALID_PE; |
165 | #endif | |
166 | INIT_LIST_HEAD(&pdn->child_list); | |
167 | INIT_LIST_HEAD(&pdn->list); | |
168 | list_add_tail(&pdn->list, &parent->child_list); | |
169 | ||
170 | /* | |
171 | * If we already have PCI device instance, lets | |
172 | * bind them. | |
173 | */ | |
174 | if (pdev) | |
175 | pdev->dev.archdata.pci_data = pdn; | |
176 | ||
177 | return pdn; | |
178 | } | |
179 | #endif | |
180 | ||
181 | struct pci_dn *add_dev_pci_data(struct pci_dev *pdev) | |
182 | { | |
183 | #ifdef CONFIG_PCI_IOV | |
184 | struct pci_dn *parent, *pdn; | |
185 | int i; | |
186 | ||
187 | /* Only support IOV for now */ | |
188 | if (!pdev->is_physfn) | |
189 | return pci_get_pdn(pdev); | |
190 | ||
191 | /* Check if VFs have been populated */ | |
192 | pdn = pci_get_pdn(pdev); | |
193 | if (!pdn || (pdn->flags & PCI_DN_FLAG_IOV_VF)) | |
194 | return NULL; | |
195 | ||
196 | pdn->flags |= PCI_DN_FLAG_IOV_VF; | |
197 | parent = pci_bus_to_pdn(pdev->bus); | |
198 | if (!parent) | |
199 | return NULL; | |
200 | ||
201 | for (i = 0; i < pci_sriov_get_totalvfs(pdev); i++) { | |
d468fcaf ME |
202 | struct eeh_dev *edev __maybe_unused; |
203 | ||
67086e32 | 204 | pdn = add_one_dev_pci_data(parent, NULL, i, |
a8b2f828 GS |
205 | pci_iov_virtfn_bus(pdev, i), |
206 | pci_iov_virtfn_devfn(pdev, i)); | |
207 | if (!pdn) { | |
208 | dev_warn(&pdev->dev, "%s: Cannot create firmware data for VF#%d\n", | |
209 | __func__, i); | |
210 | return NULL; | |
211 | } | |
39218cd0 | 212 | |
fb36e907 | 213 | #ifdef CONFIG_EEH |
39218cd0 | 214 | /* Create the EEH device for the VF */ |
8cc7581c | 215 | edev = eeh_dev_init(pdn); |
39218cd0 WY |
216 | BUG_ON(!edev); |
217 | edev->physfn = pdev; | |
fb36e907 | 218 | #endif /* CONFIG_EEH */ |
a8b2f828 GS |
219 | } |
220 | #endif /* CONFIG_PCI_IOV */ | |
221 | ||
222 | return pci_get_pdn(pdev); | |
223 | } | |
224 | ||
225 | void remove_dev_pci_data(struct pci_dev *pdev) | |
226 | { | |
227 | #ifdef CONFIG_PCI_IOV | |
228 | struct pci_dn *parent; | |
229 | struct pci_dn *pdn, *tmp; | |
230 | int i; | |
231 | ||
781a868f WY |
232 | /* |
233 | * VF and VF PE are created/released dynamically, so we need to | |
234 | * bind/unbind them. Otherwise the VF and VF PE would be mismatched | |
235 | * when re-enabling SR-IOV. | |
236 | */ | |
237 | if (pdev->is_virtfn) { | |
238 | pdn = pci_get_pdn(pdev); | |
239 | #ifdef CONFIG_PPC_POWERNV | |
240 | pdn->pe_number = IODA_INVALID_PE; | |
241 | #endif | |
242 | return; | |
243 | } | |
244 | ||
a8b2f828 GS |
245 | /* Only support IOV PF for now */ |
246 | if (!pdev->is_physfn) | |
247 | return; | |
248 | ||
249 | /* Check if VFs have been populated */ | |
250 | pdn = pci_get_pdn(pdev); | |
251 | if (!pdn || !(pdn->flags & PCI_DN_FLAG_IOV_VF)) | |
252 | return; | |
253 | ||
254 | pdn->flags &= ~PCI_DN_FLAG_IOV_VF; | |
255 | parent = pci_bus_to_pdn(pdev->bus); | |
256 | if (!parent) | |
257 | return; | |
258 | ||
259 | /* | |
260 | * We might introduce flag to pci_dn in future | |
261 | * so that we can release VF's firmware data in | |
262 | * a batch mode. | |
263 | */ | |
264 | for (i = 0; i < pci_sriov_get_totalvfs(pdev); i++) { | |
d468fcaf ME |
265 | struct eeh_dev *edev __maybe_unused; |
266 | ||
a8b2f828 GS |
267 | list_for_each_entry_safe(pdn, tmp, |
268 | &parent->child_list, list) { | |
269 | if (pdn->busno != pci_iov_virtfn_bus(pdev, i) || | |
270 | pdn->devfn != pci_iov_virtfn_devfn(pdev, i)) | |
271 | continue; | |
272 | ||
fb36e907 | 273 | #ifdef CONFIG_EEH |
39218cd0 WY |
274 | /* Release EEH device for the VF */ |
275 | edev = pdn_to_eeh_dev(pdn); | |
276 | if (edev) { | |
277 | pdn->edev = NULL; | |
278 | kfree(edev); | |
279 | } | |
fb36e907 | 280 | #endif /* CONFIG_EEH */ |
39218cd0 | 281 | |
a8b2f828 GS |
282 | if (!list_empty(&pdn->list)) |
283 | list_del(&pdn->list); | |
284 | ||
285 | kfree(pdn); | |
286 | } | |
287 | } | |
288 | #endif /* CONFIG_PCI_IOV */ | |
289 | } | |
290 | ||
d8f66f41 GS |
291 | struct pci_dn *pci_add_device_node_info(struct pci_controller *hose, |
292 | struct device_node *dn) | |
1da177e4 | 293 | { |
c6296b96 AB |
294 | const __be32 *type = of_get_property(dn, "ibm,pci-config-space-type", NULL); |
295 | const __be32 *regs; | |
cca87d30 | 296 | struct device_node *parent; |
1635317f | 297 | struct pci_dn *pdn; |
8cc7581c GS |
298 | #ifdef CONFIG_EEH |
299 | struct eeh_dev *edev; | |
300 | #endif | |
1635317f | 301 | |
8cc7581c | 302 | pdn = kzalloc(sizeof(*pdn), GFP_KERNEL); |
1635317f PM |
303 | if (pdn == NULL) |
304 | return NULL; | |
1635317f PM |
305 | dn->data = pdn; |
306 | pdn->node = dn; | |
d8f66f41 | 307 | pdn->phb = hose; |
184cd4a3 BH |
308 | #ifdef CONFIG_PPC_POWERNV |
309 | pdn->pe_number = IODA_INVALID_PE; | |
310 | #endif | |
e2eb6392 | 311 | regs = of_get_property(dn, "reg", NULL); |
1da177e4 | 312 | if (regs) { |
c6296b96 AB |
313 | u32 addr = of_read_number(regs, 1); |
314 | ||
1da177e4 | 315 | /* First register entry is addr (00BBSS00) */ |
c6296b96 AB |
316 | pdn->busno = (addr >> 16) & 0xff; |
317 | pdn->devfn = (addr >> 8) & 0xff; | |
1da177e4 LT |
318 | } |
319 | ||
c035ff1d GS |
320 | /* vendor/device IDs and class code */ |
321 | regs = of_get_property(dn, "vendor-id", NULL); | |
322 | pdn->vendor_id = regs ? of_read_number(regs, 1) : 0; | |
323 | regs = of_get_property(dn, "device-id", NULL); | |
324 | pdn->device_id = regs ? of_read_number(regs, 1) : 0; | |
325 | regs = of_get_property(dn, "class-code", NULL); | |
326 | pdn->class_code = regs ? of_read_number(regs, 1) : 0; | |
327 | ||
328 | /* Extended config space */ | |
c6296b96 | 329 | pdn->pci_ext_config_space = (type && of_read_number(type, 1) == 1); |
cca87d30 | 330 | |
8cc7581c GS |
331 | /* Create EEH device */ |
332 | #ifdef CONFIG_EEH | |
333 | edev = eeh_dev_init(pdn); | |
334 | if (!edev) { | |
335 | kfree(pdn); | |
336 | return NULL; | |
337 | } | |
338 | #endif | |
339 | ||
cca87d30 GS |
340 | /* Attach to parent node */ |
341 | INIT_LIST_HEAD(&pdn->child_list); | |
342 | INIT_LIST_HEAD(&pdn->list); | |
343 | parent = of_get_parent(dn); | |
344 | pdn->parent = parent ? PCI_DN(parent) : NULL; | |
345 | if (pdn->parent) | |
346 | list_add_tail(&pdn->list, &pdn->parent->child_list); | |
347 | ||
d8f66f41 | 348 | return pdn; |
1da177e4 | 349 | } |
d8f66f41 | 350 | EXPORT_SYMBOL_GPL(pci_add_device_node_info); |
1da177e4 | 351 | |
de5a28ac GS |
352 | void pci_remove_device_node_info(struct device_node *dn) |
353 | { | |
354 | struct pci_dn *pdn = dn ? PCI_DN(dn) : NULL; | |
355 | #ifdef CONFIG_EEH | |
356 | struct eeh_dev *edev = pdn_to_eeh_dev(pdn); | |
357 | ||
358 | if (edev) | |
359 | edev->pdn = NULL; | |
360 | #endif | |
361 | ||
362 | if (!pdn) | |
363 | return; | |
364 | ||
365 | WARN_ON(!list_empty(&pdn->child_list)); | |
366 | list_del(&pdn->list); | |
367 | if (pdn->parent) | |
368 | of_node_put(pdn->parent->node); | |
369 | ||
370 | dn->data = NULL; | |
371 | kfree(pdn); | |
372 | } | |
373 | EXPORT_SYMBOL_GPL(pci_remove_device_node_info); | |
374 | ||
1da177e4 LT |
375 | /* |
376 | * Traverse a device tree stopping each PCI device in the tree. | |
377 | * This is done depth first. As each node is processed, a "pre" | |
378 | * function is called and the children are processed recursively. | |
379 | * | |
380 | * The "pre" func returns a value. If non-zero is returned from | |
381 | * the "pre" func, the traversal stops and this value is returned. | |
382 | * This return value is useful when using traverse as a method of | |
383 | * finding a device. | |
384 | * | |
385 | * NOTE: we do not run the func for devices that do not appear to | |
386 | * be PCI except for the start node which we assume (this is good | |
387 | * because the start node is often a phb which may be missing PCI | |
388 | * properties). | |
389 | * We use the class-code as an indicator. If we run into | |
390 | * one of these nodes we also assume its siblings are non-pci for | |
391 | * performance. | |
392 | */ | |
cdddc577 GS |
393 | void *pci_traverse_device_nodes(struct device_node *start, |
394 | void *(*fn)(struct device_node *, void *), | |
395 | void *data) | |
1da177e4 LT |
396 | { |
397 | struct device_node *dn, *nextdn; | |
398 | void *ret; | |
399 | ||
400 | /* We started with a phb, iterate all childs */ | |
401 | for (dn = start->child; dn; dn = nextdn) { | |
c6296b96 AB |
402 | const __be32 *classp; |
403 | u32 class = 0; | |
1da177e4 LT |
404 | |
405 | nextdn = NULL; | |
e2eb6392 | 406 | classp = of_get_property(dn, "class-code", NULL); |
c6296b96 AB |
407 | if (classp) |
408 | class = of_read_number(classp, 1); | |
1da177e4 | 409 | |
cdddc577 GS |
410 | if (fn) { |
411 | ret = fn(dn, data); | |
412 | if (ret) | |
413 | return ret; | |
414 | } | |
1da177e4 LT |
415 | |
416 | /* If we are a PCI bridge, go down */ | |
417 | if (dn->child && ((class >> 8) == PCI_CLASS_BRIDGE_PCI || | |
418 | (class >> 8) == PCI_CLASS_BRIDGE_CARDBUS)) | |
419 | /* Depth first...do children */ | |
420 | nextdn = dn->child; | |
421 | else if (dn->sibling) | |
422 | /* ok, try next sibling instead. */ | |
423 | nextdn = dn->sibling; | |
424 | if (!nextdn) { | |
425 | /* Walk up to next valid sibling. */ | |
426 | do { | |
427 | dn = dn->parent; | |
428 | if (dn == start) | |
429 | return NULL; | |
430 | } while (dn->sibling == NULL); | |
431 | nextdn = dn->sibling; | |
432 | } | |
433 | } | |
434 | return NULL; | |
435 | } | |
cdddc577 | 436 | EXPORT_SYMBOL_GPL(pci_traverse_device_nodes); |
1da177e4 | 437 | |
e8e9b34c GS |
438 | static struct pci_dn *pci_dn_next_one(struct pci_dn *root, |
439 | struct pci_dn *pdn) | |
440 | { | |
441 | struct list_head *next = pdn->child_list.next; | |
442 | ||
443 | if (next != &pdn->child_list) | |
444 | return list_entry(next, struct pci_dn, list); | |
445 | ||
446 | while (1) { | |
447 | if (pdn == root) | |
448 | return NULL; | |
449 | ||
450 | next = pdn->list.next; | |
451 | if (next != &pdn->parent->child_list) | |
452 | break; | |
453 | ||
454 | pdn = pdn->parent; | |
455 | } | |
456 | ||
457 | return list_entry(next, struct pci_dn, list); | |
458 | } | |
459 | ||
460 | void *traverse_pci_dn(struct pci_dn *root, | |
461 | void *(*fn)(struct pci_dn *, void *), | |
462 | void *data) | |
463 | { | |
464 | struct pci_dn *pdn = root; | |
465 | void *ret; | |
466 | ||
467 | /* Only scan the child nodes */ | |
468 | for (pdn = pci_dn_next_one(root, pdn); pdn; | |
469 | pdn = pci_dn_next_one(root, pdn)) { | |
470 | ret = fn(pdn, data); | |
471 | if (ret) | |
472 | return ret; | |
473 | } | |
474 | ||
475 | return NULL; | |
476 | } | |
477 | ||
d8f66f41 GS |
478 | static void *add_pdn(struct device_node *dn, void *data) |
479 | { | |
480 | struct pci_controller *hose = data; | |
481 | struct pci_dn *pdn; | |
482 | ||
483 | pdn = pci_add_device_node_info(hose, dn); | |
484 | if (!pdn) | |
485 | return ERR_PTR(-ENOMEM); | |
486 | ||
487 | return NULL; | |
488 | } | |
489 | ||
18126f35 LV |
490 | /** |
491 | * pci_devs_phb_init_dynamic - setup pci devices under this PHB | |
492 | * phb: pci-to-host bridge (top-level bridge connecting to cpu) | |
493 | * | |
494 | * This routine is called both during boot, (before the memory | |
495 | * subsystem is set up, before kmalloc is valid) and during the | |
496 | * dynamic lpar operation of adding a PHB to a running system. | |
497 | */ | |
cad5cef6 | 498 | void pci_devs_phb_init_dynamic(struct pci_controller *phb) |
1da177e4 | 499 | { |
44ef3390 | 500 | struct device_node *dn = phb->dn; |
1635317f | 501 | struct pci_dn *pdn; |
1da177e4 LT |
502 | |
503 | /* PHB nodes themselves must not match */ | |
d8f66f41 | 504 | pdn = pci_add_device_node_info(phb, dn); |
cca87d30 | 505 | if (pdn) { |
1635317f | 506 | pdn->devfn = pdn->busno = -1; |
c035ff1d | 507 | pdn->vendor_id = pdn->device_id = pdn->class_code = 0; |
cca87d30 GS |
508 | pdn->phb = phb; |
509 | phb->pci_data = pdn; | |
510 | } | |
1da177e4 LT |
511 | |
512 | /* Update dn->phb ptrs for new phb and children devices */ | |
cdddc577 | 513 | pci_traverse_device_nodes(dn, add_pdn, phb); |
1da177e4 LT |
514 | } |
515 | ||
18126f35 LV |
516 | /** |
517 | * pci_devs_phb_init - Initialize phbs and pci devs under them. | |
518 | * | |
519 | * This routine walks over all phb's (pci-host bridges) on the | |
520 | * system, and sets up assorted pci-related structures | |
521 | * (including pci info in the device node structs) for each | |
522 | * pci device found underneath. This routine runs once, | |
523 | * early in the boot sequence. | |
1da177e4 | 524 | */ |
8cc7581c | 525 | static int __init pci_devs_phb_init(void) |
1da177e4 LT |
526 | { |
527 | struct pci_controller *phb, *tmp; | |
528 | ||
529 | /* This must be done first so the device nodes have valid pci info! */ | |
530 | list_for_each_entry_safe(phb, tmp, &hose_list, list_node) | |
531 | pci_devs_phb_init_dynamic(phb); | |
8cc7581c GS |
532 | |
533 | return 0; | |
1da177e4 | 534 | } |
cca87d30 | 535 | |
8cc7581c GS |
536 | core_initcall(pci_devs_phb_init); |
537 | ||
cca87d30 GS |
538 | static void pci_dev_pdn_setup(struct pci_dev *pdev) |
539 | { | |
540 | struct pci_dn *pdn; | |
541 | ||
542 | if (pdev->dev.archdata.pci_data) | |
543 | return; | |
544 | ||
545 | /* Setup the fast path */ | |
546 | pdn = pci_get_pdn(pdev); | |
547 | pdev->dev.archdata.pci_data = pdn; | |
548 | } | |
549 | DECLARE_PCI_FIXUP_EARLY(PCI_ANY_ID, PCI_ANY_ID, pci_dev_pdn_setup); |