Home | History | Annotate | Line # | Download | only in pci
pci.c revision 1.51.2.10
      1  1.51.2.10   thorpej /*	$NetBSD: pci.c,v 1.51.2.10 2003/01/03 17:07:57 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.51.2.5   nathanw 
     38   1.51.2.5   nathanw #include <sys/cdefs.h>
     39  1.51.2.10   thorpej __KERNEL_RCSID(0, "$NetBSD: pci.c,v 1.51.2.10 2003/01/03 17:07:57 thorpej Exp $");
     40        1.1   mycroft 
     41       1.45       cgd #include "opt_pci.h"
     42       1.45       cgd 
     43        1.1   mycroft #include <sys/param.h>
     44       1.10       cgd #include <sys/systm.h>
     45        1.1   mycroft #include <sys/device.h>
     46        1.1   mycroft 
     47       1.10       cgd #include <dev/pci/pcireg.h>
     48        1.7       cgd #include <dev/pci/pcivar.h>
     49       1.33       cgd #include <dev/pci/pcidevs.h>
     50       1.10       cgd 
     51       1.45       cgd #ifdef PCI_CONFIG_DUMP
     52       1.45       cgd int pci_config_dump = 1;
     53       1.45       cgd #else
     54       1.45       cgd int pci_config_dump = 0;
     55       1.45       cgd #endif
     56       1.45       cgd 
     57       1.26       cgd int pcimatch __P((struct device *, struct cfdata *, void *));
     58       1.10       cgd void pciattach __P((struct device *, struct device *, void *));
     59       1.10       cgd 
     60   1.51.2.8   nathanw CFATTACH_DECL(pci, sizeof(struct pci_softc),
     61   1.51.2.8   nathanw     pcimatch, pciattach, NULL, NULL);
     62       1.10       cgd 
     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.51.2.8   nathanw 	if (strcmp(pba->pba_busname, cf->cf_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.51.2.6   nathanw 	return (1);
    117       1.10       cgd }
    118        1.1   mycroft 
    119       1.34  drochner void
    120       1.34  drochner pciattach(parent, self, aux)
    121       1.34  drochner 	struct device *parent, *self;
    122       1.34  drochner 	void *aux;
    123       1.34  drochner {
    124       1.34  drochner 	struct pcibus_attach_args *pba = aux;
    125       1.34  drochner 	struct pci_softc *sc = (struct pci_softc *)self;
    126       1.43   thorpej 	int io_enabled, mem_enabled, mrl_enabled, mrm_enabled, mwi_enabled;
    127       1.43   thorpej 	const char *sep = "";
    128       1.34  drochner 
    129       1.34  drochner 	pci_attach_hook(parent, self, pba);
    130       1.34  drochner 	printf("\n");
    131       1.34  drochner 
    132       1.34  drochner 	io_enabled = (pba->pba_flags & PCI_FLAGS_IO_ENABLED);
    133       1.34  drochner 	mem_enabled = (pba->pba_flags & PCI_FLAGS_MEM_ENABLED);
    134       1.43   thorpej 	mrl_enabled = (pba->pba_flags & PCI_FLAGS_MRL_OKAY);
    135       1.43   thorpej 	mrm_enabled = (pba->pba_flags & PCI_FLAGS_MRM_OKAY);
    136       1.43   thorpej 	mwi_enabled = (pba->pba_flags & PCI_FLAGS_MWI_OKAY);
    137       1.34  drochner 
    138       1.34  drochner 	if (io_enabled == 0 && mem_enabled == 0) {
    139       1.34  drochner 		printf("%s: no spaces enabled!\n", self->dv_xname);
    140       1.34  drochner 		return;
    141       1.34  drochner 	}
    142       1.34  drochner 
    143   1.51.2.9   nathanw #define	PRINT(str)	do { printf("%s%s", sep, str); sep = ", "; } while (0)
    144       1.43   thorpej 
    145       1.34  drochner 	printf("%s: ", self->dv_xname);
    146       1.43   thorpej 
    147       1.34  drochner 	if (io_enabled)
    148       1.43   thorpej 		PRINT("i/o space");
    149       1.43   thorpej 	if (mem_enabled)
    150       1.43   thorpej 		PRINT("memory space");
    151       1.43   thorpej 	printf(" enabled");
    152       1.43   thorpej 
    153       1.43   thorpej 	if (mrl_enabled || mrm_enabled || mwi_enabled) {
    154       1.43   thorpej 		if (mrl_enabled)
    155       1.43   thorpej 			PRINT("rd/line");
    156       1.43   thorpej 		if (mrm_enabled)
    157       1.43   thorpej 			PRINT("rd/mult");
    158       1.43   thorpej 		if (mwi_enabled)
    159       1.43   thorpej 			PRINT("wr/inv");
    160       1.43   thorpej 		printf(" ok");
    161       1.34  drochner 	}
    162       1.43   thorpej 
    163       1.34  drochner 	printf("\n");
    164       1.43   thorpej 
    165       1.43   thorpej #undef PRINT
    166       1.34  drochner 
    167       1.34  drochner 	sc->sc_iot = pba->pba_iot;
    168       1.34  drochner 	sc->sc_memt = pba->pba_memt;
    169       1.34  drochner 	sc->sc_dmat = pba->pba_dmat;
    170       1.34  drochner 	sc->sc_pc = pba->pba_pc;
    171       1.34  drochner 	sc->sc_bus = pba->pba_bus;
    172   1.51.2.6   nathanw 	sc->sc_bridgetag = pba->pba_bridgetag;
    173       1.34  drochner 	sc->sc_maxndevs = pci_bus_maxdevs(pba->pba_pc, pba->pba_bus);
    174       1.34  drochner 	sc->sc_intrswiz = pba->pba_intrswiz;
    175       1.34  drochner 	sc->sc_intrtag = pba->pba_intrtag;
    176       1.34  drochner 	sc->sc_flags = pba->pba_flags;
    177   1.51.2.6   nathanw 	pci_enumerate_bus(sc, NULL, NULL);
    178       1.34  drochner }
    179       1.34  drochner 
    180        1.1   mycroft int
    181       1.10       cgd pciprint(aux, pnp)
    182        1.1   mycroft 	void *aux;
    183       1.21       cgd 	const char *pnp;
    184        1.1   mycroft {
    185       1.46  augustss 	struct pci_attach_args *pa = aux;
    186       1.10       cgd 	char devinfo[256];
    187       1.37       cgd 	const struct pci_quirkdata *qd;
    188        1.1   mycroft 
    189       1.10       cgd 	if (pnp) {
    190       1.10       cgd 		pci_devinfo(pa->pa_id, pa->pa_class, 1, devinfo);
    191  1.51.2.10   thorpej 		aprint_normal("%s at %s", devinfo, pnp);
    192       1.10       cgd 	}
    193  1.51.2.10   thorpej 	aprint_normal(" dev %d function %d", pa->pa_device, pa->pa_function);
    194       1.45       cgd 	if (pci_config_dump) {
    195       1.45       cgd 		printf(": ");
    196       1.45       cgd 		pci_conf_print(pa->pa_pc, pa->pa_tag, NULL);
    197       1.45       cgd 		if (!pnp)
    198       1.45       cgd 			pci_devinfo(pa->pa_id, pa->pa_class, 1, devinfo);
    199       1.45       cgd 		printf("%s at %s", devinfo, pnp ? pnp : "?");
    200       1.45       cgd 		printf(" dev %d function %d (", pa->pa_device, pa->pa_function);
    201       1.37       cgd #ifdef __i386__
    202       1.45       cgd 		printf("tag %#lx, intrtag %#lx, intrswiz %#lx, intrpin %#lx",
    203       1.45       cgd 		    *(long *)&pa->pa_tag, *(long *)&pa->pa_intrtag,
    204       1.45       cgd 		    (long)pa->pa_intrswiz, (long)pa->pa_intrpin);
    205       1.37       cgd #else
    206   1.51.2.2   nathanw 		printf("intrswiz %#lx, intrpin %#lx",
    207   1.51.2.2   nathanw 		    (long)pa->pa_intrswiz, (long)pa->pa_intrpin);
    208       1.36       cgd #endif
    209       1.45       cgd 		printf(", i/o %s, mem %s,",
    210       1.45       cgd 		    pa->pa_flags & PCI_FLAGS_IO_ENABLED ? "on" : "off",
    211       1.45       cgd 		    pa->pa_flags & PCI_FLAGS_MEM_ENABLED ? "on" : "off");
    212       1.45       cgd 		qd = pci_lookup_quirkdata(PCI_VENDOR(pa->pa_id),
    213       1.45       cgd 		    PCI_PRODUCT(pa->pa_id));
    214       1.45       cgd 		if (qd == NULL) {
    215       1.45       cgd 			printf(" no quirks");
    216       1.45       cgd 		} else {
    217       1.45       cgd 			bitmask_snprintf(qd->quirks,
    218       1.45       cgd 			    "\20\1multifn", devinfo, sizeof (devinfo));
    219       1.45       cgd 			printf(" quirks %s", devinfo);
    220       1.45       cgd 		}
    221       1.45       cgd 		printf(")");
    222       1.37       cgd 	}
    223        1.6   mycroft 	return (UNCONF);
    224        1.6   mycroft }
    225        1.6   mycroft 
    226        1.6   mycroft int
    227       1.26       cgd pcisubmatch(parent, cf, aux)
    228        1.6   mycroft 	struct device *parent;
    229       1.26       cgd 	struct cfdata *cf;
    230       1.26       cgd 	void *aux;
    231        1.6   mycroft {
    232        1.6   mycroft 	struct pci_attach_args *pa = aux;
    233        1.6   mycroft 
    234       1.14       cgd 	if (cf->pcicf_dev != PCI_UNK_DEV &&
    235       1.14       cgd 	    cf->pcicf_dev != pa->pa_device)
    236   1.51.2.6   nathanw 		return (0);
    237       1.14       cgd 	if (cf->pcicf_function != PCI_UNK_FUNCTION &&
    238       1.14       cgd 	    cf->pcicf_function != pa->pa_function)
    239   1.51.2.6   nathanw 		return (0);
    240   1.51.2.8   nathanw 	return (config_match(parent, cf, aux));
    241       1.40  drochner }
    242       1.40  drochner 
    243       1.40  drochner int
    244   1.51.2.6   nathanw pci_probe_device(struct pci_softc *sc, pcitag_t tag,
    245   1.51.2.6   nathanw     int (*match)(struct pci_attach_args *), struct pci_attach_args *pap)
    246   1.51.2.6   nathanw {
    247   1.51.2.6   nathanw 	pci_chipset_tag_t pc = sc->sc_pc;
    248   1.51.2.6   nathanw 	struct pci_attach_args pa;
    249   1.51.2.6   nathanw 	pcireg_t id, csr, class, intr, bhlcr;
    250   1.51.2.6   nathanw 	int ret, pin, bus, device, function;
    251   1.51.2.6   nathanw 
    252   1.51.2.6   nathanw 	pci_decompose_tag(pc, tag, &bus, &device, &function);
    253   1.51.2.6   nathanw 
    254   1.51.2.6   nathanw 	id = pci_conf_read(pc, tag, PCI_ID_REG);
    255   1.51.2.6   nathanw 	csr = pci_conf_read(pc, tag, PCI_COMMAND_STATUS_REG);
    256   1.51.2.6   nathanw 	class = pci_conf_read(pc, tag, PCI_CLASS_REG);
    257   1.51.2.6   nathanw 	intr = pci_conf_read(pc, tag, PCI_INTERRUPT_REG);
    258   1.51.2.6   nathanw 	bhlcr = pci_conf_read(pc, tag, PCI_BHLC_REG);
    259   1.51.2.6   nathanw 
    260   1.51.2.6   nathanw 	/* Invalid vendor ID value? */
    261   1.51.2.6   nathanw 	if (PCI_VENDOR(id) == PCI_VENDOR_INVALID)
    262   1.51.2.7   nathanw 		return (0);
    263   1.51.2.6   nathanw 	/* XXX Not invalid, but we've done this ~forever. */
    264   1.51.2.6   nathanw 	if (PCI_VENDOR(id) == 0)
    265   1.51.2.7   nathanw 		return (0);
    266   1.51.2.6   nathanw 
    267   1.51.2.6   nathanw 	pa.pa_iot = sc->sc_iot;
    268   1.51.2.6   nathanw 	pa.pa_memt = sc->sc_memt;
    269   1.51.2.6   nathanw 	pa.pa_dmat = sc->sc_dmat;
    270   1.51.2.6   nathanw 	pa.pa_pc = pc;
    271   1.51.2.6   nathanw 	pa.pa_bus = bus;
    272   1.51.2.6   nathanw 	pa.pa_device = device;
    273   1.51.2.6   nathanw 	pa.pa_function = function;
    274   1.51.2.6   nathanw 	pa.pa_tag = tag;
    275   1.51.2.6   nathanw 	pa.pa_id = id;
    276   1.51.2.6   nathanw 	pa.pa_class = class;
    277   1.51.2.6   nathanw 
    278   1.51.2.6   nathanw 	/*
    279   1.51.2.6   nathanw 	 * Set up memory, I/O enable, and PCI command flags
    280   1.51.2.6   nathanw 	 * as appropriate.
    281   1.51.2.6   nathanw 	 */
    282   1.51.2.6   nathanw 	pa.pa_flags = sc->sc_flags;
    283   1.51.2.6   nathanw 	if ((csr & PCI_COMMAND_IO_ENABLE) == 0)
    284   1.51.2.6   nathanw 		pa.pa_flags &= ~PCI_FLAGS_IO_ENABLED;
    285   1.51.2.6   nathanw 	if ((csr & PCI_COMMAND_MEM_ENABLE) == 0)
    286   1.51.2.6   nathanw 		pa.pa_flags &= ~PCI_FLAGS_MEM_ENABLED;
    287   1.51.2.6   nathanw 
    288   1.51.2.6   nathanw 	/*
    289   1.51.2.6   nathanw 	 * If the cache line size is not configured, then
    290   1.51.2.6   nathanw 	 * clear the MRL/MRM/MWI command-ok flags.
    291   1.51.2.6   nathanw 	 */
    292   1.51.2.6   nathanw 	if (PCI_CACHELINE(bhlcr) == 0)
    293   1.51.2.6   nathanw 		pa.pa_flags &= ~(PCI_FLAGS_MRL_OKAY|
    294   1.51.2.6   nathanw 		    PCI_FLAGS_MRM_OKAY|PCI_FLAGS_MWI_OKAY);
    295   1.51.2.6   nathanw 
    296   1.51.2.6   nathanw 	if (sc->sc_bridgetag == NULL) {
    297   1.51.2.6   nathanw 		pa.pa_intrswiz = 0;
    298   1.51.2.6   nathanw 		pa.pa_intrtag = tag;
    299   1.51.2.6   nathanw 	} else {
    300   1.51.2.6   nathanw 		pa.pa_intrswiz = sc->sc_intrswiz + device;
    301   1.51.2.6   nathanw 		pa.pa_intrtag = sc->sc_intrtag;
    302   1.51.2.6   nathanw 	}
    303   1.51.2.6   nathanw 	pin = PCI_INTERRUPT_PIN(intr);
    304   1.51.2.6   nathanw 	pa.pa_rawintrpin = pin;
    305   1.51.2.6   nathanw 	if (pin == PCI_INTERRUPT_PIN_NONE) {
    306   1.51.2.6   nathanw 		/* no interrupt */
    307   1.51.2.6   nathanw 		pa.pa_intrpin = 0;
    308   1.51.2.6   nathanw 	} else {
    309   1.51.2.6   nathanw 		/*
    310   1.51.2.6   nathanw 		 * swizzle it based on the number of busses we're
    311   1.51.2.6   nathanw 		 * behind and our device number.
    312   1.51.2.6   nathanw 		 */
    313   1.51.2.6   nathanw 		pa.pa_intrpin = 	/* XXX */
    314   1.51.2.6   nathanw 		    ((pin + pa.pa_intrswiz - 1) % 4) + 1;
    315   1.51.2.6   nathanw 	}
    316   1.51.2.6   nathanw 	pa.pa_intrline = PCI_INTERRUPT_LINE(intr);
    317   1.51.2.6   nathanw 
    318   1.51.2.6   nathanw 	if (match != NULL) {
    319   1.51.2.6   nathanw 		ret = (*match)(&pa);
    320   1.51.2.6   nathanw 		if (ret != 0 && pap != NULL)
    321   1.51.2.6   nathanw 			*pap = pa;
    322   1.51.2.6   nathanw 	} else {
    323   1.51.2.6   nathanw 		ret = config_found_sm(&sc->sc_dev, &pa, pciprint,
    324   1.51.2.6   nathanw 		    pcisubmatch) != NULL;
    325   1.51.2.6   nathanw 	}
    326   1.51.2.6   nathanw 
    327   1.51.2.6   nathanw 	return (ret);
    328   1.51.2.6   nathanw }
    329   1.51.2.6   nathanw 
    330   1.51.2.6   nathanw int
    331       1.40  drochner pci_get_capability(pc, tag, capid, offset, value)
    332       1.40  drochner 	pci_chipset_tag_t pc;
    333       1.40  drochner 	pcitag_t tag;
    334       1.40  drochner 	int capid;
    335       1.40  drochner 	int *offset;
    336       1.40  drochner 	pcireg_t *value;
    337       1.40  drochner {
    338       1.40  drochner 	pcireg_t reg;
    339       1.40  drochner 	unsigned int ofs;
    340       1.40  drochner 
    341       1.40  drochner 	reg = pci_conf_read(pc, tag, PCI_COMMAND_STATUS_REG);
    342       1.40  drochner 	if (!(reg & PCI_STATUS_CAPLIST_SUPPORT))
    343       1.40  drochner 		return (0);
    344       1.40  drochner 
    345       1.48    kleink 	/* Determine the Capability List Pointer register to start with. */
    346       1.47    kleink 	reg = pci_conf_read(pc, tag, PCI_BHLC_REG);
    347       1.47    kleink 	switch (PCI_HDRTYPE_TYPE(reg)) {
    348       1.47    kleink 	case 0:	/* standard device header */
    349       1.47    kleink 		ofs = PCI_CAPLISTPTR_REG;
    350       1.47    kleink 		break;
    351       1.47    kleink 	case 2:	/* PCI-CardBus Bridge header */
    352       1.47    kleink 		ofs = PCI_CARDBUS_CAPLISTPTR_REG;
    353       1.47    kleink 		break;
    354       1.47    kleink 	default:
    355       1.47    kleink 		return (0);
    356       1.47    kleink 	}
    357       1.47    kleink 
    358       1.47    kleink 	ofs = PCI_CAPLIST_PTR(pci_conf_read(pc, tag, ofs));
    359       1.40  drochner 	while (ofs != 0) {
    360       1.40  drochner #ifdef DIAGNOSTIC
    361       1.40  drochner 		if ((ofs & 3) || (ofs < 0x40))
    362       1.40  drochner 			panic("pci_get_capability");
    363       1.40  drochner #endif
    364       1.40  drochner 		reg = pci_conf_read(pc, tag, ofs);
    365       1.40  drochner 		if (PCI_CAPLIST_CAP(reg) == capid) {
    366       1.40  drochner 			if (offset)
    367       1.40  drochner 				*offset = ofs;
    368       1.40  drochner 			if (value)
    369       1.40  drochner 				*value = reg;
    370       1.40  drochner 			return (1);
    371       1.40  drochner 		}
    372       1.40  drochner 		ofs = PCI_CAPLIST_NEXT(reg);
    373       1.40  drochner 	}
    374       1.40  drochner 
    375       1.40  drochner 	return (0);
    376   1.51.2.3   nathanw }
    377   1.51.2.3   nathanw 
    378   1.51.2.3   nathanw int
    379   1.51.2.3   nathanw pci_find_device(struct pci_attach_args *pa,
    380   1.51.2.3   nathanw 		int (*match)(struct pci_attach_args *))
    381   1.51.2.3   nathanw {
    382   1.51.2.3   nathanw 	extern struct cfdriver pci_cd;
    383   1.51.2.6   nathanw 	struct device *pcidev;
    384   1.51.2.6   nathanw 	int i;
    385   1.51.2.3   nathanw 
    386   1.51.2.3   nathanw 	for (i = 0; i < pci_cd.cd_ndevs; i++) {
    387   1.51.2.3   nathanw 		pcidev = pci_cd.cd_devs[i];
    388   1.51.2.6   nathanw 		if (pcidev != NULL &&
    389   1.51.2.6   nathanw 		    pci_enumerate_bus((struct pci_softc *) pcidev,
    390   1.51.2.6   nathanw 		    		      match, pa) != 0)
    391   1.51.2.6   nathanw 			return (1);
    392   1.51.2.3   nathanw 	}
    393   1.51.2.6   nathanw 	return (0);
    394   1.51.2.6   nathanw }
    395   1.51.2.6   nathanw 
    396   1.51.2.6   nathanw /*
    397   1.51.2.6   nathanw  * Generic PCI bus enumeration routine.  Used unless machine-dependent
    398   1.51.2.6   nathanw  * code needs to provide something else.
    399   1.51.2.6   nathanw  */
    400   1.51.2.6   nathanw int
    401   1.51.2.6   nathanw pci_enumerate_bus_generic(struct pci_softc *sc,
    402   1.51.2.6   nathanw     int (*match)(struct pci_attach_args *), struct pci_attach_args *pap)
    403   1.51.2.6   nathanw {
    404   1.51.2.6   nathanw 	pci_chipset_tag_t pc = sc->sc_pc;
    405   1.51.2.6   nathanw 	int device, function, nfunctions, ret;
    406   1.51.2.6   nathanw 	const struct pci_quirkdata *qd;
    407   1.51.2.6   nathanw 	pcireg_t id, bhlcr;
    408   1.51.2.6   nathanw 	pcitag_t tag;
    409   1.51.2.6   nathanw #ifdef __PCI_BUS_DEVORDER
    410   1.51.2.6   nathanw 	char devs[32];
    411   1.51.2.6   nathanw 	int i;
    412   1.51.2.6   nathanw #endif
    413   1.51.2.6   nathanw 
    414   1.51.2.6   nathanw #ifdef __PCI_BUS_DEVORDER
    415   1.51.2.6   nathanw 	pci_bus_devorder(sc->sc_pc, sc->sc_bus, devs);
    416   1.51.2.6   nathanw 	for (i = 0; (device = devs[i]) < 32 && device >= 0; i++)
    417   1.51.2.6   nathanw #else
    418   1.51.2.6   nathanw 	for (device = 0; device < sc->sc_maxndevs; device++)
    419   1.51.2.6   nathanw #endif
    420   1.51.2.6   nathanw 	{
    421   1.51.2.6   nathanw 		tag = pci_make_tag(pc, sc->sc_bus, device, 0);
    422   1.51.2.6   nathanw 		id = pci_conf_read(pc, tag, PCI_ID_REG);
    423   1.51.2.6   nathanw 
    424   1.51.2.6   nathanw 		/* Invalid vendor ID value? */
    425   1.51.2.6   nathanw 		if (PCI_VENDOR(id) == PCI_VENDOR_INVALID)
    426   1.51.2.6   nathanw 			continue;
    427   1.51.2.6   nathanw 		/* XXX Not invalid, but we've done this ~forever. */
    428   1.51.2.6   nathanw 		if (PCI_VENDOR(id) == 0)
    429   1.51.2.6   nathanw 			continue;
    430   1.51.2.6   nathanw 
    431   1.51.2.6   nathanw 		qd = pci_lookup_quirkdata(PCI_VENDOR(id), PCI_PRODUCT(id));
    432   1.51.2.6   nathanw 
    433   1.51.2.6   nathanw 		bhlcr = pci_conf_read(pc, tag, PCI_BHLC_REG);
    434   1.51.2.6   nathanw 		if (PCI_HDRTYPE_MULTIFN(bhlcr) ||
    435   1.51.2.6   nathanw 		    (qd != NULL &&
    436   1.51.2.6   nathanw 		      (qd->quirks & PCI_QUIRK_MULTIFUNCTION) != 0))
    437   1.51.2.6   nathanw 			nfunctions = 8;
    438   1.51.2.6   nathanw 		else
    439   1.51.2.6   nathanw 			nfunctions = 1;
    440   1.51.2.6   nathanw 
    441   1.51.2.6   nathanw 		for (function = 0; function < nfunctions; function++) {
    442   1.51.2.6   nathanw 			tag = pci_make_tag(pc, sc->sc_bus, device, function);
    443   1.51.2.6   nathanw 			ret = pci_probe_device(sc, tag, match, pap);
    444   1.51.2.6   nathanw 			if (match != NULL && ret != 0)
    445   1.51.2.6   nathanw 				return (ret);
    446   1.51.2.6   nathanw 		}
    447   1.51.2.6   nathanw 	}
    448   1.51.2.6   nathanw 	return (0);
    449   1.51.2.6   nathanw }
    450   1.51.2.6   nathanw 
    451   1.51.2.6   nathanw /*
    452   1.51.2.6   nathanw  * Power Management Capability (Rev 2.2)
    453   1.51.2.6   nathanw  */
    454   1.51.2.6   nathanw 
    455   1.51.2.6   nathanw int
    456   1.51.2.6   nathanw pci_set_powerstate(pci_chipset_tag_t pc, pcitag_t tag, int newstate)
    457   1.51.2.6   nathanw {
    458   1.51.2.6   nathanw 	int offset;
    459   1.51.2.6   nathanw 	pcireg_t value, cap, now;
    460   1.51.2.6   nathanw 
    461   1.51.2.6   nathanw 	if (!pci_get_capability(pc, tag, PCI_CAP_PWRMGMT, &offset, &value))
    462   1.51.2.6   nathanw 		return (EOPNOTSUPP);
    463   1.51.2.6   nathanw 
    464   1.51.2.6   nathanw 	cap = value >> 16;
    465   1.51.2.7   nathanw 	value = pci_conf_read(pc, tag, offset + PCI_PMCSR);
    466   1.51.2.6   nathanw 	now    = value & PCI_PMCSR_STATE_MASK;
    467   1.51.2.6   nathanw 	value &= ~PCI_PMCSR_STATE_MASK;
    468   1.51.2.6   nathanw 	switch (newstate) {
    469   1.51.2.6   nathanw 	case PCI_PWR_D0:
    470   1.51.2.6   nathanw 		if (now == PCI_PMCSR_STATE_D0)
    471   1.51.2.6   nathanw 			return (0);
    472   1.51.2.6   nathanw 		value |= PCI_PMCSR_STATE_D0;
    473   1.51.2.6   nathanw 		break;
    474   1.51.2.6   nathanw 	case PCI_PWR_D1:
    475   1.51.2.6   nathanw 		if (now == PCI_PMCSR_STATE_D1)
    476   1.51.2.6   nathanw 			return (0);
    477   1.51.2.6   nathanw 		if (now == PCI_PMCSR_STATE_D2 || now == PCI_PMCSR_STATE_D3)
    478   1.51.2.6   nathanw 			return (EINVAL);
    479   1.51.2.6   nathanw 		if (!(cap & PCI_PMCR_D1SUPP))
    480   1.51.2.6   nathanw 			return (EOPNOTSUPP);
    481   1.51.2.6   nathanw 		value |= PCI_PMCSR_STATE_D1;
    482   1.51.2.6   nathanw 		break;
    483   1.51.2.6   nathanw 	case PCI_PWR_D2:
    484   1.51.2.6   nathanw 		if (now == PCI_PMCSR_STATE_D2)
    485   1.51.2.6   nathanw 			return (0);
    486   1.51.2.6   nathanw 		if (now == PCI_PMCSR_STATE_D3)
    487   1.51.2.6   nathanw 			return (EINVAL);
    488   1.51.2.6   nathanw 		if (!(cap & PCI_PMCR_D2SUPP))
    489   1.51.2.6   nathanw 			return (EOPNOTSUPP);
    490   1.51.2.6   nathanw 		value |= PCI_PMCSR_STATE_D2;
    491   1.51.2.6   nathanw 		break;
    492   1.51.2.6   nathanw 	case PCI_PWR_D3:
    493   1.51.2.6   nathanw 		if (now == PCI_PMCSR_STATE_D3)
    494   1.51.2.6   nathanw 			return (0);
    495   1.51.2.6   nathanw 		value |= PCI_PMCSR_STATE_D3;
    496   1.51.2.6   nathanw 		break;
    497   1.51.2.6   nathanw 	default:
    498   1.51.2.6   nathanw 		return (EINVAL);
    499   1.51.2.6   nathanw 	}
    500   1.51.2.7   nathanw 	pci_conf_write(pc, tag, offset + PCI_PMCSR, value);
    501   1.51.2.6   nathanw 	DELAY(1000);
    502   1.51.2.6   nathanw 
    503   1.51.2.6   nathanw 	return (0);
    504   1.51.2.6   nathanw }
    505   1.51.2.6   nathanw 
    506   1.51.2.6   nathanw int
    507   1.51.2.6   nathanw pci_get_powerstate(pci_chipset_tag_t pc, pcitag_t tag)
    508   1.51.2.6   nathanw {
    509   1.51.2.6   nathanw 	int offset;
    510   1.51.2.6   nathanw 	pcireg_t value;
    511   1.51.2.6   nathanw 
    512   1.51.2.6   nathanw 	if (!pci_get_capability(pc, tag, PCI_CAP_PWRMGMT, &offset, &value))
    513   1.51.2.6   nathanw 		return (PCI_PWR_D0);
    514   1.51.2.7   nathanw 	value = pci_conf_read(pc, tag, offset + PCI_PMCSR);
    515   1.51.2.6   nathanw 	value &= PCI_PMCSR_STATE_MASK;
    516   1.51.2.6   nathanw 	switch (value) {
    517   1.51.2.6   nathanw 	case PCI_PMCSR_STATE_D0:
    518   1.51.2.6   nathanw 		return (PCI_PWR_D0);
    519   1.51.2.6   nathanw 	case PCI_PMCSR_STATE_D1:
    520   1.51.2.6   nathanw 		return (PCI_PWR_D1);
    521   1.51.2.6   nathanw 	case PCI_PMCSR_STATE_D2:
    522   1.51.2.6   nathanw 		return (PCI_PWR_D2);
    523   1.51.2.6   nathanw 	case PCI_PMCSR_STATE_D3:
    524   1.51.2.6   nathanw 		return (PCI_PWR_D3);
    525   1.51.2.6   nathanw 	}
    526   1.51.2.6   nathanw 
    527   1.51.2.6   nathanw 	return (PCI_PWR_D0);
    528        1.1   mycroft }
    529