Home | History | Annotate | Line # | Download | only in pci
pci_map.c revision 1.33.12.1
      1  1.33.12.1  pgoyette /*	$NetBSD: pci_map.c,v 1.33.12.1 2018/05/21 04:36:06 pgoyette 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.33.12.1  pgoyette __KERNEL_RCSID(0, "$NetBSD: pci_map.c,v 1.33.12.1 2018/05/21 04:36:06 pgoyette 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.33.12.1  pgoyette bool pci_mapreg_map_enable_decode = true;
     47  1.33.12.1  pgoyette 
     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.33.12.1  pgoyette 	pcireg_t csr;
    293  1.33.12.1  pgoyette 	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.33.12.1  pgoyette 	if (pci_mapreg_map_enable_decode) {
    335  1.33.12.1  pgoyette 		s = splhigh();
    336  1.33.12.1  pgoyette 		csr = pci_conf_read(pa->pa_pc, pa->pa_tag, PCI_COMMAND_STATUS_REG);
    337  1.33.12.1  pgoyette 		csr |= (PCI_MAPREG_TYPE(type) == PCI_MAPREG_TYPE_IO) ?
    338  1.33.12.1  pgoyette 		    PCI_COMMAND_IO_ENABLE : PCI_COMMAND_MEM_ENABLE;
    339  1.33.12.1  pgoyette 		pci_conf_write(pa->pa_pc, pa->pa_tag, PCI_COMMAND_STATUS_REG, csr);
    340  1.33.12.1  pgoyette 		splx(s);
    341  1.33.12.1  pgoyette 	}
    342  1.33.12.1  pgoyette 
    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