Home | History | Annotate | Line # | Download | only in pci
pci_map.c revision 1.14.6.1
      1  1.14.6.1    simonb /*	$NetBSD: pci_map.c,v 1.14.6.1 2006/04/22 11:39:15 simonb 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  * 3. All advertising materials mentioning features or use of this software
     19       1.1   mycroft  *    must display the following acknowledgement:
     20       1.5   mycroft  *        This product includes software developed by the NetBSD
     21       1.5   mycroft  *        Foundation, Inc. and its contributors.
     22       1.5   mycroft  * 4. Neither the name of The NetBSD Foundation nor the names of its
     23       1.5   mycroft  *    contributors may be used to endorse or promote products derived
     24       1.5   mycroft  *    from this software without specific prior written permission.
     25       1.1   mycroft  *
     26       1.5   mycroft  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     27       1.5   mycroft  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     28       1.5   mycroft  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     29       1.5   mycroft  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     30       1.5   mycroft  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     31       1.5   mycroft  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     32       1.5   mycroft  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     33       1.5   mycroft  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     34       1.5   mycroft  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     35       1.5   mycroft  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     36       1.5   mycroft  * POSSIBILITY OF SUCH DAMAGE.
     37       1.1   mycroft  */
     38       1.1   mycroft 
     39       1.1   mycroft /*
     40       1.1   mycroft  * PCI device mapping.
     41       1.1   mycroft  */
     42      1.10     lukem 
     43      1.10     lukem #include <sys/cdefs.h>
     44  1.14.6.1    simonb __KERNEL_RCSID(0, "$NetBSD: pci_map.c,v 1.14.6.1 2006/04/22 11:39:15 simonb Exp $");
     45       1.1   mycroft 
     46       1.1   mycroft #include <sys/param.h>
     47       1.1   mycroft #include <sys/systm.h>
     48       1.1   mycroft #include <sys/device.h>
     49       1.1   mycroft 
     50       1.1   mycroft #include <dev/pci/pcireg.h>
     51       1.1   mycroft #include <dev/pci/pcivar.h>
     52       1.1   mycroft 
     53       1.1   mycroft static int
     54       1.9   thorpej pci_io_find(pci_chipset_tag_t pc, pcitag_t tag, int reg, pcireg_t type,
     55       1.9   thorpej     bus_addr_t *basep, bus_size_t *sizep, int *flagsp)
     56       1.1   mycroft {
     57       1.1   mycroft 	pcireg_t address, mask;
     58       1.1   mycroft 	int s;
     59       1.1   mycroft 
     60       1.8   thorpej 	if (reg < PCI_MAPREG_START ||
     61       1.8   thorpej #if 0
     62       1.8   thorpej 	    /*
     63       1.8   thorpej 	     * Can't do this check; some devices have mapping registers
     64       1.8   thorpej 	     * way out in left field.
     65       1.8   thorpej 	     */
     66       1.8   thorpej 	    reg >= PCI_MAPREG_END ||
     67       1.8   thorpej #endif
     68       1.8   thorpej 	    (reg & 3))
     69       1.1   mycroft 		panic("pci_io_find: bad request");
     70       1.1   mycroft 
     71       1.1   mycroft 	/*
     72       1.1   mycroft 	 * Section 6.2.5.1, `Address Maps', tells us that:
     73       1.1   mycroft 	 *
     74       1.1   mycroft 	 * 1) The builtin software should have already mapped the device in a
     75       1.1   mycroft 	 * reasonable way.
     76       1.1   mycroft 	 *
     77       1.1   mycroft 	 * 2) A device which wants 2^n bytes of memory will hardwire the bottom
     78       1.1   mycroft 	 * n bits of the address to 0.  As recommended, we write all 1s and see
     79       1.1   mycroft 	 * what we get back.
     80       1.1   mycroft 	 */
     81       1.1   mycroft 	s = splhigh();
     82       1.1   mycroft 	address = pci_conf_read(pc, tag, reg);
     83       1.1   mycroft 	pci_conf_write(pc, tag, reg, 0xffffffff);
     84       1.1   mycroft 	mask = pci_conf_read(pc, tag, reg);
     85       1.1   mycroft 	pci_conf_write(pc, tag, reg, address);
     86       1.1   mycroft 	splx(s);
     87       1.1   mycroft 
     88       1.1   mycroft 	if (PCI_MAPREG_TYPE(address) != PCI_MAPREG_TYPE_IO) {
     89       1.1   mycroft 		printf("pci_io_find: expected type i/o, found mem\n");
     90       1.1   mycroft 		return (1);
     91       1.1   mycroft 	}
     92       1.1   mycroft 
     93       1.2   mycroft 	if (PCI_MAPREG_IO_SIZE(mask) == 0) {
     94       1.2   mycroft 		printf("pci_io_find: void region\n");
     95       1.2   mycroft 		return (1);
     96       1.2   mycroft 	}
     97       1.2   mycroft 
     98       1.1   mycroft 	if (basep != 0)
     99       1.1   mycroft 		*basep = PCI_MAPREG_IO_ADDR(address);
    100       1.1   mycroft 	if (sizep != 0)
    101       1.1   mycroft 		*sizep = PCI_MAPREG_IO_SIZE(mask);
    102       1.1   mycroft 	if (flagsp != 0)
    103       1.1   mycroft 		*flagsp = 0;
    104       1.1   mycroft 
    105       1.1   mycroft 	return (0);
    106       1.1   mycroft }
    107       1.1   mycroft 
    108       1.1   mycroft static int
    109       1.9   thorpej pci_mem_find(pci_chipset_tag_t pc, pcitag_t tag, int reg, pcireg_t type,
    110       1.9   thorpej     bus_addr_t *basep, bus_size_t *sizep, int *flagsp)
    111       1.1   mycroft {
    112       1.7   thorpej 	pcireg_t address, mask, address1 = 0, mask1 = 0xffffffff;
    113       1.7   thorpej 	u_int64_t waddress, wmask;
    114  1.14.6.1    simonb 	int s, is64bit, isrom;
    115       1.7   thorpej 
    116       1.7   thorpej 	is64bit = (PCI_MAPREG_MEM_TYPE(type) == PCI_MAPREG_MEM_TYPE_64BIT);
    117  1.14.6.1    simonb 	isrom = (reg == PCI_MAPREG_ROM);
    118       1.1   mycroft 
    119  1.14.6.1    simonb 	if ((!isrom) && (reg < PCI_MAPREG_START ||
    120       1.8   thorpej #if 0
    121       1.8   thorpej 	    /*
    122       1.8   thorpej 	     * Can't do this check; some devices have mapping registers
    123       1.8   thorpej 	     * way out in left field.
    124       1.8   thorpej 	     */
    125       1.8   thorpej 	    reg >= PCI_MAPREG_END ||
    126       1.8   thorpej #endif
    127  1.14.6.1    simonb 	    (reg & 3)))
    128       1.7   thorpej 		panic("pci_mem_find: bad request");
    129       1.7   thorpej 
    130       1.7   thorpej 	if (is64bit && (reg + 4) >= PCI_MAPREG_END)
    131       1.7   thorpej 		panic("pci_mem_find: bad 64-bit request");
    132       1.1   mycroft 
    133       1.1   mycroft 	/*
    134       1.1   mycroft 	 * Section 6.2.5.1, `Address Maps', tells us that:
    135       1.1   mycroft 	 *
    136       1.1   mycroft 	 * 1) The builtin software should have already mapped the device in a
    137       1.1   mycroft 	 * reasonable way.
    138       1.1   mycroft 	 *
    139       1.1   mycroft 	 * 2) A device which wants 2^n bytes of memory will hardwire the bottom
    140       1.1   mycroft 	 * n bits of the address to 0.  As recommended, we write all 1s and see
    141       1.1   mycroft 	 * what we get back.
    142       1.1   mycroft 	 */
    143       1.1   mycroft 	s = splhigh();
    144       1.1   mycroft 	address = pci_conf_read(pc, tag, reg);
    145       1.1   mycroft 	pci_conf_write(pc, tag, reg, 0xffffffff);
    146       1.1   mycroft 	mask = pci_conf_read(pc, tag, reg);
    147       1.1   mycroft 	pci_conf_write(pc, tag, reg, address);
    148       1.7   thorpej 	if (is64bit) {
    149       1.7   thorpej 		address1 = pci_conf_read(pc, tag, reg + 4);
    150       1.7   thorpej 		pci_conf_write(pc, tag, reg + 4, 0xffffffff);
    151       1.7   thorpej 		mask1 = pci_conf_read(pc, tag, reg + 4);
    152       1.7   thorpej 		pci_conf_write(pc, tag, reg + 4, address1);
    153       1.7   thorpej 	}
    154       1.1   mycroft 	splx(s);
    155       1.1   mycroft 
    156  1.14.6.1    simonb 	if (!isrom) {
    157  1.14.6.1    simonb 		/*
    158  1.14.6.1    simonb 		 * roms should have an enable bit instead of a memory
    159  1.14.6.1    simonb 		 * type decoder bit.  For normal BARs, make sure that
    160  1.14.6.1    simonb 		 * the address decoder type matches what we asked for.
    161  1.14.6.1    simonb 		 */
    162  1.14.6.1    simonb 		if (PCI_MAPREG_TYPE(address) != PCI_MAPREG_TYPE_MEM) {
    163  1.14.6.1    simonb 			printf("pci_mem_find: expected type mem, found i/o\n");
    164  1.14.6.1    simonb 			return (1);
    165  1.14.6.1    simonb 		}
    166  1.14.6.1    simonb 		if (PCI_MAPREG_MEM_TYPE(address) !=
    167  1.14.6.1    simonb 		    PCI_MAPREG_MEM_TYPE(type)) {
    168  1.14.6.1    simonb 			printf("pci_mem_find: "
    169  1.14.6.1    simonb 			    "expected mem type %08x, found %08x\n",
    170  1.14.6.1    simonb 			    PCI_MAPREG_MEM_TYPE(type),
    171  1.14.6.1    simonb 			    PCI_MAPREG_MEM_TYPE(address));
    172  1.14.6.1    simonb 			return (1);
    173  1.14.6.1    simonb 		}
    174       1.2   mycroft 	}
    175       1.2   mycroft 
    176       1.7   thorpej 	waddress = (u_int64_t)address1 << 32UL | address;
    177       1.7   thorpej 	wmask = (u_int64_t)mask1 << 32UL | mask;
    178       1.7   thorpej 
    179      1.11    bouyer 	if ((is64bit && PCI_MAPREG_MEM64_SIZE(wmask) == 0) ||
    180      1.11    bouyer 	    (!is64bit && PCI_MAPREG_MEM_SIZE(mask) == 0)) {
    181       1.2   mycroft 		printf("pci_mem_find: void region\n");
    182       1.1   mycroft 		return (1);
    183       1.1   mycroft 	}
    184       1.1   mycroft 
    185       1.1   mycroft 	switch (PCI_MAPREG_MEM_TYPE(address)) {
    186       1.1   mycroft 	case PCI_MAPREG_MEM_TYPE_32BIT:
    187       1.1   mycroft 	case PCI_MAPREG_MEM_TYPE_32BIT_1M:
    188       1.1   mycroft 		break;
    189       1.1   mycroft 	case PCI_MAPREG_MEM_TYPE_64BIT:
    190       1.7   thorpej 		/*
    191       1.7   thorpej 		 * Handle the case of a 64-bit memory register on a
    192       1.7   thorpej 		 * platform with 32-bit addressing.  Make sure that
    193       1.7   thorpej 		 * the address assigned and the device's memory size
    194       1.7   thorpej 		 * fit in 32 bits.  We implicitly assume that if
    195       1.7   thorpej 		 * bus_addr_t is 64-bit, then so is bus_size_t.
    196       1.7   thorpej 		 */
    197       1.7   thorpej 		if (sizeof(u_int64_t) > sizeof(bus_addr_t) &&
    198       1.7   thorpej 		    (address1 != 0 || mask1 != 0xffffffff)) {
    199       1.7   thorpej 			printf("pci_mem_find: 64-bit memory map which is "
    200       1.7   thorpej 			    "inaccessible on a 32-bit platform\n");
    201       1.7   thorpej 			return (1);
    202       1.7   thorpej 		}
    203       1.7   thorpej 		break;
    204       1.1   mycroft 	default:
    205       1.1   mycroft 		printf("pci_mem_find: reserved mapping register type\n");
    206       1.1   mycroft 		return (1);
    207       1.1   mycroft 	}
    208       1.1   mycroft 
    209       1.7   thorpej 	if (sizeof(u_int64_t) > sizeof(bus_addr_t)) {
    210       1.7   thorpej 		if (basep != 0)
    211       1.7   thorpej 			*basep = PCI_MAPREG_MEM_ADDR(address);
    212       1.7   thorpej 		if (sizep != 0)
    213       1.7   thorpej 			*sizep = PCI_MAPREG_MEM_SIZE(mask);
    214       1.7   thorpej 	} else {
    215       1.7   thorpej 		if (basep != 0)
    216       1.7   thorpej 			*basep = PCI_MAPREG_MEM64_ADDR(waddress);
    217       1.7   thorpej 		if (sizep != 0)
    218       1.7   thorpej 			*sizep = PCI_MAPREG_MEM64_SIZE(wmask);
    219       1.7   thorpej 	}
    220       1.1   mycroft 	if (flagsp != 0)
    221  1.14.6.1    simonb 		*flagsp = (isrom || PCI_MAPREG_MEM_PREFETCHABLE(address)) ?
    222       1.6  drochner 		    BUS_SPACE_MAP_PREFETCHABLE : 0;
    223       1.1   mycroft 
    224       1.1   mycroft 	return (0);
    225       1.7   thorpej }
    226       1.7   thorpej 
    227      1.12  drochner #define _PCI_MAPREG_TYPEBITS(reg) \
    228      1.12  drochner 	(PCI_MAPREG_TYPE(reg) == PCI_MAPREG_TYPE_IO ? \
    229      1.12  drochner 	reg & PCI_MAPREG_TYPE_MASK : \
    230      1.12  drochner 	reg & (PCI_MAPREG_TYPE_MASK|PCI_MAPREG_MEM_TYPE_MASK))
    231      1.12  drochner 
    232       1.7   thorpej pcireg_t
    233       1.9   thorpej pci_mapreg_type(pci_chipset_tag_t pc, pcitag_t tag, int reg)
    234       1.7   thorpej {
    235       1.7   thorpej 
    236      1.12  drochner 	return (_PCI_MAPREG_TYPEBITS(pci_conf_read(pc, tag, reg)));
    237      1.12  drochner }
    238      1.12  drochner 
    239      1.12  drochner int
    240      1.12  drochner pci_mapreg_probe(pci_chipset_tag_t pc, pcitag_t tag, int reg, pcireg_t *typep)
    241      1.12  drochner {
    242      1.12  drochner 	pcireg_t address, mask;
    243      1.12  drochner 	int s;
    244      1.13     perry 
    245      1.12  drochner 	s = splhigh();
    246      1.12  drochner 	address = pci_conf_read(pc, tag, reg);
    247      1.12  drochner 	pci_conf_write(pc, tag, reg, 0xffffffff);
    248      1.12  drochner 	mask = pci_conf_read(pc, tag, reg);
    249      1.12  drochner 	pci_conf_write(pc, tag, reg, address);
    250      1.12  drochner 	splx(s);
    251      1.12  drochner 
    252      1.12  drochner 	if (mask == 0) /* unimplemented mapping register */
    253      1.12  drochner 		return (0);
    254      1.12  drochner 
    255      1.12  drochner 	if (typep)
    256      1.12  drochner 		*typep = _PCI_MAPREG_TYPEBITS(address);
    257      1.12  drochner 	return (1);
    258       1.1   mycroft }
    259       1.1   mycroft 
    260       1.1   mycroft int
    261       1.9   thorpej pci_mapreg_info(pci_chipset_tag_t pc, pcitag_t tag, int reg, pcireg_t type,
    262       1.9   thorpej     bus_addr_t *basep, bus_size_t *sizep, int *flagsp)
    263       1.1   mycroft {
    264       1.1   mycroft 
    265       1.1   mycroft 	if (PCI_MAPREG_TYPE(type) == PCI_MAPREG_TYPE_IO)
    266       1.4   thorpej 		return (pci_io_find(pc, tag, reg, type, basep, sizep,
    267       1.4   thorpej 		    flagsp));
    268       1.1   mycroft 	else
    269       1.4   thorpej 		return (pci_mem_find(pc, tag, reg, type, basep, sizep,
    270       1.4   thorpej 		    flagsp));
    271       1.1   mycroft }
    272       1.1   mycroft 
    273       1.1   mycroft int
    274       1.9   thorpej pci_mapreg_map(struct pci_attach_args *pa, int reg, pcireg_t type,
    275       1.9   thorpej     int busflags, bus_space_tag_t *tagp, bus_space_handle_t *handlep,
    276       1.9   thorpej     bus_addr_t *basep, bus_size_t *sizep)
    277       1.1   mycroft {
    278       1.1   mycroft 	bus_space_tag_t tag;
    279       1.1   mycroft 	bus_space_handle_t handle;
    280       1.1   mycroft 	bus_addr_t base;
    281       1.1   mycroft 	bus_size_t size;
    282       1.1   mycroft 	int flags;
    283       1.1   mycroft 
    284       1.1   mycroft 	if (PCI_MAPREG_TYPE(type) == PCI_MAPREG_TYPE_IO) {
    285       1.1   mycroft 		if ((pa->pa_flags & PCI_FLAGS_IO_ENABLED) == 0)
    286       1.1   mycroft 			return (1);
    287       1.1   mycroft 		if (pci_io_find(pa->pa_pc, pa->pa_tag, reg, type, &base,
    288       1.1   mycroft 		    &size, &flags))
    289       1.1   mycroft 			return (1);
    290       1.1   mycroft 		tag = pa->pa_iot;
    291       1.1   mycroft 	} else {
    292       1.1   mycroft 		if ((pa->pa_flags & PCI_FLAGS_MEM_ENABLED) == 0)
    293       1.1   mycroft 			return (1);
    294       1.1   mycroft 		if (pci_mem_find(pa->pa_pc, pa->pa_tag, reg, type, &base,
    295       1.1   mycroft 		    &size, &flags))
    296       1.1   mycroft 			return (1);
    297       1.1   mycroft 		tag = pa->pa_memt;
    298       1.1   mycroft 	}
    299       1.1   mycroft 
    300  1.14.6.1    simonb 	if (reg == PCI_MAPREG_ROM) {
    301  1.14.6.1    simonb 		pcireg_t 	mask;
    302  1.14.6.1    simonb 		int		s;
    303  1.14.6.1    simonb 		/* we have to enable the ROM address decoder... */
    304  1.14.6.1    simonb 		s = splhigh();
    305  1.14.6.1    simonb 		mask = pci_conf_read(pa->pa_pc, pa->pa_tag, reg);
    306  1.14.6.1    simonb 		mask |= PCI_MAPREG_ROM_ENABLE;
    307  1.14.6.1    simonb 		pci_conf_write(pa->pa_pc, pa->pa_tag, reg, mask);
    308  1.14.6.1    simonb 		splx(s);
    309  1.14.6.1    simonb 	}
    310  1.14.6.1    simonb 
    311       1.1   mycroft 	if (bus_space_map(tag, base, size, busflags | flags, &handle))
    312       1.1   mycroft 		return (1);
    313       1.1   mycroft 
    314       1.1   mycroft 	if (tagp != 0)
    315       1.1   mycroft 		*tagp = tag;
    316       1.1   mycroft 	if (handlep != 0)
    317       1.1   mycroft 		*handlep = handle;
    318       1.1   mycroft 	if (basep != 0)
    319       1.1   mycroft 		*basep = base;
    320       1.1   mycroft 	if (sizep != 0)
    321       1.1   mycroft 		*sizep = size;
    322       1.1   mycroft 
    323       1.1   mycroft 	return (0);
    324       1.1   mycroft }
    325  1.14.6.1    simonb 
    326  1.14.6.1    simonb int
    327  1.14.6.1    simonb pci_find_rom(struct pci_attach_args *pa, bus_space_tag_t bst,
    328  1.14.6.1    simonb     bus_space_handle_t bsh, int type, bus_space_handle_t *romh, bus_size_t *sz)
    329  1.14.6.1    simonb {
    330  1.14.6.1    simonb 	bus_size_t	romsz, offset = 0, imagesz;
    331  1.14.6.1    simonb 	uint16_t	ptr;
    332  1.14.6.1    simonb 	int		done = 0;
    333  1.14.6.1    simonb 
    334  1.14.6.1    simonb 	if (pci_mem_find(pa->pa_pc, pa->pa_tag, PCI_MAPREG_ROM,
    335  1.14.6.1    simonb 	    PCI_MAPREG_TYPE_ROM, NULL, &romsz, NULL))
    336  1.14.6.1    simonb 		return 1;
    337  1.14.6.1    simonb 
    338  1.14.6.1    simonb 	/*
    339  1.14.6.1    simonb 	 * no upper bound check; i cannot imagine a 4GB ROM, but
    340  1.14.6.1    simonb 	 * it appears the spec would allow it!
    341  1.14.6.1    simonb 	 */
    342  1.14.6.1    simonb 	if (romsz < 1024)
    343  1.14.6.1    simonb 		return 1;
    344  1.14.6.1    simonb 
    345  1.14.6.1    simonb 	while (offset < romsz && !done){
    346  1.14.6.1    simonb 		struct pci_rom_header	hdr;
    347  1.14.6.1    simonb 		struct pci_rom		rom;
    348  1.14.6.1    simonb 
    349  1.14.6.1    simonb 		hdr.romh_magic = bus_space_read_2(bst, bsh,
    350  1.14.6.1    simonb 		    offset + offsetof (struct pci_rom_header, romh_magic));
    351  1.14.6.1    simonb 		hdr.romh_data_ptr = bus_space_read_2(bst, bsh,
    352  1.14.6.1    simonb 		    offset + offsetof (struct pci_rom_header, romh_data_ptr));
    353  1.14.6.1    simonb 
    354  1.14.6.1    simonb 		/* no warning: quite possibly ROM is simply not populated */
    355  1.14.6.1    simonb 		if (hdr.romh_magic != PCI_ROM_HEADER_MAGIC)
    356  1.14.6.1    simonb 			return 1;
    357  1.14.6.1    simonb 
    358  1.14.6.1    simonb 		ptr = offset + hdr.romh_data_ptr;
    359  1.14.6.1    simonb 
    360  1.14.6.1    simonb 		if (ptr > romsz) {
    361  1.14.6.1    simonb 			printf("pci_find_rom: rom data ptr out of range\n");
    362  1.14.6.1    simonb 			return 1;
    363  1.14.6.1    simonb 		}
    364  1.14.6.1    simonb 
    365  1.14.6.1    simonb 		rom.rom_signature = bus_space_read_4(bst, bsh, ptr);
    366  1.14.6.1    simonb 		rom.rom_vendor = bus_space_read_2(bst, bsh, ptr +
    367  1.14.6.1    simonb 		    offsetof(struct pci_rom, rom_vendor));
    368  1.14.6.1    simonb 		rom.rom_product = bus_space_read_2(bst, bsh, ptr +
    369  1.14.6.1    simonb 		    offsetof(struct pci_rom, rom_product));
    370  1.14.6.1    simonb 		rom.rom_class = bus_space_read_1(bst, bsh,
    371  1.14.6.1    simonb 		    ptr + offsetof (struct pci_rom, rom_class));
    372  1.14.6.1    simonb 		rom.rom_subclass = bus_space_read_1(bst, bsh,
    373  1.14.6.1    simonb 		    ptr + offsetof (struct pci_rom, rom_subclass));
    374  1.14.6.1    simonb 		rom.rom_interface = bus_space_read_1(bst, bsh,
    375  1.14.6.1    simonb 		    ptr + offsetof (struct pci_rom, rom_interface));
    376  1.14.6.1    simonb 		rom.rom_len = bus_space_read_2(bst, bsh,
    377  1.14.6.1    simonb 		    ptr + offsetof (struct pci_rom, rom_len));
    378  1.14.6.1    simonb 		rom.rom_code_type = bus_space_read_1(bst, bsh,
    379  1.14.6.1    simonb 		    ptr + offsetof (struct pci_rom, rom_code_type));
    380  1.14.6.1    simonb 		rom.rom_indicator = bus_space_read_1(bst, bsh,
    381  1.14.6.1    simonb 		    ptr + offsetof (struct pci_rom, rom_indicator));
    382  1.14.6.1    simonb 
    383  1.14.6.1    simonb 		if (rom.rom_signature != PCI_ROM_SIGNATURE) {
    384  1.14.6.1    simonb 			printf("pci_find_rom: bad rom data signature\n");
    385  1.14.6.1    simonb 			return 1;
    386  1.14.6.1    simonb 		}
    387  1.14.6.1    simonb 
    388  1.14.6.1    simonb 		imagesz = rom.rom_len * 512;
    389  1.14.6.1    simonb 
    390  1.14.6.1    simonb 		if ((rom.rom_vendor == PCI_VENDOR(pa->pa_id)) &&
    391  1.14.6.1    simonb 		    (rom.rom_product == PCI_PRODUCT(pa->pa_id)) &&
    392  1.14.6.1    simonb 		    (rom.rom_class == PCI_CLASS(pa->pa_class)) &&
    393  1.14.6.1    simonb 		    (rom.rom_subclass == PCI_SUBCLASS(pa->pa_class)) &&
    394  1.14.6.1    simonb 		    (rom.rom_interface == PCI_INTERFACE(pa->pa_class)) &&
    395  1.14.6.1    simonb 		    (rom.rom_code_type == type)) {
    396  1.14.6.1    simonb 			*sz = imagesz;
    397  1.14.6.1    simonb 			bus_space_subregion(bst, bsh, offset, imagesz, romh);
    398  1.14.6.1    simonb 			return 0;
    399  1.14.6.1    simonb 		}
    400  1.14.6.1    simonb 
    401  1.14.6.1    simonb 		/* last image check */
    402  1.14.6.1    simonb 		if (rom.rom_indicator & PCI_ROM_INDICATOR_LAST)
    403  1.14.6.1    simonb 			return 1;
    404  1.14.6.1    simonb 
    405  1.14.6.1    simonb 		/* offset by size */
    406  1.14.6.1    simonb 		offset += imagesz;
    407  1.14.6.1    simonb 	}
    408  1.14.6.1    simonb 	return 1;
    409  1.14.6.1    simonb }
    410