pci_map.c revision 1.41 1 1.41 skrll /* $NetBSD: pci_map.c,v 1.41 2020/12/28 12:38:44 skrll Exp $ */
2 1.1 mycroft
3 1.5 mycroft /*-
4 1.7 thorpej * Copyright (c) 1998, 2000 The NetBSD Foundation, Inc.
5 1.5 mycroft * All rights reserved.
6 1.5 mycroft *
7 1.5 mycroft * This code is derived from software contributed to The NetBSD Foundation
8 1.7 thorpej * by Charles M. Hannum; by William R. Studenmund; by Jason R. Thorpe.
9 1.1 mycroft *
10 1.1 mycroft * Redistribution and use in source and binary forms, with or without
11 1.1 mycroft * modification, are permitted provided that the following conditions
12 1.1 mycroft * are met:
13 1.1 mycroft * 1. Redistributions of source code must retain the above copyright
14 1.1 mycroft * notice, this list of conditions and the following disclaimer.
15 1.1 mycroft * 2. Redistributions in binary form must reproduce the above copyright
16 1.1 mycroft * notice, this list of conditions and the following disclaimer in the
17 1.1 mycroft * documentation and/or other materials provided with the distribution.
18 1.1 mycroft *
19 1.5 mycroft * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
20 1.5 mycroft * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
21 1.5 mycroft * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
22 1.5 mycroft * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
23 1.5 mycroft * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
24 1.5 mycroft * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
25 1.5 mycroft * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
26 1.5 mycroft * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
27 1.5 mycroft * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
28 1.5 mycroft * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
29 1.5 mycroft * POSSIBILITY OF SUCH DAMAGE.
30 1.1 mycroft */
31 1.1 mycroft
32 1.1 mycroft /*
33 1.1 mycroft * PCI device mapping.
34 1.1 mycroft */
35 1.10 lukem
36 1.10 lukem #include <sys/cdefs.h>
37 1.41 skrll __KERNEL_RCSID(0, "$NetBSD: pci_map.c,v 1.41 2020/12/28 12:38:44 skrll Exp $");
38 1.1 mycroft
39 1.1 mycroft #include <sys/param.h>
40 1.1 mycroft #include <sys/systm.h>
41 1.1 mycroft #include <sys/device.h>
42 1.1 mycroft
43 1.1 mycroft #include <dev/pci/pcireg.h>
44 1.1 mycroft #include <dev/pci/pcivar.h>
45 1.1 mycroft
46 1.36 jakllsch bool pci_mapreg_map_enable_decode = true;
47 1.35 jakllsch
48 1.1 mycroft static int
49 1.18 christos pci_io_find(pci_chipset_tag_t pc, pcitag_t tag, int reg, pcireg_t type,
50 1.9 thorpej bus_addr_t *basep, bus_size_t *sizep, int *flagsp)
51 1.1 mycroft {
52 1.40 bouyer pcireg_t address, mask, csr;
53 1.1 mycroft int s;
54 1.1 mycroft
55 1.8 thorpej if (reg < PCI_MAPREG_START ||
56 1.8 thorpej #if 0
57 1.8 thorpej /*
58 1.8 thorpej * Can't do this check; some devices have mapping registers
59 1.8 thorpej * way out in left field.
60 1.8 thorpej */
61 1.8 thorpej reg >= PCI_MAPREG_END ||
62 1.8 thorpej #endif
63 1.8 thorpej (reg & 3))
64 1.1 mycroft panic("pci_io_find: bad request");
65 1.1 mycroft
66 1.1 mycroft /*
67 1.1 mycroft * Section 6.2.5.1, `Address Maps', tells us that:
68 1.1 mycroft *
69 1.1 mycroft * 1) The builtin software should have already mapped the device in a
70 1.1 mycroft * reasonable way.
71 1.1 mycroft *
72 1.1 mycroft * 2) A device which wants 2^n bytes of memory will hardwire the bottom
73 1.1 mycroft * n bits of the address to 0. As recommended, we write all 1s and see
74 1.1 mycroft * what we get back.
75 1.1 mycroft */
76 1.1 mycroft s = splhigh();
77 1.1 mycroft address = pci_conf_read(pc, tag, reg);
78 1.40 bouyer /*
79 1.40 bouyer * Disable decoding via the command register before writing to the
80 1.40 bouyer * BAR register. Changing the decoding address to all-one is
81 1.40 bouyer * not a valid address and could have side effects.
82 1.40 bouyer */
83 1.40 bouyer csr = pci_conf_read(pc, tag, PCI_COMMAND_STATUS_REG);
84 1.40 bouyer pci_conf_write(pc, tag, PCI_COMMAND_STATUS_REG,
85 1.40 bouyer csr & ~PCI_COMMAND_IO_ENABLE) ;
86 1.1 mycroft pci_conf_write(pc, tag, reg, 0xffffffff);
87 1.1 mycroft mask = pci_conf_read(pc, tag, reg);
88 1.1 mycroft pci_conf_write(pc, tag, reg, address);
89 1.40 bouyer pci_conf_write(pc, tag, PCI_COMMAND_STATUS_REG, csr);
90 1.1 mycroft splx(s);
91 1.1 mycroft
92 1.1 mycroft if (PCI_MAPREG_TYPE(address) != PCI_MAPREG_TYPE_IO) {
93 1.22 jmcneill aprint_debug("pci_io_find: expected type i/o, found mem\n");
94 1.25 dyoung return 1;
95 1.1 mycroft }
96 1.1 mycroft
97 1.2 mycroft if (PCI_MAPREG_IO_SIZE(mask) == 0) {
98 1.19 macallan aprint_debug("pci_io_find: void region\n");
99 1.25 dyoung return 1;
100 1.2 mycroft }
101 1.2 mycroft
102 1.25 dyoung if (basep != NULL)
103 1.1 mycroft *basep = PCI_MAPREG_IO_ADDR(address);
104 1.25 dyoung if (sizep != NULL)
105 1.1 mycroft *sizep = PCI_MAPREG_IO_SIZE(mask);
106 1.25 dyoung if (flagsp != NULL)
107 1.1 mycroft *flagsp = 0;
108 1.1 mycroft
109 1.25 dyoung return 0;
110 1.1 mycroft }
111 1.1 mycroft
112 1.1 mycroft static int
113 1.9 thorpej pci_mem_find(pci_chipset_tag_t pc, pcitag_t tag, int reg, pcireg_t type,
114 1.9 thorpej bus_addr_t *basep, bus_size_t *sizep, int *flagsp)
115 1.1 mycroft {
116 1.7 thorpej pcireg_t address, mask, address1 = 0, mask1 = 0xffffffff;
117 1.37 msaitoh uint64_t waddress, wmask;
118 1.15 gdamore int s, is64bit, isrom;
119 1.40 bouyer pcireg_t csr;
120 1.7 thorpej
121 1.7 thorpej is64bit = (PCI_MAPREG_MEM_TYPE(type) == PCI_MAPREG_MEM_TYPE_64BIT);
122 1.15 gdamore isrom = (reg == PCI_MAPREG_ROM);
123 1.1 mycroft
124 1.15 gdamore if ((!isrom) && (reg < PCI_MAPREG_START ||
125 1.8 thorpej #if 0
126 1.8 thorpej /*
127 1.8 thorpej * Can't do this check; some devices have mapping registers
128 1.8 thorpej * way out in left field.
129 1.8 thorpej */
130 1.8 thorpej reg >= PCI_MAPREG_END ||
131 1.8 thorpej #endif
132 1.15 gdamore (reg & 3)))
133 1.7 thorpej panic("pci_mem_find: bad request");
134 1.7 thorpej
135 1.7 thorpej if (is64bit && (reg + 4) >= PCI_MAPREG_END)
136 1.7 thorpej panic("pci_mem_find: bad 64-bit request");
137 1.1 mycroft
138 1.1 mycroft /*
139 1.1 mycroft * Section 6.2.5.1, `Address Maps', tells us that:
140 1.1 mycroft *
141 1.1 mycroft * 1) The builtin software should have already mapped the device in a
142 1.1 mycroft * reasonable way.
143 1.1 mycroft *
144 1.1 mycroft * 2) A device which wants 2^n bytes of memory will hardwire the bottom
145 1.1 mycroft * n bits of the address to 0. As recommended, we write all 1s and see
146 1.30 matt * what we get back. Only probe the upper BAR of a mem64 BAR if bit 31
147 1.30 matt * is readonly.
148 1.1 mycroft */
149 1.1 mycroft s = splhigh();
150 1.1 mycroft address = pci_conf_read(pc, tag, reg);
151 1.40 bouyer csr = pci_conf_read(pc, tag, PCI_COMMAND_STATUS_REG);
152 1.40 bouyer /*
153 1.40 bouyer * Disable decoding via the command register before writing to the
154 1.40 bouyer * BAR register. Changing the decoding address to all-one is
155 1.40 bouyer * not a valid address and could have side effects.
156 1.40 bouyer */
157 1.40 bouyer pci_conf_write(pc, tag, PCI_COMMAND_STATUS_REG,
158 1.40 bouyer csr & ~PCI_COMMAND_MEM_ENABLE) ;
159 1.1 mycroft pci_conf_write(pc, tag, reg, 0xffffffff);
160 1.1 mycroft mask = pci_conf_read(pc, tag, reg);
161 1.1 mycroft pci_conf_write(pc, tag, reg, address);
162 1.7 thorpej if (is64bit) {
163 1.7 thorpej address1 = pci_conf_read(pc, tag, reg + 4);
164 1.30 matt if ((mask & 0x80000000) == 0) {
165 1.30 matt pci_conf_write(pc, tag, reg + 4, 0xffffffff);
166 1.30 matt mask1 = pci_conf_read(pc, tag, reg + 4);
167 1.30 matt pci_conf_write(pc, tag, reg + 4, address1);
168 1.30 matt }
169 1.7 thorpej }
170 1.40 bouyer pci_conf_write(pc, tag, PCI_COMMAND_STATUS_REG, csr);
171 1.1 mycroft splx(s);
172 1.1 mycroft
173 1.15 gdamore if (!isrom) {
174 1.15 gdamore /*
175 1.15 gdamore * roms should have an enable bit instead of a memory
176 1.15 gdamore * type decoder bit. For normal BARs, make sure that
177 1.15 gdamore * the address decoder type matches what we asked for.
178 1.15 gdamore */
179 1.15 gdamore if (PCI_MAPREG_TYPE(address) != PCI_MAPREG_TYPE_MEM) {
180 1.15 gdamore printf("pci_mem_find: expected type mem, found i/o\n");
181 1.25 dyoung return 1;
182 1.15 gdamore }
183 1.21 joerg /* XXX Allow 64bit bars for 32bit requests.*/
184 1.15 gdamore if (PCI_MAPREG_MEM_TYPE(address) !=
185 1.21 joerg PCI_MAPREG_MEM_TYPE(type) &&
186 1.21 joerg PCI_MAPREG_MEM_TYPE(address) !=
187 1.21 joerg PCI_MAPREG_MEM_TYPE_64BIT) {
188 1.15 gdamore printf("pci_mem_find: "
189 1.15 gdamore "expected mem type %08x, found %08x\n",
190 1.15 gdamore PCI_MAPREG_MEM_TYPE(type),
191 1.15 gdamore PCI_MAPREG_MEM_TYPE(address));
192 1.25 dyoung return 1;
193 1.15 gdamore }
194 1.2 mycroft }
195 1.2 mycroft
196 1.37 msaitoh waddress = (uint64_t)address1 << 32UL | address;
197 1.37 msaitoh wmask = (uint64_t)mask1 << 32UL | mask;
198 1.7 thorpej
199 1.11 bouyer if ((is64bit && PCI_MAPREG_MEM64_SIZE(wmask) == 0) ||
200 1.11 bouyer (!is64bit && PCI_MAPREG_MEM_SIZE(mask) == 0)) {
201 1.27 jmcneill aprint_debug("pci_mem_find: void region\n");
202 1.25 dyoung return 1;
203 1.1 mycroft }
204 1.1 mycroft
205 1.1 mycroft switch (PCI_MAPREG_MEM_TYPE(address)) {
206 1.1 mycroft case PCI_MAPREG_MEM_TYPE_32BIT:
207 1.1 mycroft case PCI_MAPREG_MEM_TYPE_32BIT_1M:
208 1.1 mycroft break;
209 1.1 mycroft case PCI_MAPREG_MEM_TYPE_64BIT:
210 1.7 thorpej /*
211 1.7 thorpej * Handle the case of a 64-bit memory register on a
212 1.7 thorpej * platform with 32-bit addressing. Make sure that
213 1.7 thorpej * the address assigned and the device's memory size
214 1.7 thorpej * fit in 32 bits. We implicitly assume that if
215 1.7 thorpej * bus_addr_t is 64-bit, then so is bus_size_t.
216 1.7 thorpej */
217 1.37 msaitoh if (sizeof(uint64_t) > sizeof(bus_addr_t) &&
218 1.7 thorpej (address1 != 0 || mask1 != 0xffffffff)) {
219 1.7 thorpej printf("pci_mem_find: 64-bit memory map which is "
220 1.7 thorpej "inaccessible on a 32-bit platform\n");
221 1.25 dyoung return 1;
222 1.7 thorpej }
223 1.7 thorpej break;
224 1.1 mycroft default:
225 1.1 mycroft printf("pci_mem_find: reserved mapping register type\n");
226 1.25 dyoung return 1;
227 1.1 mycroft }
228 1.1 mycroft
229 1.37 msaitoh if (sizeof(uint64_t) > sizeof(bus_addr_t)) {
230 1.25 dyoung if (basep != NULL)
231 1.7 thorpej *basep = PCI_MAPREG_MEM_ADDR(address);
232 1.25 dyoung if (sizep != NULL)
233 1.7 thorpej *sizep = PCI_MAPREG_MEM_SIZE(mask);
234 1.7 thorpej } else {
235 1.25 dyoung if (basep != NULL)
236 1.7 thorpej *basep = PCI_MAPREG_MEM64_ADDR(waddress);
237 1.25 dyoung if (sizep != NULL)
238 1.7 thorpej *sizep = PCI_MAPREG_MEM64_SIZE(wmask);
239 1.7 thorpej }
240 1.25 dyoung if (flagsp != NULL)
241 1.15 gdamore *flagsp = (isrom || PCI_MAPREG_MEM_PREFETCHABLE(address)) ?
242 1.6 drochner BUS_SPACE_MAP_PREFETCHABLE : 0;
243 1.1 mycroft
244 1.25 dyoung return 0;
245 1.7 thorpej }
246 1.7 thorpej
247 1.12 drochner #define _PCI_MAPREG_TYPEBITS(reg) \
248 1.12 drochner (PCI_MAPREG_TYPE(reg) == PCI_MAPREG_TYPE_IO ? \
249 1.12 drochner reg & PCI_MAPREG_TYPE_MASK : \
250 1.12 drochner reg & (PCI_MAPREG_TYPE_MASK|PCI_MAPREG_MEM_TYPE_MASK))
251 1.12 drochner
252 1.7 thorpej pcireg_t
253 1.9 thorpej pci_mapreg_type(pci_chipset_tag_t pc, pcitag_t tag, int reg)
254 1.7 thorpej {
255 1.7 thorpej
256 1.25 dyoung return _PCI_MAPREG_TYPEBITS(pci_conf_read(pc, tag, reg));
257 1.12 drochner }
258 1.12 drochner
259 1.12 drochner int
260 1.12 drochner pci_mapreg_probe(pci_chipset_tag_t pc, pcitag_t tag, int reg, pcireg_t *typep)
261 1.12 drochner {
262 1.40 bouyer pcireg_t address, mask, csr;
263 1.12 drochner int s;
264 1.13 perry
265 1.12 drochner s = splhigh();
266 1.12 drochner address = pci_conf_read(pc, tag, reg);
267 1.40 bouyer /*
268 1.40 bouyer * Disable decoding via the command register before writing to the
269 1.40 bouyer * BAR register. Changing the decoding address to all-one is
270 1.40 bouyer * not a valid address and could have side effects.
271 1.40 bouyer */
272 1.40 bouyer csr = pci_conf_read(pc, tag, PCI_COMMAND_STATUS_REG);
273 1.40 bouyer if (PCI_MAPREG_TYPE(address) == PCI_MAPREG_TYPE_IO) {
274 1.40 bouyer pci_conf_write(pc, tag, PCI_COMMAND_STATUS_REG,
275 1.40 bouyer csr & ~PCI_COMMAND_IO_ENABLE);
276 1.40 bouyer } else {
277 1.40 bouyer pci_conf_write(pc, tag, PCI_COMMAND_STATUS_REG,
278 1.40 bouyer csr & ~PCI_COMMAND_MEM_ENABLE);
279 1.40 bouyer }
280 1.12 drochner pci_conf_write(pc, tag, reg, 0xffffffff);
281 1.12 drochner mask = pci_conf_read(pc, tag, reg);
282 1.12 drochner pci_conf_write(pc, tag, reg, address);
283 1.40 bouyer pci_conf_write(pc, tag, PCI_COMMAND_STATUS_REG, csr);
284 1.12 drochner splx(s);
285 1.12 drochner
286 1.12 drochner if (mask == 0) /* unimplemented mapping register */
287 1.25 dyoung return 0;
288 1.12 drochner
289 1.25 dyoung if (typep != NULL)
290 1.12 drochner *typep = _PCI_MAPREG_TYPEBITS(address);
291 1.25 dyoung return 1;
292 1.1 mycroft }
293 1.1 mycroft
294 1.1 mycroft int
295 1.9 thorpej pci_mapreg_info(pci_chipset_tag_t pc, pcitag_t tag, int reg, pcireg_t type,
296 1.9 thorpej bus_addr_t *basep, bus_size_t *sizep, int *flagsp)
297 1.1 mycroft {
298 1.1 mycroft
299 1.1 mycroft if (PCI_MAPREG_TYPE(type) == PCI_MAPREG_TYPE_IO)
300 1.25 dyoung return pci_io_find(pc, tag, reg, type, basep, sizep,
301 1.25 dyoung flagsp);
302 1.1 mycroft else
303 1.25 dyoung return pci_mem_find(pc, tag, reg, type, basep, sizep,
304 1.25 dyoung flagsp);
305 1.1 mycroft }
306 1.1 mycroft
307 1.1 mycroft int
308 1.28 dyoung pci_mapreg_map(const struct pci_attach_args *pa, int reg, pcireg_t type,
309 1.9 thorpej int busflags, bus_space_tag_t *tagp, bus_space_handle_t *handlep,
310 1.9 thorpej bus_addr_t *basep, bus_size_t *sizep)
311 1.1 mycroft {
312 1.41 skrll return pci_mapreg_submap(pa, reg, type, busflags, 0, 0, tagp,
313 1.24 bjs handlep, basep, sizep);
314 1.24 bjs }
315 1.24 bjs
316 1.32 msaitoh int
317 1.28 dyoung pci_mapreg_submap(const struct pci_attach_args *pa, int reg, pcireg_t type,
318 1.33 msaitoh int busflags, bus_size_t reqsize, bus_size_t offset, bus_space_tag_t *tagp,
319 1.24 bjs bus_space_handle_t *handlep, bus_addr_t *basep, bus_size_t *sizep)
320 1.24 bjs {
321 1.1 mycroft bus_space_tag_t tag;
322 1.1 mycroft bus_space_handle_t handle;
323 1.1 mycroft bus_addr_t base;
324 1.33 msaitoh bus_size_t realmaxsize;
325 1.34 jakllsch pcireg_t csr;
326 1.34 jakllsch int flags, s;
327 1.1 mycroft
328 1.1 mycroft if (PCI_MAPREG_TYPE(type) == PCI_MAPREG_TYPE_IO) {
329 1.29 dyoung if ((pa->pa_flags & PCI_FLAGS_IO_OKAY) == 0)
330 1.25 dyoung return 1;
331 1.1 mycroft if (pci_io_find(pa->pa_pc, pa->pa_tag, reg, type, &base,
332 1.33 msaitoh &realmaxsize, &flags))
333 1.25 dyoung return 1;
334 1.1 mycroft tag = pa->pa_iot;
335 1.1 mycroft } else {
336 1.29 dyoung if ((pa->pa_flags & PCI_FLAGS_MEM_OKAY) == 0)
337 1.25 dyoung return 1;
338 1.1 mycroft if (pci_mem_find(pa->pa_pc, pa->pa_tag, reg, type, &base,
339 1.33 msaitoh &realmaxsize, &flags))
340 1.25 dyoung return 1;
341 1.1 mycroft tag = pa->pa_memt;
342 1.1 mycroft }
343 1.1 mycroft
344 1.15 gdamore if (reg == PCI_MAPREG_ROM) {
345 1.15 gdamore pcireg_t mask;
346 1.15 gdamore /* we have to enable the ROM address decoder... */
347 1.15 gdamore s = splhigh();
348 1.15 gdamore mask = pci_conf_read(pa->pa_pc, pa->pa_tag, reg);
349 1.15 gdamore mask |= PCI_MAPREG_ROM_ENABLE;
350 1.15 gdamore pci_conf_write(pa->pa_pc, pa->pa_tag, reg, mask);
351 1.15 gdamore splx(s);
352 1.15 gdamore }
353 1.15 gdamore
354 1.41 skrll /* If we're called with maxsize/offset of 0, behave like
355 1.24 bjs * pci_mapreg_map.
356 1.24 bjs */
357 1.24 bjs
358 1.33 msaitoh reqsize = (reqsize != 0) ? reqsize : realmaxsize;
359 1.24 bjs base += offset;
360 1.24 bjs
361 1.33 msaitoh if (realmaxsize < (offset + reqsize))
362 1.25 dyoung return 1;
363 1.24 bjs
364 1.38 riastrad if (bus_space_map(tag, base, reqsize, busflags, &handle))
365 1.25 dyoung return 1;
366 1.1 mycroft
367 1.35 jakllsch if (pci_mapreg_map_enable_decode) {
368 1.35 jakllsch s = splhigh();
369 1.35 jakllsch csr = pci_conf_read(pa->pa_pc, pa->pa_tag, PCI_COMMAND_STATUS_REG);
370 1.35 jakllsch csr |= (PCI_MAPREG_TYPE(type) == PCI_MAPREG_TYPE_IO) ?
371 1.35 jakllsch PCI_COMMAND_IO_ENABLE : PCI_COMMAND_MEM_ENABLE;
372 1.35 jakllsch pci_conf_write(pa->pa_pc, pa->pa_tag, PCI_COMMAND_STATUS_REG, csr);
373 1.35 jakllsch splx(s);
374 1.35 jakllsch }
375 1.35 jakllsch
376 1.25 dyoung if (tagp != NULL)
377 1.1 mycroft *tagp = tag;
378 1.25 dyoung if (handlep != NULL)
379 1.1 mycroft *handlep = handle;
380 1.25 dyoung if (basep != NULL)
381 1.1 mycroft *basep = base;
382 1.25 dyoung if (sizep != NULL)
383 1.33 msaitoh *sizep = reqsize;
384 1.1 mycroft
385 1.25 dyoung return 0;
386 1.1 mycroft }
387 1.16 gdamore
388 1.16 gdamore int
389 1.28 dyoung pci_find_rom(const struct pci_attach_args *pa, bus_space_tag_t bst,
390 1.31 riastrad bus_space_handle_t bsh, bus_size_t sz, int type,
391 1.31 riastrad bus_space_handle_t *romh, bus_size_t *romsz)
392 1.16 gdamore {
393 1.31 riastrad bus_size_t offset = 0, imagesz;
394 1.16 gdamore uint16_t ptr;
395 1.16 gdamore int done = 0;
396 1.16 gdamore
397 1.16 gdamore /*
398 1.16 gdamore * no upper bound check; i cannot imagine a 4GB ROM, but
399 1.16 gdamore * it appears the spec would allow it!
400 1.16 gdamore */
401 1.31 riastrad if (sz < 1024)
402 1.16 gdamore return 1;
403 1.16 gdamore
404 1.31 riastrad while (offset < sz && !done){
405 1.16 gdamore struct pci_rom_header hdr;
406 1.16 gdamore struct pci_rom rom;
407 1.16 gdamore
408 1.16 gdamore hdr.romh_magic = bus_space_read_2(bst, bsh,
409 1.16 gdamore offset + offsetof (struct pci_rom_header, romh_magic));
410 1.16 gdamore hdr.romh_data_ptr = bus_space_read_2(bst, bsh,
411 1.16 gdamore offset + offsetof (struct pci_rom_header, romh_data_ptr));
412 1.16 gdamore
413 1.16 gdamore /* no warning: quite possibly ROM is simply not populated */
414 1.16 gdamore if (hdr.romh_magic != PCI_ROM_HEADER_MAGIC)
415 1.16 gdamore return 1;
416 1.16 gdamore
417 1.16 gdamore ptr = offset + hdr.romh_data_ptr;
418 1.41 skrll
419 1.31 riastrad if (ptr > sz) {
420 1.16 gdamore printf("pci_find_rom: rom data ptr out of range\n");
421 1.16 gdamore return 1;
422 1.16 gdamore }
423 1.16 gdamore
424 1.16 gdamore rom.rom_signature = bus_space_read_4(bst, bsh, ptr);
425 1.16 gdamore rom.rom_vendor = bus_space_read_2(bst, bsh, ptr +
426 1.16 gdamore offsetof(struct pci_rom, rom_vendor));
427 1.16 gdamore rom.rom_product = bus_space_read_2(bst, bsh, ptr +
428 1.16 gdamore offsetof(struct pci_rom, rom_product));
429 1.16 gdamore rom.rom_class = bus_space_read_1(bst, bsh,
430 1.16 gdamore ptr + offsetof (struct pci_rom, rom_class));
431 1.16 gdamore rom.rom_subclass = bus_space_read_1(bst, bsh,
432 1.16 gdamore ptr + offsetof (struct pci_rom, rom_subclass));
433 1.16 gdamore rom.rom_interface = bus_space_read_1(bst, bsh,
434 1.16 gdamore ptr + offsetof (struct pci_rom, rom_interface));
435 1.16 gdamore rom.rom_len = bus_space_read_2(bst, bsh,
436 1.16 gdamore ptr + offsetof (struct pci_rom, rom_len));
437 1.16 gdamore rom.rom_code_type = bus_space_read_1(bst, bsh,
438 1.16 gdamore ptr + offsetof (struct pci_rom, rom_code_type));
439 1.16 gdamore rom.rom_indicator = bus_space_read_1(bst, bsh,
440 1.16 gdamore ptr + offsetof (struct pci_rom, rom_indicator));
441 1.16 gdamore
442 1.16 gdamore if (rom.rom_signature != PCI_ROM_SIGNATURE) {
443 1.16 gdamore printf("pci_find_rom: bad rom data signature\n");
444 1.16 gdamore return 1;
445 1.16 gdamore }
446 1.16 gdamore
447 1.16 gdamore imagesz = rom.rom_len * 512;
448 1.16 gdamore
449 1.16 gdamore if ((rom.rom_vendor == PCI_VENDOR(pa->pa_id)) &&
450 1.16 gdamore (rom.rom_product == PCI_PRODUCT(pa->pa_id)) &&
451 1.16 gdamore (rom.rom_class == PCI_CLASS(pa->pa_class)) &&
452 1.16 gdamore (rom.rom_subclass == PCI_SUBCLASS(pa->pa_class)) &&
453 1.16 gdamore (rom.rom_interface == PCI_INTERFACE(pa->pa_class)) &&
454 1.16 gdamore (rom.rom_code_type == type)) {
455 1.31 riastrad *romsz = imagesz;
456 1.16 gdamore bus_space_subregion(bst, bsh, offset, imagesz, romh);
457 1.16 gdamore return 0;
458 1.16 gdamore }
459 1.41 skrll
460 1.16 gdamore /* last image check */
461 1.16 gdamore if (rom.rom_indicator & PCI_ROM_INDICATOR_LAST)
462 1.16 gdamore return 1;
463 1.16 gdamore
464 1.16 gdamore /* offset by size */
465 1.16 gdamore offset += imagesz;
466 1.16 gdamore }
467 1.16 gdamore return 1;
468 1.16 gdamore }
469