Home | History | Annotate | Line # | Download | only in pci
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