pci_map.c revision 1.36 1 1.36 jakllsch /* $NetBSD: pci_map.c,v 1.36 2018/05/19 17:21:42 jakllsch 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.36 jakllsch __KERNEL_RCSID(0, "$NetBSD: pci_map.c,v 1.36 2018/05/19 17:21:42 jakllsch 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.1 mycroft pcireg_t address, mask;
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.1 mycroft pci_conf_write(pc, tag, reg, 0xffffffff);
79 1.1 mycroft mask = pci_conf_read(pc, tag, reg);
80 1.1 mycroft pci_conf_write(pc, tag, reg, address);
81 1.1 mycroft splx(s);
82 1.1 mycroft
83 1.1 mycroft if (PCI_MAPREG_TYPE(address) != PCI_MAPREG_TYPE_IO) {
84 1.22 jmcneill aprint_debug("pci_io_find: expected type i/o, found mem\n");
85 1.25 dyoung return 1;
86 1.1 mycroft }
87 1.1 mycroft
88 1.2 mycroft if (PCI_MAPREG_IO_SIZE(mask) == 0) {
89 1.19 macallan aprint_debug("pci_io_find: void region\n");
90 1.25 dyoung return 1;
91 1.2 mycroft }
92 1.2 mycroft
93 1.25 dyoung if (basep != NULL)
94 1.1 mycroft *basep = PCI_MAPREG_IO_ADDR(address);
95 1.25 dyoung if (sizep != NULL)
96 1.1 mycroft *sizep = PCI_MAPREG_IO_SIZE(mask);
97 1.25 dyoung if (flagsp != NULL)
98 1.1 mycroft *flagsp = 0;
99 1.1 mycroft
100 1.25 dyoung return 0;
101 1.1 mycroft }
102 1.1 mycroft
103 1.1 mycroft static int
104 1.9 thorpej pci_mem_find(pci_chipset_tag_t pc, pcitag_t tag, int reg, pcireg_t type,
105 1.9 thorpej bus_addr_t *basep, bus_size_t *sizep, int *flagsp)
106 1.1 mycroft {
107 1.7 thorpej pcireg_t address, mask, address1 = 0, mask1 = 0xffffffff;
108 1.7 thorpej u_int64_t waddress, wmask;
109 1.15 gdamore int s, is64bit, isrom;
110 1.7 thorpej
111 1.7 thorpej is64bit = (PCI_MAPREG_MEM_TYPE(type) == PCI_MAPREG_MEM_TYPE_64BIT);
112 1.15 gdamore isrom = (reg == PCI_MAPREG_ROM);
113 1.1 mycroft
114 1.15 gdamore if ((!isrom) && (reg < PCI_MAPREG_START ||
115 1.8 thorpej #if 0
116 1.8 thorpej /*
117 1.8 thorpej * Can't do this check; some devices have mapping registers
118 1.8 thorpej * way out in left field.
119 1.8 thorpej */
120 1.8 thorpej reg >= PCI_MAPREG_END ||
121 1.8 thorpej #endif
122 1.15 gdamore (reg & 3)))
123 1.7 thorpej panic("pci_mem_find: bad request");
124 1.7 thorpej
125 1.7 thorpej if (is64bit && (reg + 4) >= PCI_MAPREG_END)
126 1.7 thorpej panic("pci_mem_find: bad 64-bit request");
127 1.1 mycroft
128 1.1 mycroft /*
129 1.1 mycroft * Section 6.2.5.1, `Address Maps', tells us that:
130 1.1 mycroft *
131 1.1 mycroft * 1) The builtin software should have already mapped the device in a
132 1.1 mycroft * reasonable way.
133 1.1 mycroft *
134 1.1 mycroft * 2) A device which wants 2^n bytes of memory will hardwire the bottom
135 1.1 mycroft * n bits of the address to 0. As recommended, we write all 1s and see
136 1.30 matt * what we get back. Only probe the upper BAR of a mem64 BAR if bit 31
137 1.30 matt * is readonly.
138 1.1 mycroft */
139 1.1 mycroft s = splhigh();
140 1.1 mycroft address = pci_conf_read(pc, tag, reg);
141 1.1 mycroft pci_conf_write(pc, tag, reg, 0xffffffff);
142 1.1 mycroft mask = pci_conf_read(pc, tag, reg);
143 1.1 mycroft pci_conf_write(pc, tag, reg, address);
144 1.7 thorpej if (is64bit) {
145 1.7 thorpej address1 = pci_conf_read(pc, tag, reg + 4);
146 1.30 matt if ((mask & 0x80000000) == 0) {
147 1.30 matt pci_conf_write(pc, tag, reg + 4, 0xffffffff);
148 1.30 matt mask1 = pci_conf_read(pc, tag, reg + 4);
149 1.30 matt pci_conf_write(pc, tag, reg + 4, address1);
150 1.30 matt }
151 1.7 thorpej }
152 1.1 mycroft splx(s);
153 1.1 mycroft
154 1.15 gdamore if (!isrom) {
155 1.15 gdamore /*
156 1.15 gdamore * roms should have an enable bit instead of a memory
157 1.15 gdamore * type decoder bit. For normal BARs, make sure that
158 1.15 gdamore * the address decoder type matches what we asked for.
159 1.15 gdamore */
160 1.15 gdamore if (PCI_MAPREG_TYPE(address) != PCI_MAPREG_TYPE_MEM) {
161 1.15 gdamore printf("pci_mem_find: expected type mem, found i/o\n");
162 1.25 dyoung return 1;
163 1.15 gdamore }
164 1.21 joerg /* XXX Allow 64bit bars for 32bit requests.*/
165 1.15 gdamore if (PCI_MAPREG_MEM_TYPE(address) !=
166 1.21 joerg PCI_MAPREG_MEM_TYPE(type) &&
167 1.21 joerg PCI_MAPREG_MEM_TYPE(address) !=
168 1.21 joerg PCI_MAPREG_MEM_TYPE_64BIT) {
169 1.15 gdamore printf("pci_mem_find: "
170 1.15 gdamore "expected mem type %08x, found %08x\n",
171 1.15 gdamore PCI_MAPREG_MEM_TYPE(type),
172 1.15 gdamore PCI_MAPREG_MEM_TYPE(address));
173 1.25 dyoung return 1;
174 1.15 gdamore }
175 1.2 mycroft }
176 1.2 mycroft
177 1.7 thorpej waddress = (u_int64_t)address1 << 32UL | address;
178 1.7 thorpej wmask = (u_int64_t)mask1 << 32UL | mask;
179 1.7 thorpej
180 1.11 bouyer if ((is64bit && PCI_MAPREG_MEM64_SIZE(wmask) == 0) ||
181 1.11 bouyer (!is64bit && PCI_MAPREG_MEM_SIZE(mask) == 0)) {
182 1.27 jmcneill aprint_debug("pci_mem_find: void region\n");
183 1.25 dyoung return 1;
184 1.1 mycroft }
185 1.1 mycroft
186 1.1 mycroft switch (PCI_MAPREG_MEM_TYPE(address)) {
187 1.1 mycroft case PCI_MAPREG_MEM_TYPE_32BIT:
188 1.1 mycroft case PCI_MAPREG_MEM_TYPE_32BIT_1M:
189 1.1 mycroft break;
190 1.1 mycroft case PCI_MAPREG_MEM_TYPE_64BIT:
191 1.7 thorpej /*
192 1.7 thorpej * Handle the case of a 64-bit memory register on a
193 1.7 thorpej * platform with 32-bit addressing. Make sure that
194 1.7 thorpej * the address assigned and the device's memory size
195 1.7 thorpej * fit in 32 bits. We implicitly assume that if
196 1.7 thorpej * bus_addr_t is 64-bit, then so is bus_size_t.
197 1.7 thorpej */
198 1.7 thorpej if (sizeof(u_int64_t) > sizeof(bus_addr_t) &&
199 1.7 thorpej (address1 != 0 || mask1 != 0xffffffff)) {
200 1.7 thorpej printf("pci_mem_find: 64-bit memory map which is "
201 1.7 thorpej "inaccessible on a 32-bit platform\n");
202 1.25 dyoung return 1;
203 1.7 thorpej }
204 1.7 thorpej break;
205 1.1 mycroft default:
206 1.1 mycroft printf("pci_mem_find: reserved mapping register type\n");
207 1.25 dyoung return 1;
208 1.1 mycroft }
209 1.1 mycroft
210 1.7 thorpej if (sizeof(u_int64_t) > sizeof(bus_addr_t)) {
211 1.25 dyoung if (basep != NULL)
212 1.7 thorpej *basep = PCI_MAPREG_MEM_ADDR(address);
213 1.25 dyoung if (sizep != NULL)
214 1.7 thorpej *sizep = PCI_MAPREG_MEM_SIZE(mask);
215 1.7 thorpej } else {
216 1.25 dyoung if (basep != NULL)
217 1.7 thorpej *basep = PCI_MAPREG_MEM64_ADDR(waddress);
218 1.25 dyoung if (sizep != NULL)
219 1.7 thorpej *sizep = PCI_MAPREG_MEM64_SIZE(wmask);
220 1.7 thorpej }
221 1.25 dyoung if (flagsp != NULL)
222 1.15 gdamore *flagsp = (isrom || PCI_MAPREG_MEM_PREFETCHABLE(address)) ?
223 1.6 drochner BUS_SPACE_MAP_PREFETCHABLE : 0;
224 1.1 mycroft
225 1.25 dyoung return 0;
226 1.7 thorpej }
227 1.7 thorpej
228 1.12 drochner #define _PCI_MAPREG_TYPEBITS(reg) \
229 1.12 drochner (PCI_MAPREG_TYPE(reg) == PCI_MAPREG_TYPE_IO ? \
230 1.12 drochner reg & PCI_MAPREG_TYPE_MASK : \
231 1.12 drochner reg & (PCI_MAPREG_TYPE_MASK|PCI_MAPREG_MEM_TYPE_MASK))
232 1.12 drochner
233 1.7 thorpej pcireg_t
234 1.9 thorpej pci_mapreg_type(pci_chipset_tag_t pc, pcitag_t tag, int reg)
235 1.7 thorpej {
236 1.7 thorpej
237 1.25 dyoung return _PCI_MAPREG_TYPEBITS(pci_conf_read(pc, tag, reg));
238 1.12 drochner }
239 1.12 drochner
240 1.12 drochner int
241 1.12 drochner pci_mapreg_probe(pci_chipset_tag_t pc, pcitag_t tag, int reg, pcireg_t *typep)
242 1.12 drochner {
243 1.12 drochner pcireg_t address, mask;
244 1.12 drochner int s;
245 1.13 perry
246 1.12 drochner s = splhigh();
247 1.12 drochner address = pci_conf_read(pc, tag, reg);
248 1.12 drochner pci_conf_write(pc, tag, reg, 0xffffffff);
249 1.12 drochner mask = pci_conf_read(pc, tag, reg);
250 1.12 drochner pci_conf_write(pc, tag, reg, address);
251 1.12 drochner splx(s);
252 1.12 drochner
253 1.12 drochner if (mask == 0) /* unimplemented mapping register */
254 1.25 dyoung return 0;
255 1.12 drochner
256 1.25 dyoung if (typep != NULL)
257 1.12 drochner *typep = _PCI_MAPREG_TYPEBITS(address);
258 1.25 dyoung return 1;
259 1.1 mycroft }
260 1.1 mycroft
261 1.1 mycroft int
262 1.9 thorpej pci_mapreg_info(pci_chipset_tag_t pc, pcitag_t tag, int reg, pcireg_t type,
263 1.9 thorpej bus_addr_t *basep, bus_size_t *sizep, int *flagsp)
264 1.1 mycroft {
265 1.1 mycroft
266 1.1 mycroft if (PCI_MAPREG_TYPE(type) == PCI_MAPREG_TYPE_IO)
267 1.25 dyoung return pci_io_find(pc, tag, reg, type, basep, sizep,
268 1.25 dyoung flagsp);
269 1.1 mycroft else
270 1.25 dyoung return pci_mem_find(pc, tag, reg, type, basep, sizep,
271 1.25 dyoung flagsp);
272 1.1 mycroft }
273 1.1 mycroft
274 1.1 mycroft int
275 1.28 dyoung pci_mapreg_map(const struct pci_attach_args *pa, int reg, pcireg_t type,
276 1.9 thorpej int busflags, bus_space_tag_t *tagp, bus_space_handle_t *handlep,
277 1.9 thorpej bus_addr_t *basep, bus_size_t *sizep)
278 1.1 mycroft {
279 1.24 bjs return pci_mapreg_submap(pa, reg, type, busflags, 0, 0, tagp,
280 1.24 bjs handlep, basep, sizep);
281 1.24 bjs }
282 1.24 bjs
283 1.32 msaitoh int
284 1.28 dyoung pci_mapreg_submap(const struct pci_attach_args *pa, int reg, pcireg_t type,
285 1.33 msaitoh int busflags, bus_size_t reqsize, bus_size_t offset, bus_space_tag_t *tagp,
286 1.24 bjs bus_space_handle_t *handlep, bus_addr_t *basep, bus_size_t *sizep)
287 1.24 bjs {
288 1.1 mycroft bus_space_tag_t tag;
289 1.1 mycroft bus_space_handle_t handle;
290 1.1 mycroft bus_addr_t base;
291 1.33 msaitoh bus_size_t realmaxsize;
292 1.34 jakllsch pcireg_t csr;
293 1.34 jakllsch int flags, s;
294 1.1 mycroft
295 1.1 mycroft if (PCI_MAPREG_TYPE(type) == PCI_MAPREG_TYPE_IO) {
296 1.29 dyoung if ((pa->pa_flags & PCI_FLAGS_IO_OKAY) == 0)
297 1.25 dyoung return 1;
298 1.1 mycroft if (pci_io_find(pa->pa_pc, pa->pa_tag, reg, type, &base,
299 1.33 msaitoh &realmaxsize, &flags))
300 1.25 dyoung return 1;
301 1.1 mycroft tag = pa->pa_iot;
302 1.1 mycroft } else {
303 1.29 dyoung if ((pa->pa_flags & PCI_FLAGS_MEM_OKAY) == 0)
304 1.25 dyoung return 1;
305 1.1 mycroft if (pci_mem_find(pa->pa_pc, pa->pa_tag, reg, type, &base,
306 1.33 msaitoh &realmaxsize, &flags))
307 1.25 dyoung return 1;
308 1.1 mycroft tag = pa->pa_memt;
309 1.1 mycroft }
310 1.1 mycroft
311 1.15 gdamore if (reg == PCI_MAPREG_ROM) {
312 1.15 gdamore pcireg_t mask;
313 1.15 gdamore /* we have to enable the ROM address decoder... */
314 1.15 gdamore s = splhigh();
315 1.15 gdamore mask = pci_conf_read(pa->pa_pc, pa->pa_tag, reg);
316 1.15 gdamore mask |= PCI_MAPREG_ROM_ENABLE;
317 1.15 gdamore pci_conf_write(pa->pa_pc, pa->pa_tag, reg, mask);
318 1.15 gdamore splx(s);
319 1.15 gdamore }
320 1.15 gdamore
321 1.24 bjs /* If we're called with maxsize/offset of 0, behave like
322 1.24 bjs * pci_mapreg_map.
323 1.24 bjs */
324 1.24 bjs
325 1.33 msaitoh reqsize = (reqsize != 0) ? reqsize : realmaxsize;
326 1.24 bjs base += offset;
327 1.24 bjs
328 1.33 msaitoh if (realmaxsize < (offset + reqsize))
329 1.25 dyoung return 1;
330 1.24 bjs
331 1.33 msaitoh if (bus_space_map(tag, base, reqsize, busflags | flags, &handle))
332 1.25 dyoung return 1;
333 1.1 mycroft
334 1.35 jakllsch if (pci_mapreg_map_enable_decode) {
335 1.35 jakllsch s = splhigh();
336 1.35 jakllsch csr = pci_conf_read(pa->pa_pc, pa->pa_tag, PCI_COMMAND_STATUS_REG);
337 1.35 jakllsch csr |= (PCI_MAPREG_TYPE(type) == PCI_MAPREG_TYPE_IO) ?
338 1.35 jakllsch PCI_COMMAND_IO_ENABLE : PCI_COMMAND_MEM_ENABLE;
339 1.35 jakllsch pci_conf_write(pa->pa_pc, pa->pa_tag, PCI_COMMAND_STATUS_REG, csr);
340 1.35 jakllsch splx(s);
341 1.35 jakllsch }
342 1.35 jakllsch
343 1.25 dyoung if (tagp != NULL)
344 1.1 mycroft *tagp = tag;
345 1.25 dyoung if (handlep != NULL)
346 1.1 mycroft *handlep = handle;
347 1.25 dyoung if (basep != NULL)
348 1.1 mycroft *basep = base;
349 1.25 dyoung if (sizep != NULL)
350 1.33 msaitoh *sizep = reqsize;
351 1.1 mycroft
352 1.25 dyoung return 0;
353 1.1 mycroft }
354 1.16 gdamore
355 1.16 gdamore int
356 1.28 dyoung pci_find_rom(const struct pci_attach_args *pa, bus_space_tag_t bst,
357 1.31 riastrad bus_space_handle_t bsh, bus_size_t sz, int type,
358 1.31 riastrad bus_space_handle_t *romh, bus_size_t *romsz)
359 1.16 gdamore {
360 1.31 riastrad bus_size_t offset = 0, imagesz;
361 1.16 gdamore uint16_t ptr;
362 1.16 gdamore int done = 0;
363 1.16 gdamore
364 1.16 gdamore /*
365 1.16 gdamore * no upper bound check; i cannot imagine a 4GB ROM, but
366 1.16 gdamore * it appears the spec would allow it!
367 1.16 gdamore */
368 1.31 riastrad if (sz < 1024)
369 1.16 gdamore return 1;
370 1.16 gdamore
371 1.31 riastrad while (offset < sz && !done){
372 1.16 gdamore struct pci_rom_header hdr;
373 1.16 gdamore struct pci_rom rom;
374 1.16 gdamore
375 1.16 gdamore hdr.romh_magic = bus_space_read_2(bst, bsh,
376 1.16 gdamore offset + offsetof (struct pci_rom_header, romh_magic));
377 1.16 gdamore hdr.romh_data_ptr = bus_space_read_2(bst, bsh,
378 1.16 gdamore offset + offsetof (struct pci_rom_header, romh_data_ptr));
379 1.16 gdamore
380 1.16 gdamore /* no warning: quite possibly ROM is simply not populated */
381 1.16 gdamore if (hdr.romh_magic != PCI_ROM_HEADER_MAGIC)
382 1.16 gdamore return 1;
383 1.16 gdamore
384 1.16 gdamore ptr = offset + hdr.romh_data_ptr;
385 1.16 gdamore
386 1.31 riastrad if (ptr > sz) {
387 1.16 gdamore printf("pci_find_rom: rom data ptr out of range\n");
388 1.16 gdamore return 1;
389 1.16 gdamore }
390 1.16 gdamore
391 1.16 gdamore rom.rom_signature = bus_space_read_4(bst, bsh, ptr);
392 1.16 gdamore rom.rom_vendor = bus_space_read_2(bst, bsh, ptr +
393 1.16 gdamore offsetof(struct pci_rom, rom_vendor));
394 1.16 gdamore rom.rom_product = bus_space_read_2(bst, bsh, ptr +
395 1.16 gdamore offsetof(struct pci_rom, rom_product));
396 1.16 gdamore rom.rom_class = bus_space_read_1(bst, bsh,
397 1.16 gdamore ptr + offsetof (struct pci_rom, rom_class));
398 1.16 gdamore rom.rom_subclass = bus_space_read_1(bst, bsh,
399 1.16 gdamore ptr + offsetof (struct pci_rom, rom_subclass));
400 1.16 gdamore rom.rom_interface = bus_space_read_1(bst, bsh,
401 1.16 gdamore ptr + offsetof (struct pci_rom, rom_interface));
402 1.16 gdamore rom.rom_len = bus_space_read_2(bst, bsh,
403 1.16 gdamore ptr + offsetof (struct pci_rom, rom_len));
404 1.16 gdamore rom.rom_code_type = bus_space_read_1(bst, bsh,
405 1.16 gdamore ptr + offsetof (struct pci_rom, rom_code_type));
406 1.16 gdamore rom.rom_indicator = bus_space_read_1(bst, bsh,
407 1.16 gdamore ptr + offsetof (struct pci_rom, rom_indicator));
408 1.16 gdamore
409 1.16 gdamore if (rom.rom_signature != PCI_ROM_SIGNATURE) {
410 1.16 gdamore printf("pci_find_rom: bad rom data signature\n");
411 1.16 gdamore return 1;
412 1.16 gdamore }
413 1.16 gdamore
414 1.16 gdamore imagesz = rom.rom_len * 512;
415 1.16 gdamore
416 1.16 gdamore if ((rom.rom_vendor == PCI_VENDOR(pa->pa_id)) &&
417 1.16 gdamore (rom.rom_product == PCI_PRODUCT(pa->pa_id)) &&
418 1.16 gdamore (rom.rom_class == PCI_CLASS(pa->pa_class)) &&
419 1.16 gdamore (rom.rom_subclass == PCI_SUBCLASS(pa->pa_class)) &&
420 1.16 gdamore (rom.rom_interface == PCI_INTERFACE(pa->pa_class)) &&
421 1.16 gdamore (rom.rom_code_type == type)) {
422 1.31 riastrad *romsz = imagesz;
423 1.16 gdamore bus_space_subregion(bst, bsh, offset, imagesz, romh);
424 1.16 gdamore return 0;
425 1.16 gdamore }
426 1.16 gdamore
427 1.16 gdamore /* last image check */
428 1.16 gdamore if (rom.rom_indicator & PCI_ROM_INDICATOR_LAST)
429 1.16 gdamore return 1;
430 1.16 gdamore
431 1.16 gdamore /* offset by size */
432 1.16 gdamore offset += imagesz;
433 1.16 gdamore }
434 1.16 gdamore return 1;
435 1.16 gdamore }
436