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