![[BACK]](/icons/back.gif){kind=icon}
Return to pci_bus_fixup.c CVS log ![[TXT]](/icons/text.gif){kind=icon}
![[DIR]](/icons/dir.gif){kind=icon}
Up to [local] / sys / arch / i386 / pci|
Return to pci_bus_fixup.c CVS log | Up to [local] / sys / arch / i386 / pci |
1.1 nbrk 1: /* $OpenBSD: pci_bus_fixup.c,v 1.9 2006/08/18 22:18:18 kettenis Exp $ */
2: /* $NetBSD: pci_bus_fixup.c,v 1.1 1999/11/17 07:32:58 thorpej Exp $ */
3:
4: /*
5: * Copyright (c) 1999, by UCHIYAMA Yasushi
6: * All rights reserved.
7: *
8: * Redistribution and use in source and binary forms, with or without
9: * modification, are permitted provided that the following conditions
10: * are met:
11: * 1. Redistributions of source code must retain the above copyright
12: * notice, this list of conditions and the following disclaimer.
13: * 2. The name of the developer may NOT be used to endorse or promote products
14: * derived from this software without specific prior written permission.
15: *
16: * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
17: * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
18: * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
19: * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
20: * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
21: * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
22: * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
23: * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
24: * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
25: * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
26: * SUCH DAMAGE.
27: */
28:
29: /*
30: * PCI bus renumbering support.
31: */
32:
33: #include <sys/param.h>
34: #include <sys/systm.h>
35: #include <sys/kernel.h>
36: #include <sys/device.h>
37:
38: #include <machine/bus.h>
39:
40: #include <dev/pci/pcireg.h>
41: #include <dev/pci/pcivar.h>
42: #include <dev/pci/pcidevs.h>
43: #include <dev/pci/ppbreg.h>
44:
45: #include <i386/pci/pcibiosvar.h>
46:
47: int pci_bus_check(pci_chipset_tag_t, int);
48: int pci_bus_assign(pci_chipset_tag_t, int);
49: void pcibus_print_devid(pci_chipset_tag_t, pcitag_t);
50:
51: int
52: pci_bus_check(pci_chipset_tag_t pc, int bus)
53: {
54: int device, maxdevs, function, nfuncs, bus_max, bus_sub;
55: const struct pci_quirkdata *qd;
56: pcireg_t reg;
57: pcitag_t tag;
58:
59: bus_max = bus;
60:
61: maxdevs = pci_bus_maxdevs(pc, bus);
62: for (device = 0; device < maxdevs; device++) {
63: tag = pci_make_tag(pc, bus, device, 0);
64: reg = pci_conf_read(pc, tag, PCI_ID_REG);
65:
66: /* can't be that many */
67: if (bus_max == 255)
68: break;
69:
70: /* Invalid vendor ID value? */
71: if (PCI_VENDOR(reg) == PCI_VENDOR_INVALID)
72: continue;
73: /* XXX Not invalid, but we've done this ~forever. */
74: if (PCI_VENDOR(reg) == 0)
75: continue;
76:
77: qd = pci_lookup_quirkdata(PCI_VENDOR(reg), PCI_PRODUCT(reg));
78:
79: reg = pci_conf_read(pc, tag, PCI_BHLC_REG);
80: if (PCI_HDRTYPE_MULTIFN(reg) ||
81: (qd != NULL &&
82: (qd->quirks & PCI_QUIRK_MULTIFUNCTION) != 0))
83: nfuncs = 8;
84: else
85: nfuncs = 1;
86:
87: for (function = 0; function < nfuncs; function++) {
88: tag = pci_make_tag(pc, bus, device, function);
89: reg = pci_conf_read(pc, tag, PCI_ID_REG);
90:
91: /* Invalid vendor ID value? */
92: if (PCI_VENDOR(reg) == PCI_VENDOR_INVALID)
93: continue;
94: /* XXX Not invalid, but we've done this ~forever. */
95: if (PCI_VENDOR(reg) == 0)
96: continue;
97:
98: reg = pci_conf_read(pc, tag, PCI_CLASS_REG);
99: if (PCI_CLASS(reg) == PCI_CLASS_BRIDGE &&
100: (PCI_SUBCLASS(reg) == PCI_SUBCLASS_BRIDGE_PCI ||
101: PCI_SUBCLASS(reg) == PCI_SUBCLASS_BRIDGE_CARDBUS)) {
102:
103: reg = pci_conf_read(pc, tag, PPB_REG_BUSINFO);
104: if (PPB_BUSINFO_PRIMARY(reg) != bus) {
105: if (pcibios_flags & PCIBIOS_VERBOSE) {
106: pcibus_print_devid(pc, tag);
107: printf("Mismatched primary bus: "
108: "primary %d, secondary %d, "
109: "subordinate %d\n",
110: PPB_BUSINFO_PRIMARY(reg),
111: PPB_BUSINFO_SECONDARY(reg),
112: PPB_BUSINFO_SUBORDINATE(reg));
113: }
114: return (-1);
115: }
116: if (PPB_BUSINFO_SECONDARY(reg) <= bus) {
117: if (pcibios_flags & PCIBIOS_VERBOSE) {
118: pcibus_print_devid(pc, tag);
119: printf("Incorrect secondary bus: "
120: "primary %d, secondary %d, "
121: "subordinate %d\n",
122: PPB_BUSINFO_PRIMARY(reg),
123: PPB_BUSINFO_SECONDARY(reg),
124: PPB_BUSINFO_SUBORDINATE(reg));
125: }
126: return (-1);
127: }
128:
129: /* Scan subordinate bus. */
130: bus_sub = pci_bus_check(pc,
131: PPB_BUSINFO_SECONDARY(reg));
132: if (bus_sub == -1)
133: return (-1);
134:
135: if (PPB_BUSINFO_SUBORDINATE(reg) < bus_sub) {
136: if (pcibios_flags & PCIBIOS_VERBOSE) {
137: pcibus_print_devid(pc, tag);
138: printf("Incorrect subordinate bus %d: "
139: "primary %d, secondary %d, "
140: "subordinate %d\n", bus_sub,
141: PPB_BUSINFO_PRIMARY(reg),
142: PPB_BUSINFO_SECONDARY(reg),
143: PPB_BUSINFO_SUBORDINATE(reg));
144: }
145: return (-1);
146: }
147:
148: bus_max = (bus_sub > bus_max) ?
149: bus_sub : bus_max;
150: }
151: }
152: }
153:
154: return (bus_max); /* last # of subordinate bus */
155: }
156:
157: int
158: pci_bus_assign(pci_chipset_tag_t pc, int bus)
159: {
160: static int bridge_cnt;
161: int bridge, device, maxdevs, function, nfuncs, bus_max, bus_sub;
162: const struct pci_quirkdata *qd;
163: pcireg_t reg;
164: pcitag_t tag;
165:
166: bus_max = bus;
167:
168: maxdevs = pci_bus_maxdevs(pc, bus);
169: for (device = 0; device < maxdevs; device++) {
170: tag = pci_make_tag(pc, bus, device, 0);
171: reg = pci_conf_read(pc, tag, PCI_ID_REG);
172:
173: /* can't be that many */
174: if (bus_max == 255)
175: break;
176:
177: /* Invalid vendor ID value? */
178: if (PCI_VENDOR(reg) == PCI_VENDOR_INVALID)
179: continue;
180: /* XXX Not invalid, but we've done this ~forever. */
181: if (PCI_VENDOR(reg) == 0)
182: continue;
183:
184: qd = pci_lookup_quirkdata(PCI_VENDOR(reg), PCI_PRODUCT(reg));
185:
186: reg = pci_conf_read(pc, tag, PCI_BHLC_REG);
187: if (PCI_HDRTYPE_MULTIFN(reg) ||
188: (qd != NULL &&
189: (qd->quirks & PCI_QUIRK_MULTIFUNCTION) != 0))
190: nfuncs = 8;
191: else
192: nfuncs = 1;
193:
194: for (function = 0; function < nfuncs; function++) {
195: tag = pci_make_tag(pc, bus, device, function);
196: reg = pci_conf_read(pc, tag, PCI_ID_REG);
197:
198: /* Invalid vendor ID value? */
199: if (PCI_VENDOR(reg) == PCI_VENDOR_INVALID)
200: continue;
201: /* XXX Not invalid, but we've done this ~forever. */
202: if (PCI_VENDOR(reg) == 0)
203: continue;
204:
205: reg = pci_conf_read(pc, tag, PCI_CLASS_REG);
206: if (PCI_CLASS(reg) == PCI_CLASS_BRIDGE &&
207: (PCI_SUBCLASS(reg) == PCI_SUBCLASS_BRIDGE_PCI ||
208: PCI_SUBCLASS(reg) == PCI_SUBCLASS_BRIDGE_CARDBUS)) {
209: /* Assign the bridge's secondary bus #. */
210: bus_max++;
211:
212: reg = pci_conf_read(pc, tag, PPB_REG_BUSINFO);
213: reg &= 0xff000000;
214: reg |= bus | (bus_max << 8) | (0xff << 16);
215: pci_conf_write(pc, tag, PPB_REG_BUSINFO, reg);
216:
217: /* Scan subordinate bus. */
218: bus_sub = pci_bus_assign(pc, bus_max);
219:
220: /* Configure the bridge. */
221: reg &= 0xff000000;
222: reg |= bus | (bus_max << 8) | (bus_sub << 16);
223: pci_conf_write(pc, tag, PPB_REG_BUSINFO, reg);
224:
225: if (pcibios_flags & PCIBIOS_VERBOSE) {
226: /* Assign the bridge #. */
227: bridge = bridge_cnt++;
228:
229: printf("PCI bridge %d: primary %d, "
230: "secondary %d, subordinate %d\n",
231: bridge, bus, bus_max, bus_sub);
232: }
233:
234: /* Next bridge's secondary bus #. */
235: bus_max = (bus_sub > bus_max) ?
236: bus_sub : bus_max;
237: }
238: }
239: }
240:
241: return (bus_max); /* last # of subordinate bus */
242: }
243:
244: int
245: pci_bus_fixup(pci_chipset_tag_t pc, int bus)
246: {
247: int bus_max;
248:
249: bus_max = pci_bus_check(pc, bus);
250: if (bus_max != -1)
251: return (bus_max);
252:
253: if (pcibios_flags & PCIBIOS_VERBOSE)
254: printf("PCI bus renumbering needed\n");
255: return pci_bus_assign(pc, bus);
256: }
257:
258: void
259: pcibus_print_devid(pci_chipset_tag_t pc, pcitag_t tag)
260: {
261: int bus, device, function;
262: pcireg_t id;
263:
264: id = pci_conf_read(pc, tag, PCI_ID_REG);
265: pci_decompose_tag(pc, tag, &bus, &device, &function);
266: printf("%03d:%02d:%d %04x:%04x\n", bus, device, function,
267: PCI_VENDOR(id), PCI_PRODUCT(id));
268: }