Home | History | Annotate | Line # | Download | only in pci
pci.c revision 1.55
      1  1.55      fvdl /*	$NetBSD: pci.c,v 1.55 2001/09/10 10:04:49 fvdl Exp $	*/
      2   1.3       cgd 
      3   1.1   mycroft /*
      4  1.37       cgd  * Copyright (c) 1995, 1996, 1997, 1998
      5  1.27       cgd  *     Christopher G. Demetriou.  All rights reserved.
      6  1.39   mycroft  * Copyright (c) 1994 Charles M. Hannum.  All rights reserved.
      7   1.1   mycroft  *
      8   1.1   mycroft  * Redistribution and use in source and binary forms, with or without
      9   1.1   mycroft  * modification, are permitted provided that the following conditions
     10   1.1   mycroft  * are met:
     11   1.1   mycroft  * 1. Redistributions of source code must retain the above copyright
     12   1.1   mycroft  *    notice, this list of conditions and the following disclaimer.
     13   1.1   mycroft  * 2. Redistributions in binary form must reproduce the above copyright
     14   1.1   mycroft  *    notice, this list of conditions and the following disclaimer in the
     15   1.1   mycroft  *    documentation and/or other materials provided with the distribution.
     16   1.1   mycroft  * 3. All advertising materials mentioning features or use of this software
     17   1.1   mycroft  *    must display the following acknowledgement:
     18  1.39   mycroft  *	This product includes software developed by Charles M. Hannum.
     19   1.1   mycroft  * 4. The name of the author may not be used to endorse or promote products
     20   1.1   mycroft  *    derived from this software without specific prior written permission.
     21   1.1   mycroft  *
     22   1.1   mycroft  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
     23   1.1   mycroft  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
     24   1.1   mycroft  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
     25   1.1   mycroft  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
     26   1.1   mycroft  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
     27   1.1   mycroft  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
     28   1.1   mycroft  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
     29   1.1   mycroft  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
     30   1.1   mycroft  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
     31   1.1   mycroft  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
     32   1.1   mycroft  */
     33   1.1   mycroft 
     34   1.1   mycroft /*
     35  1.10       cgd  * PCI bus autoconfiguration.
     36   1.1   mycroft  */
     37   1.1   mycroft 
     38  1.45       cgd #include "opt_pci.h"
     39  1.45       cgd 
     40   1.1   mycroft #include <sys/param.h>
     41  1.10       cgd #include <sys/systm.h>
     42   1.1   mycroft #include <sys/device.h>
     43   1.1   mycroft 
     44  1.10       cgd #include <dev/pci/pcireg.h>
     45   1.7       cgd #include <dev/pci/pcivar.h>
     46  1.33       cgd #include <dev/pci/pcidevs.h>
     47  1.10       cgd 
     48  1.45       cgd #ifdef PCI_CONFIG_DUMP
     49  1.45       cgd int pci_config_dump = 1;
     50  1.45       cgd #else
     51  1.45       cgd int pci_config_dump = 0;
     52  1.45       cgd #endif
     53  1.45       cgd 
     54  1.26       cgd int pcimatch __P((struct device *, struct cfdata *, void *));
     55  1.10       cgd void pciattach __P((struct device *, struct device *, void *));
     56  1.10       cgd 
     57  1.34  drochner struct pci_softc {
     58  1.34  drochner 	struct device sc_dev;
     59  1.34  drochner 	bus_space_tag_t sc_iot, sc_memt;
     60  1.34  drochner 	bus_dma_tag_t sc_dmat;
     61  1.34  drochner 	pci_chipset_tag_t sc_pc;
     62  1.34  drochner 	int sc_bus, sc_maxndevs;
     63  1.34  drochner 	u_int sc_intrswiz;
     64  1.34  drochner 	pcitag_t sc_intrtag;
     65  1.34  drochner 	int sc_flags;
     66  1.34  drochner };
     67  1.34  drochner 
     68  1.16   thorpej struct cfattach pci_ca = {
     69  1.34  drochner 	sizeof(struct pci_softc), pcimatch, pciattach
     70  1.10       cgd };
     71  1.10       cgd 
     72  1.55      fvdl int	pci_probe_bus(struct device *, int (*match)(struct pci_attach_args *),
     73  1.55      fvdl 		      struct pci_attach_args *);
     74  1.21       cgd int	pciprint __P((void *, const char *));
     75  1.26       cgd int	pcisubmatch __P((struct device *, struct cfdata *, void *));
     76  1.10       cgd 
     77  1.25       cgd /*
     78  1.38   thorpej  * Important note about PCI-ISA bridges:
     79  1.38   thorpej  *
     80  1.38   thorpej  * Callbacks are used to configure these devices so that ISA/EISA bridges
     81  1.38   thorpej  * can attach their child busses after PCI configuration is done.
     82  1.25       cgd  *
     83  1.25       cgd  * This works because:
     84  1.25       cgd  *	(1) there can be at most one ISA/EISA bridge per PCI bus, and
     85  1.25       cgd  *	(2) any ISA/EISA bridges must be attached to primary PCI
     86  1.25       cgd  *	    busses (i.e. bus zero).
     87  1.25       cgd  *
     88  1.25       cgd  * That boils down to: there can only be one of these outstanding
     89  1.25       cgd  * at a time, it is cleared when configuring PCI bus 0 before any
     90  1.25       cgd  * subdevices have been found, and it is run after all subdevices
     91  1.25       cgd  * of PCI bus 0 have been found.
     92  1.25       cgd  *
     93  1.25       cgd  * This is needed because there are some (legacy) PCI devices which
     94  1.25       cgd  * can show up as ISA/EISA devices as well (the prime example of which
     95  1.25       cgd  * are VGA controllers).  If you attach ISA from a PCI-ISA/EISA bridge,
     96  1.25       cgd  * and the bridge is seen before the video board is, the board can show
     97  1.25       cgd  * up as an ISA device, and that can (bogusly) complicate the PCI device's
     98  1.25       cgd  * attach code, or make the PCI device not be properly attached at all.
     99  1.38   thorpej  *
    100  1.38   thorpej  * We use the generic config_defer() facility to achieve this.
    101  1.25       cgd  */
    102  1.25       cgd 
    103  1.10       cgd int
    104  1.26       cgd pcimatch(parent, cf, aux)
    105  1.10       cgd 	struct device *parent;
    106  1.26       cgd 	struct cfdata *cf;
    107  1.26       cgd 	void *aux;
    108  1.10       cgd {
    109  1.10       cgd 	struct pcibus_attach_args *pba = aux;
    110  1.10       cgd 
    111  1.10       cgd 	if (strcmp(pba->pba_busname, cf->cf_driver->cd_name))
    112  1.10       cgd 		return (0);
    113  1.10       cgd 
    114  1.10       cgd 	/* Check the locators */
    115  1.14       cgd 	if (cf->pcibuscf_bus != PCIBUS_UNK_BUS &&
    116  1.14       cgd 	    cf->pcibuscf_bus != pba->pba_bus)
    117  1.10       cgd 		return (0);
    118  1.10       cgd 
    119  1.10       cgd 	/* sanity */
    120  1.10       cgd 	if (pba->pba_bus < 0 || pba->pba_bus > 255)
    121  1.10       cgd 		return (0);
    122  1.10       cgd 
    123  1.10       cgd 	/*
    124  1.10       cgd 	 * XXX check other (hardware?) indicators
    125  1.10       cgd 	 */
    126  1.10       cgd 
    127  1.10       cgd 	return 1;
    128  1.10       cgd }
    129  1.10       cgd 
    130  1.51       mrg /* XXX
    131  1.51       mrg  * The __PCI_BUS_DEVORDER/__PCI_DEV_FUNCORDER macros should go away
    132  1.51       mrg  * and be implemented with device properties when they arrive.
    133  1.51       mrg  */
    134  1.55      fvdl int
    135  1.55      fvdl pci_probe_bus(struct device *self, int (*match)(struct pci_attach_args *),
    136  1.55      fvdl 	      struct pci_attach_args *pap)
    137  1.10       cgd {
    138  1.34  drochner 	struct pci_softc *sc = (struct pci_softc *)self;
    139  1.24   thorpej 	bus_space_tag_t iot, memt;
    140  1.18       cgd 	pci_chipset_tag_t pc;
    141  1.37       cgd 	const struct pci_quirkdata *qd;
    142  1.55      fvdl 	int bus, device, function, nfunctions, ret;
    143  1.51       mrg #ifdef __PCI_BUS_DEVORDER
    144  1.51       mrg 	char devs[32];
    145  1.51       mrg 	int i;
    146  1.51       mrg #endif
    147  1.51       mrg #ifdef __PCI_DEV_FUNCORDER
    148  1.51       mrg 	char funcs[8];
    149  1.51       mrg 	int j;
    150  1.51       mrg #endif
    151  1.31   thorpej 
    152  1.34  drochner 	iot = sc->sc_iot;
    153  1.34  drochner 	memt = sc->sc_memt;
    154  1.34  drochner 	pc = sc->sc_pc;
    155  1.34  drochner 	bus = sc->sc_bus;
    156  1.51       mrg #ifdef __PCI_BUS_DEVORDER
    157  1.51       mrg 	pci_bus_devorder(sc->sc_pc, sc->sc_bus, devs);
    158  1.51       mrg 	for (i = 0; (device = devs[i]) < 32 && device >= 0; i++)
    159  1.51       mrg #else
    160  1.51       mrg 	for (device = 0; device < sc->sc_maxndevs; device++)
    161  1.51       mrg #endif
    162  1.51       mrg 	{
    163  1.10       cgd 		pcitag_t tag;
    164  1.27       cgd 		pcireg_t id, class, intr, bhlcr, csr;
    165  1.10       cgd 		struct pci_attach_args pa;
    166  1.19  christos 		int pin;
    167  1.10       cgd 
    168  1.18       cgd 		tag = pci_make_tag(pc, bus, device, 0);
    169  1.18       cgd 		id = pci_conf_read(pc, tag, PCI_ID_REG);
    170  1.32       cgd 
    171  1.32       cgd 		/* Invalid vendor ID value? */
    172  1.33       cgd 		if (PCI_VENDOR(id) == PCI_VENDOR_INVALID)
    173  1.32       cgd 			continue;
    174  1.32       cgd 		/* XXX Not invalid, but we've done this ~forever. */
    175  1.32       cgd 		if (PCI_VENDOR(id) == 0)
    176  1.10       cgd 			continue;
    177  1.10       cgd 
    178  1.37       cgd 		qd = pci_lookup_quirkdata(PCI_VENDOR(id), PCI_PRODUCT(id));
    179  1.37       cgd 
    180  1.18       cgd 		bhlcr = pci_conf_read(pc, tag, PCI_BHLC_REG);
    181  1.37       cgd 		if (PCI_HDRTYPE_MULTIFN(bhlcr) ||
    182  1.37       cgd 		    (qd != NULL &&
    183  1.37       cgd 		      (qd->quirks & PCI_QUIRK_MULTIFUNCTION) != 0))
    184  1.37       cgd 			nfunctions = 8;
    185  1.37       cgd 		else
    186  1.37       cgd 			nfunctions = 1;
    187  1.10       cgd 
    188  1.51       mrg #ifdef __PCI_DEV_FUNCORDER
    189  1.51       mrg 		pci_dev_funcorder(sc->sc_pc, sc->sc_bus, device, funcs);
    190  1.51       mrg 		for (j = 0; (function = funcs[j]) < nfunctions &&
    191  1.51       mrg 		    function >= 0; j++)
    192  1.51       mrg #else
    193  1.51       mrg 		for (function = 0; function < nfunctions; function++)
    194  1.51       mrg #endif
    195  1.51       mrg 		{
    196  1.18       cgd 			tag = pci_make_tag(pc, bus, device, function);
    197  1.18       cgd 			id = pci_conf_read(pc, tag, PCI_ID_REG);
    198  1.27       cgd 			csr = pci_conf_read(pc, tag, PCI_COMMAND_STATUS_REG);
    199  1.18       cgd 			class = pci_conf_read(pc, tag, PCI_CLASS_REG);
    200  1.18       cgd 			intr = pci_conf_read(pc, tag, PCI_INTERRUPT_REG);
    201  1.53   thorpej 			bhlcr = pci_conf_read(pc, tag, PCI_BHLC_REG);
    202  1.32       cgd 
    203  1.32       cgd 			/* Invalid vendor ID value? */
    204  1.33       cgd 			if (PCI_VENDOR(id) == PCI_VENDOR_INVALID)
    205  1.32       cgd 				continue;
    206  1.32       cgd 			/* XXX Not invalid, but we've done this ~forever. */
    207  1.32       cgd 			if (PCI_VENDOR(id) == 0)
    208  1.32       cgd 				continue;
    209  1.10       cgd 
    210  1.24   thorpej 			pa.pa_iot = iot;
    211  1.24   thorpej 			pa.pa_memt = memt;
    212  1.34  drochner 			pa.pa_dmat = sc->sc_dmat;
    213  1.18       cgd 			pa.pa_pc = pc;
    214  1.52    bouyer 			pa.pa_bus = bus;
    215  1.10       cgd 			pa.pa_device = device;
    216  1.10       cgd 			pa.pa_function = function;
    217  1.10       cgd 			pa.pa_tag = tag;
    218  1.10       cgd 			pa.pa_id = id;
    219  1.10       cgd 			pa.pa_class = class;
    220  1.10       cgd 
    221  1.44   thorpej 			/*
    222  1.44   thorpej 			 * Set up memory, I/O enable, and PCI command flags
    223  1.44   thorpej 			 * as appropriate.
    224  1.44   thorpej 			 */
    225  1.44   thorpej 			pa.pa_flags = sc->sc_flags;
    226  1.44   thorpej 			if ((csr & PCI_COMMAND_IO_ENABLE) == 0)
    227  1.44   thorpej 				pa.pa_flags &= ~PCI_FLAGS_IO_ENABLED;
    228  1.44   thorpej 			if ((csr & PCI_COMMAND_MEM_ENABLE) == 0)
    229  1.44   thorpej 				pa.pa_flags &= ~PCI_FLAGS_MEM_ENABLED;
    230  1.53   thorpej 
    231  1.53   thorpej 			/*
    232  1.53   thorpej 			 * If the cache line size is not configured, then
    233  1.53   thorpej 			 * clear the MRL/MRM/MWI command-ok flags.
    234  1.53   thorpej 			 */
    235  1.53   thorpej 			if (PCI_CACHELINE(bhlcr) == 0)
    236  1.53   thorpej 				pa.pa_flags &= ~(PCI_FLAGS_MRL_OKAY|
    237  1.53   thorpej 				    PCI_FLAGS_MRM_OKAY|PCI_FLAGS_MWI_OKAY);
    238  1.27       cgd 
    239  1.18       cgd 			if (bus == 0) {
    240  1.18       cgd 				pa.pa_intrswiz = 0;
    241  1.18       cgd 				pa.pa_intrtag = tag;
    242  1.18       cgd 			} else {
    243  1.34  drochner 				pa.pa_intrswiz = sc->sc_intrswiz + device;
    244  1.34  drochner 				pa.pa_intrtag = sc->sc_intrtag;
    245  1.18       cgd 			}
    246  1.18       cgd 			pin = PCI_INTERRUPT_PIN(intr);
    247  1.18       cgd 			if (pin == PCI_INTERRUPT_PIN_NONE) {
    248  1.18       cgd 				/* no interrupt */
    249  1.18       cgd 				pa.pa_intrpin = 0;
    250  1.18       cgd 			} else {
    251  1.18       cgd 				/*
    252  1.18       cgd 				 * swizzle it based on the number of
    253  1.18       cgd 				 * busses we're behind and our device
    254  1.18       cgd 				 * number.
    255  1.18       cgd 				 */
    256  1.18       cgd 				pa.pa_intrpin =			/* XXX */
    257  1.18       cgd 				    ((pin + pa.pa_intrswiz - 1) % 4) + 1;
    258  1.18       cgd 			}
    259  1.18       cgd 			pa.pa_intrline = PCI_INTERRUPT_LINE(intr);
    260  1.18       cgd 
    261  1.55      fvdl 			if (match != NULL) {
    262  1.55      fvdl 				ret = match(&pa);
    263  1.55      fvdl 				if (ret != 0) {
    264  1.55      fvdl 					if (pap != NULL)
    265  1.55      fvdl 						*pap = pa;
    266  1.55      fvdl 					return ret;
    267  1.55      fvdl 				}
    268  1.55      fvdl 			} else {
    269  1.55      fvdl 				config_found_sm(self, &pa, pciprint,
    270  1.55      fvdl 				    pcisubmatch);
    271  1.55      fvdl 			}
    272  1.10       cgd 		}
    273  1.10       cgd 	}
    274  1.55      fvdl 	return 0;
    275  1.10       cgd }
    276   1.1   mycroft 
    277  1.34  drochner void
    278  1.34  drochner pciattach(parent, self, aux)
    279  1.34  drochner 	struct device *parent, *self;
    280  1.34  drochner 	void *aux;
    281  1.34  drochner {
    282  1.34  drochner 	struct pcibus_attach_args *pba = aux;
    283  1.34  drochner 	struct pci_softc *sc = (struct pci_softc *)self;
    284  1.43   thorpej 	int io_enabled, mem_enabled, mrl_enabled, mrm_enabled, mwi_enabled;
    285  1.43   thorpej 	const char *sep = "";
    286  1.34  drochner 
    287  1.34  drochner 	pci_attach_hook(parent, self, pba);
    288  1.34  drochner 	printf("\n");
    289  1.34  drochner 
    290  1.34  drochner 	io_enabled = (pba->pba_flags & PCI_FLAGS_IO_ENABLED);
    291  1.34  drochner 	mem_enabled = (pba->pba_flags & PCI_FLAGS_MEM_ENABLED);
    292  1.43   thorpej 	mrl_enabled = (pba->pba_flags & PCI_FLAGS_MRL_OKAY);
    293  1.43   thorpej 	mrm_enabled = (pba->pba_flags & PCI_FLAGS_MRM_OKAY);
    294  1.43   thorpej 	mwi_enabled = (pba->pba_flags & PCI_FLAGS_MWI_OKAY);
    295  1.34  drochner 
    296  1.34  drochner 	if (io_enabled == 0 && mem_enabled == 0) {
    297  1.34  drochner 		printf("%s: no spaces enabled!\n", self->dv_xname);
    298  1.34  drochner 		return;
    299  1.34  drochner 	}
    300  1.34  drochner 
    301  1.43   thorpej #define	PRINT(s)	do { printf("%s%s", sep, s); sep = ", "; } while (0)
    302  1.43   thorpej 
    303  1.34  drochner 	printf("%s: ", self->dv_xname);
    304  1.43   thorpej 
    305  1.34  drochner 	if (io_enabled)
    306  1.43   thorpej 		PRINT("i/o space");
    307  1.43   thorpej 	if (mem_enabled)
    308  1.43   thorpej 		PRINT("memory space");
    309  1.43   thorpej 	printf(" enabled");
    310  1.43   thorpej 
    311  1.43   thorpej 	if (mrl_enabled || mrm_enabled || mwi_enabled) {
    312  1.43   thorpej 		if (mrl_enabled)
    313  1.43   thorpej 			PRINT("rd/line");
    314  1.43   thorpej 		if (mrm_enabled)
    315  1.43   thorpej 			PRINT("rd/mult");
    316  1.43   thorpej 		if (mwi_enabled)
    317  1.43   thorpej 			PRINT("wr/inv");
    318  1.43   thorpej 		printf(" ok");
    319  1.34  drochner 	}
    320  1.43   thorpej 
    321  1.34  drochner 	printf("\n");
    322  1.43   thorpej 
    323  1.43   thorpej #undef PRINT
    324  1.34  drochner 
    325  1.34  drochner 	sc->sc_iot = pba->pba_iot;
    326  1.34  drochner 	sc->sc_memt = pba->pba_memt;
    327  1.34  drochner 	sc->sc_dmat = pba->pba_dmat;
    328  1.34  drochner 	sc->sc_pc = pba->pba_pc;
    329  1.34  drochner 	sc->sc_bus = pba->pba_bus;
    330  1.34  drochner 	sc->sc_maxndevs = pci_bus_maxdevs(pba->pba_pc, pba->pba_bus);
    331  1.34  drochner 	sc->sc_intrswiz = pba->pba_intrswiz;
    332  1.34  drochner 	sc->sc_intrtag = pba->pba_intrtag;
    333  1.34  drochner 	sc->sc_flags = pba->pba_flags;
    334  1.55      fvdl 	pci_probe_bus(self, NULL, NULL);
    335  1.34  drochner }
    336  1.34  drochner 
    337   1.1   mycroft int
    338  1.10       cgd pciprint(aux, pnp)
    339   1.1   mycroft 	void *aux;
    340  1.21       cgd 	const char *pnp;
    341   1.1   mycroft {
    342  1.46  augustss 	struct pci_attach_args *pa = aux;
    343  1.10       cgd 	char devinfo[256];
    344  1.37       cgd 	const struct pci_quirkdata *qd;
    345   1.1   mycroft 
    346  1.10       cgd 	if (pnp) {
    347  1.10       cgd 		pci_devinfo(pa->pa_id, pa->pa_class, 1, devinfo);
    348  1.23  christos 		printf("%s at %s", devinfo, pnp);
    349  1.10       cgd 	}
    350  1.23  christos 	printf(" dev %d function %d", pa->pa_device, pa->pa_function);
    351  1.45       cgd 	if (pci_config_dump) {
    352  1.45       cgd 		printf(": ");
    353  1.45       cgd 		pci_conf_print(pa->pa_pc, pa->pa_tag, NULL);
    354  1.45       cgd 		if (!pnp)
    355  1.45       cgd 			pci_devinfo(pa->pa_id, pa->pa_class, 1, devinfo);
    356  1.45       cgd 		printf("%s at %s", devinfo, pnp ? pnp : "?");
    357  1.45       cgd 		printf(" dev %d function %d (", pa->pa_device, pa->pa_function);
    358  1.37       cgd #ifdef __i386__
    359  1.45       cgd 		printf("tag %#lx, intrtag %#lx, intrswiz %#lx, intrpin %#lx",
    360  1.45       cgd 		    *(long *)&pa->pa_tag, *(long *)&pa->pa_intrtag,
    361  1.45       cgd 		    (long)pa->pa_intrswiz, (long)pa->pa_intrpin);
    362  1.37       cgd #else
    363  1.54       mrg 		printf("intrswiz %#lx, intrpin %#lx",
    364  1.54       mrg 		    (long)pa->pa_intrswiz, (long)pa->pa_intrpin);
    365  1.36       cgd #endif
    366  1.45       cgd 		printf(", i/o %s, mem %s,",
    367  1.45       cgd 		    pa->pa_flags & PCI_FLAGS_IO_ENABLED ? "on" : "off",
    368  1.45       cgd 		    pa->pa_flags & PCI_FLAGS_MEM_ENABLED ? "on" : "off");
    369  1.45       cgd 		qd = pci_lookup_quirkdata(PCI_VENDOR(pa->pa_id),
    370  1.45       cgd 		    PCI_PRODUCT(pa->pa_id));
    371  1.45       cgd 		if (qd == NULL) {
    372  1.45       cgd 			printf(" no quirks");
    373  1.45       cgd 		} else {
    374  1.45       cgd 			bitmask_snprintf(qd->quirks,
    375  1.45       cgd 			    "\20\1multifn", devinfo, sizeof (devinfo));
    376  1.45       cgd 			printf(" quirks %s", devinfo);
    377  1.45       cgd 		}
    378  1.45       cgd 		printf(")");
    379  1.37       cgd 	}
    380   1.6   mycroft 	return (UNCONF);
    381   1.6   mycroft }
    382   1.6   mycroft 
    383   1.6   mycroft int
    384  1.26       cgd pcisubmatch(parent, cf, aux)
    385   1.6   mycroft 	struct device *parent;
    386  1.26       cgd 	struct cfdata *cf;
    387  1.26       cgd 	void *aux;
    388   1.6   mycroft {
    389   1.6   mycroft 	struct pci_attach_args *pa = aux;
    390   1.6   mycroft 
    391  1.14       cgd 	if (cf->pcicf_dev != PCI_UNK_DEV &&
    392  1.14       cgd 	    cf->pcicf_dev != pa->pa_device)
    393   1.6   mycroft 		return 0;
    394  1.14       cgd 	if (cf->pcicf_function != PCI_UNK_FUNCTION &&
    395  1.14       cgd 	    cf->pcicf_function != pa->pa_function)
    396   1.6   mycroft 		return 0;
    397  1.26       cgd 	return ((*cf->cf_attach->ca_match)(parent, cf, aux));
    398  1.40  drochner }
    399  1.40  drochner 
    400  1.40  drochner int
    401  1.40  drochner pci_get_capability(pc, tag, capid, offset, value)
    402  1.40  drochner 	pci_chipset_tag_t pc;
    403  1.40  drochner 	pcitag_t tag;
    404  1.40  drochner 	int capid;
    405  1.40  drochner 	int *offset;
    406  1.40  drochner 	pcireg_t *value;
    407  1.40  drochner {
    408  1.40  drochner 	pcireg_t reg;
    409  1.40  drochner 	unsigned int ofs;
    410  1.40  drochner 
    411  1.40  drochner 	reg = pci_conf_read(pc, tag, PCI_COMMAND_STATUS_REG);
    412  1.40  drochner 	if (!(reg & PCI_STATUS_CAPLIST_SUPPORT))
    413  1.40  drochner 		return (0);
    414  1.40  drochner 
    415  1.48    kleink 	/* Determine the Capability List Pointer register to start with. */
    416  1.47    kleink 	reg = pci_conf_read(pc, tag, PCI_BHLC_REG);
    417  1.47    kleink 	switch (PCI_HDRTYPE_TYPE(reg)) {
    418  1.47    kleink 	case 0:	/* standard device header */
    419  1.47    kleink 		ofs = PCI_CAPLISTPTR_REG;
    420  1.47    kleink 		break;
    421  1.47    kleink 	case 2:	/* PCI-CardBus Bridge header */
    422  1.47    kleink 		ofs = PCI_CARDBUS_CAPLISTPTR_REG;
    423  1.47    kleink 		break;
    424  1.47    kleink 	default:
    425  1.47    kleink 		return (0);
    426  1.47    kleink 	}
    427  1.47    kleink 
    428  1.47    kleink 	ofs = PCI_CAPLIST_PTR(pci_conf_read(pc, tag, ofs));
    429  1.40  drochner 	while (ofs != 0) {
    430  1.40  drochner #ifdef DIAGNOSTIC
    431  1.40  drochner 		if ((ofs & 3) || (ofs < 0x40))
    432  1.40  drochner 			panic("pci_get_capability");
    433  1.40  drochner #endif
    434  1.40  drochner 		reg = pci_conf_read(pc, tag, ofs);
    435  1.40  drochner 		if (PCI_CAPLIST_CAP(reg) == capid) {
    436  1.40  drochner 			if (offset)
    437  1.40  drochner 				*offset = ofs;
    438  1.40  drochner 			if (value)
    439  1.40  drochner 				*value = reg;
    440  1.40  drochner 			return (1);
    441  1.40  drochner 		}
    442  1.40  drochner 		ofs = PCI_CAPLIST_NEXT(reg);
    443  1.40  drochner 	}
    444  1.40  drochner 
    445  1.40  drochner 	return (0);
    446  1.55      fvdl }
    447  1.55      fvdl 
    448  1.55      fvdl int
    449  1.55      fvdl pci_find_device(struct pci_attach_args *pa,
    450  1.55      fvdl 		int (*match)(struct pci_attach_args *))
    451  1.55      fvdl {
    452  1.55      fvdl 	int i;
    453  1.55      fvdl 	struct device *pcidev;
    454  1.55      fvdl 	extern struct cfdriver pci_cd;
    455  1.55      fvdl 
    456  1.55      fvdl 	for (i = 0; i < pci_cd.cd_ndevs; i++) {
    457  1.55      fvdl 		pcidev = pci_cd.cd_devs[i];
    458  1.55      fvdl 		if (pcidev != NULL && pci_probe_bus(pcidev, match, pa) != 0)
    459  1.55      fvdl 			return 1;
    460  1.55      fvdl 	}
    461  1.55      fvdl 	return 0;
    462   1.1   mycroft }
    463