Home | History | Annotate | Line # | Download | only in pci
ehci_pci.c revision 1.58.4.1
      1  1.58.4.1       snj /*	$NetBSD: ehci_pci.c,v 1.58.4.1 2017/04/05 19:54:19 snj Exp $	*/
      2       1.1  augustss 
      3       1.1  augustss /*
      4       1.8  augustss  * Copyright (c) 2001, 2002 The NetBSD Foundation, Inc.
      5       1.1  augustss  * All rights reserved.
      6       1.1  augustss  *
      7       1.1  augustss  * This code is derived from software contributed to The NetBSD Foundation
      8       1.1  augustss  * by Lennart Augustsson (lennart (at) augustsson.net).
      9       1.1  augustss  *
     10       1.1  augustss  * Redistribution and use in source and binary forms, with or without
     11       1.1  augustss  * modification, are permitted provided that the following conditions
     12       1.1  augustss  * are met:
     13       1.1  augustss  * 1. Redistributions of source code must retain the above copyright
     14       1.1  augustss  *    notice, this list of conditions and the following disclaimer.
     15       1.1  augustss  * 2. Redistributions in binary form must reproduce the above copyright
     16       1.1  augustss  *    notice, this list of conditions and the following disclaimer in the
     17       1.1  augustss  *    documentation and/or other materials provided with the distribution.
     18       1.1  augustss  *
     19       1.1  augustss  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     20       1.1  augustss  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     21       1.1  augustss  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     22       1.1  augustss  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     23       1.1  augustss  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     24       1.1  augustss  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     25       1.1  augustss  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     26       1.1  augustss  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     27       1.1  augustss  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     28       1.1  augustss  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     29       1.1  augustss  * POSSIBILITY OF SUCH DAMAGE.
     30       1.1  augustss  */
     31       1.6     lukem 
     32       1.6     lukem #include <sys/cdefs.h>
     33  1.58.4.1       snj __KERNEL_RCSID(0, "$NetBSD: ehci_pci.c,v 1.58.4.1 2017/04/05 19:54:19 snj Exp $");
     34       1.1  augustss 
     35       1.1  augustss #include <sys/param.h>
     36       1.1  augustss #include <sys/systm.h>
     37       1.1  augustss #include <sys/kernel.h>
     38       1.1  augustss #include <sys/device.h>
     39       1.1  augustss #include <sys/proc.h>
     40       1.1  augustss #include <sys/queue.h>
     41       1.1  augustss 
     42      1.31        ad #include <sys/bus.h>
     43       1.1  augustss 
     44      1.22   xtraeme #include <dev/pci/pcidevs.h>
     45       1.1  augustss #include <dev/pci/pcivar.h>
     46       1.4  augustss #include <dev/pci/usb_pci.h>
     47       1.1  augustss 
     48       1.1  augustss #include <dev/usb/usb.h>
     49       1.1  augustss #include <dev/usb/usbdi.h>
     50       1.1  augustss #include <dev/usb/usbdivar.h>
     51       1.1  augustss #include <dev/usb/usb_mem.h>
     52       1.1  augustss 
     53       1.1  augustss #include <dev/usb/ehcireg.h>
     54       1.1  augustss #include <dev/usb/ehcivar.h>
     55       1.1  augustss 
     56       1.5  augustss #ifdef EHCI_DEBUG
     57       1.5  augustss #define DPRINTF(x)	if (ehcidebug) printf x
     58       1.5  augustss extern int ehcidebug;
     59       1.5  augustss #else
     60       1.5  augustss #define DPRINTF(x)
     61       1.5  augustss #endif
     62       1.5  augustss 
     63      1.45    cegger enum ehci_pci_quirk_flags {
     64      1.45    cegger 	EHCI_PCI_QUIRK_AMD_SB600 = 0x1,	/* always need a quirk */
     65      1.45    cegger 	EHCI_PCI_QUIRK_AMD_SB700 = 0x2,	/* depends on the SMB revision */
     66      1.45    cegger };
     67      1.45    cegger 
     68      1.45    cegger static const struct pci_quirkdata ehci_pci_quirks[] = {
     69      1.45    cegger 	{ PCI_VENDOR_ATI, PCI_PRODUCT_ATI_SB600_USB_EHCI,
     70      1.45    cegger 	    EHCI_PCI_QUIRK_AMD_SB600 },
     71      1.45    cegger 	{ PCI_VENDOR_ATI, PCI_PRODUCT_ATI_SB700_USB_EHCI,
     72      1.45    cegger 	    EHCI_PCI_QUIRK_AMD_SB700 },
     73      1.45    cegger };
     74      1.45    cegger 
     75      1.34  jmcneill static void ehci_release_ownership(ehci_softc_t *sc, pci_chipset_tag_t pc,
     76      1.34  jmcneill 				   pcitag_t tag);
     77      1.19  augustss static void ehci_get_ownership(ehci_softc_t *sc, pci_chipset_tag_t pc,
     78      1.19  augustss 			       pcitag_t tag);
     79      1.47    dyoung static bool ehci_pci_suspend(device_t, const pmf_qual_t *);
     80      1.47    dyoung static bool ehci_pci_resume(device_t, const pmf_qual_t *);
     81      1.19  augustss 
     82       1.1  augustss struct ehci_pci_softc {
     83       1.1  augustss 	ehci_softc_t		sc;
     84       1.1  augustss 	pci_chipset_tag_t	sc_pc;
     85       1.1  augustss 	pcitag_t		sc_tag;
     86       1.1  augustss 	void 			*sc_ih;		/* interrupt vectoring */
     87       1.1  augustss };
     88       1.1  augustss 
     89      1.51    dyoung static int ehci_sb700_match(const struct pci_attach_args *pa);
     90      1.45    cegger static int ehci_apply_amd_quirks(struct ehci_pci_softc *sc);
     91      1.45    cegger enum ehci_pci_quirk_flags ehci_pci_lookup_quirkdata(pci_vendor_id_t,
     92      1.45    cegger 	pci_product_id_t);
     93      1.45    cegger 
     94      1.53  jmcneill #define EHCI_MAX_BIOS_WAIT		100 /* ms*10 */
     95      1.45    cegger #define EHCI_SBx00_WORKAROUND_REG	0x50
     96      1.45    cegger #define EHCI_SBx00_WORKAROUND_ENABLE	__BIT(27)
     97      1.45    cegger 
     98      1.19  augustss 
     99      1.18   thorpej static int
    100      1.41    dyoung ehci_pci_match(device_t parent, cfdata_t match, void *aux)
    101       1.1  augustss {
    102       1.1  augustss 	struct pci_attach_args *pa = (struct pci_attach_args *) aux;
    103       1.1  augustss 
    104       1.1  augustss 	if (PCI_CLASS(pa->pa_class) == PCI_CLASS_SERIALBUS &&
    105       1.1  augustss 	    PCI_SUBCLASS(pa->pa_class) == PCI_SUBCLASS_SERIALBUS_USB &&
    106       1.1  augustss 	    PCI_INTERFACE(pa->pa_class) == PCI_INTERFACE_EHCI)
    107      1.41    dyoung 		return 1;
    108      1.17     perry 
    109      1.41    dyoung 	return 0;
    110       1.1  augustss }
    111       1.1  augustss 
    112      1.18   thorpej static void
    113      1.41    dyoung ehci_pci_attach(device_t parent, device_t self, void *aux)
    114       1.1  augustss {
    115      1.37  drochner 	struct ehci_pci_softc *sc = device_private(self);
    116       1.1  augustss 	struct pci_attach_args *pa = (struct pci_attach_args *)aux;
    117       1.1  augustss 	pci_chipset_tag_t pc = pa->pa_pc;
    118       1.1  augustss 	pcitag_t tag = pa->pa_tag;
    119       1.1  augustss 	char const *intrstr;
    120       1.1  augustss 	pci_intr_handle_t ih;
    121       1.1  augustss 	pcireg_t csr;
    122      1.16   mycroft 	const char *vendor;
    123       1.1  augustss 	usbd_status r;
    124       1.5  augustss 	int ncomp;
    125       1.5  augustss 	struct usb_pci *up;
    126      1.45    cegger 	int quirk;
    127      1.58  christos 	char intrbuf[PCI_INTRSTR_LEN];
    128       1.1  augustss 
    129      1.37  drochner 	sc->sc.sc_dev = self;
    130  1.58.4.1       snj 	sc->sc.sc_bus.ub_hcpriv = sc;
    131      1.37  drochner 
    132      1.54  drochner 	pci_aprint_devinfo(pa, "USB controller");
    133       1.1  augustss 
    134      1.45    cegger 	/* Check for quirks */
    135      1.45    cegger 	quirk = ehci_pci_lookup_quirkdata(PCI_VENDOR(pa->pa_id),
    136      1.45    cegger 					   PCI_PRODUCT(pa->pa_id));
    137      1.45    cegger 
    138       1.1  augustss 	/* Map I/O registers */
    139       1.1  augustss 	if (pci_mapreg_map(pa, PCI_CBMEM, PCI_MAPREG_TYPE_MEM, 0,
    140       1.1  augustss 			   &sc->sc.iot, &sc->sc.ioh, NULL, &sc->sc.sc_size)) {
    141      1.43    cegger 		sc->sc.sc_size = 0;
    142      1.43    cegger 		aprint_error_dev(self, "can't map memory space\n");
    143       1.1  augustss 		return;
    144       1.1  augustss 	}
    145       1.1  augustss 
    146      1.43    cegger 	/* Disable interrupts, so we don't get any spurious ones. */
    147      1.43    cegger 	sc->sc.sc_offs = EREAD1(&sc->sc, EHCI_CAPLENGTH);
    148      1.43    cegger 	DPRINTF(("%s: offs=%d\n", device_xname(self), sc->sc.sc_offs));
    149      1.56       uwe 	EOWRITE4(&sc->sc, EHCI_USBINTR, 0);
    150      1.43    cegger 
    151       1.1  augustss 	sc->sc_pc = pc;
    152       1.1  augustss 	sc->sc_tag = tag;
    153  1.58.4.1       snj 	sc->sc.sc_bus.ub_dmatag = pa->pa_dmat;
    154       1.1  augustss 
    155      1.45    cegger 	/* Handle quirks */
    156      1.45    cegger 	switch (quirk) {
    157      1.45    cegger 	case EHCI_PCI_QUIRK_AMD_SB600:
    158      1.45    cegger 		ehci_apply_amd_quirks(sc);
    159      1.45    cegger 		break;
    160      1.45    cegger 	case EHCI_PCI_QUIRK_AMD_SB700:
    161      1.45    cegger 		if (pci_find_device(NULL, ehci_sb700_match))
    162      1.45    cegger 			ehci_apply_amd_quirks(sc);
    163      1.45    cegger 		break;
    164      1.45    cegger 	}
    165      1.45    cegger 
    166       1.1  augustss 	/* Enable the device. */
    167       1.1  augustss 	csr = pci_conf_read(pc, tag, PCI_COMMAND_STATUS_REG);
    168       1.1  augustss 	pci_conf_write(pc, tag, PCI_COMMAND_STATUS_REG,
    169       1.1  augustss 		       csr | PCI_COMMAND_MASTER_ENABLE);
    170       1.1  augustss 
    171       1.1  augustss 	/* Map and establish the interrupt. */
    172       1.3  sommerfe 	if (pci_intr_map(pa, &ih)) {
    173      1.43    cegger 		aprint_error_dev(self, "couldn't map interrupt\n");
    174      1.43    cegger 		goto fail;
    175       1.1  augustss 	}
    176      1.43    cegger 
    177      1.43    cegger 	/*
    178      1.43    cegger 	 * Allocate IRQ
    179      1.43    cegger 	 */
    180      1.58  christos 	intrstr = pci_intr_string(pc, ih, intrbuf, sizeof(intrbuf));
    181  1.58.4.1       snj 	sc->sc_ih = pci_intr_establish(pc, ih, IPL_USB, ehci_intr, sc);
    182       1.1  augustss 	if (sc->sc_ih == NULL) {
    183      1.43    cegger 		aprint_error_dev(self, "couldn't establish interrupt");
    184       1.1  augustss 		if (intrstr != NULL)
    185      1.43    cegger 			aprint_error(" at %s", intrstr);
    186      1.43    cegger 		aprint_error("\n");
    187       1.1  augustss 		return;
    188       1.1  augustss 	}
    189      1.43    cegger 	aprint_normal_dev(self, "interrupting at %s\n", intrstr);
    190       1.1  augustss 
    191       1.1  augustss 	switch(pci_conf_read(pc, tag, PCI_USBREV) & PCI_USBREV_MASK) {
    192       1.1  augustss 	case PCI_USBREV_PRE_1_0:
    193       1.1  augustss 	case PCI_USBREV_1_0:
    194       1.1  augustss 	case PCI_USBREV_1_1:
    195  1.58.4.1       snj 		sc->sc.sc_bus.ub_revision = USBREV_UNKNOWN;
    196      1.43    cegger 		aprint_verbose_dev(self, "pre-2.0 USB rev\n");
    197       1.4  augustss 		return;
    198       1.1  augustss 	case PCI_USBREV_2_0:
    199  1.58.4.1       snj 		sc->sc.sc_bus.ub_revision = USBREV_2_0;
    200       1.1  augustss 		break;
    201       1.1  augustss 	default:
    202  1.58.4.1       snj 		sc->sc.sc_bus.ub_revision = USBREV_UNKNOWN;
    203       1.1  augustss 		break;
    204       1.1  augustss 	}
    205       1.1  augustss 
    206       1.1  augustss 	/* Figure out vendor for root hub descriptor. */
    207      1.49  pgoyette 	vendor = pci_findvendor(pa->pa_id);
    208       1.1  augustss 	sc->sc.sc_id_vendor = PCI_VENDOR(pa->pa_id);
    209       1.1  augustss 	if (vendor)
    210      1.14    itojun 		strlcpy(sc->sc.sc_vendor, vendor, sizeof(sc->sc.sc_vendor));
    211       1.1  augustss 	else
    212      1.14    itojun 		snprintf(sc->sc.sc_vendor, sizeof(sc->sc.sc_vendor),
    213      1.14    itojun 		    "vendor 0x%04x", PCI_VENDOR(pa->pa_id));
    214      1.17     perry 
    215      1.22   xtraeme 	/* Enable workaround for dropped interrupts as required */
    216      1.30   tsutsui 	switch (sc->sc.sc_id_vendor) {
    217      1.30   tsutsui 	case PCI_VENDOR_ATI:
    218      1.30   tsutsui 	case PCI_VENDOR_VIATECH:
    219      1.22   xtraeme 		sc->sc.sc_flags |= EHCIF_DROPPED_INTR_WORKAROUND;
    220      1.43    cegger 		aprint_normal_dev(self, "dropped intr workaround enabled\n");
    221      1.30   tsutsui 		break;
    222      1.30   tsutsui 	default:
    223      1.30   tsutsui 		break;
    224      1.30   tsutsui 	}
    225      1.22   xtraeme 
    226       1.5  augustss 	/*
    227       1.5  augustss 	 * Find companion controllers.  According to the spec they always
    228       1.5  augustss 	 * have lower function numbers so they should be enumerated already.
    229       1.5  augustss 	 */
    230      1.50      matt 	const u_int maxncomp = EHCI_HCS_N_CC(EREAD4(&sc->sc, EHCI_HCSPARAMS));
    231      1.50      matt 	KASSERT(maxncomp <= EHCI_COMPANION_MAX);
    232       1.5  augustss 	ncomp = 0;
    233       1.5  augustss 	TAILQ_FOREACH(up, &ehci_pci_alldevs, next) {
    234      1.50      matt 		if (up->bus == pa->pa_bus && up->device == pa->pa_device
    235      1.50      matt 		    && !up->claimed) {
    236       1.5  augustss 			DPRINTF(("ehci_pci_attach: companion %s\n",
    237      1.37  drochner 				 device_xname(up->usb)));
    238       1.5  augustss 			sc->sc.sc_comps[ncomp++] = up->usb;
    239      1.50      matt 			up->claimed = true;
    240      1.50      matt 			if (ncomp == maxncomp)
    241       1.5  augustss 				break;
    242       1.5  augustss 		}
    243       1.5  augustss 	}
    244       1.5  augustss 	sc->sc.sc_ncomp = ncomp;
    245       1.5  augustss 
    246      1.19  augustss 	ehci_get_ownership(&sc->sc, pc, tag);
    247      1.19  augustss 
    248       1.1  augustss 	r = ehci_init(&sc->sc);
    249       1.1  augustss 	if (r != USBD_NORMAL_COMPLETION) {
    250      1.43    cegger 		aprint_error_dev(self, "init failed, error=%d\n", r);
    251      1.43    cegger 		goto fail;
    252       1.1  augustss 	}
    253       1.1  augustss 
    254      1.36    dyoung 	if (!pmf_device_register1(self, ehci_pci_suspend, ehci_pci_resume,
    255      1.36    dyoung 	                          ehci_shutdown))
    256      1.32  jmcneill 		aprint_error_dev(self, "couldn't establish power handler\n");
    257      1.32  jmcneill 
    258       1.1  augustss 	/* Attach usb device. */
    259      1.37  drochner 	sc->sc.sc_child = config_found(self, &sc->sc.sc_bus, usbctlprint);
    260      1.43    cegger 	return;
    261      1.43    cegger 
    262      1.43    cegger fail:
    263      1.43    cegger 	if (sc->sc_ih) {
    264      1.43    cegger 		pci_intr_disestablish(sc->sc_pc, sc->sc_ih);
    265      1.43    cegger 		sc->sc_ih = NULL;
    266      1.43    cegger 	}
    267      1.43    cegger 	if (sc->sc.sc_size) {
    268      1.43    cegger 		ehci_release_ownership(&sc->sc, sc->sc_pc, sc->sc_tag);
    269      1.43    cegger 		bus_space_unmap(sc->sc.iot, sc->sc.ioh, sc->sc.sc_size);
    270      1.43    cegger 		sc->sc.sc_size = 0;
    271      1.43    cegger 	}
    272      1.43    cegger 	return;
    273       1.1  augustss }
    274       1.1  augustss 
    275      1.18   thorpej static int
    276      1.41    dyoung ehci_pci_detach(device_t self, int flags)
    277       1.1  augustss {
    278      1.37  drochner 	struct ehci_pci_softc *sc = device_private(self);
    279       1.1  augustss 	int rv;
    280       1.1  augustss 
    281       1.1  augustss 	rv = ehci_detach(&sc->sc, flags);
    282       1.1  augustss 	if (rv)
    283      1.41    dyoung 		return rv;
    284      1.40    dyoung 
    285      1.52    dyoung 	pmf_device_deregister(self);
    286      1.52    dyoung 	ehci_shutdown(self, flags);
    287      1.52    dyoung 
    288      1.40    dyoung 	/* disable interrupts */
    289      1.56       uwe 	EOWRITE4(&sc->sc, EHCI_USBINTR, 0);
    290      1.40    dyoung 	/* XXX grotty hack to flush the write */
    291      1.56       uwe 	(void)EOREAD4(&sc->sc, EHCI_USBINTR);
    292      1.40    dyoung 
    293       1.1  augustss 	if (sc->sc_ih != NULL) {
    294       1.1  augustss 		pci_intr_disestablish(sc->sc_pc, sc->sc_ih);
    295       1.1  augustss 		sc->sc_ih = NULL;
    296       1.1  augustss 	}
    297       1.1  augustss 	if (sc->sc.sc_size) {
    298      1.34  jmcneill 		ehci_release_ownership(&sc->sc, sc->sc_pc, sc->sc_tag);
    299       1.1  augustss 		bus_space_unmap(sc->sc.iot, sc->sc.ioh, sc->sc.sc_size);
    300       1.1  augustss 		sc->sc.sc_size = 0;
    301       1.1  augustss 	}
    302      1.34  jmcneill 
    303      1.55       mrg #if 1
    304      1.55       mrg 	/* XXX created in ehci.c */
    305      1.55       mrg 	mutex_destroy(&sc->sc.sc_lock);
    306      1.55       mrg 	mutex_destroy(&sc->sc.sc_intr_lock);
    307      1.55       mrg 
    308      1.55       mrg 	softint_disestablish(sc->sc.sc_doorbell_si);
    309      1.55       mrg 	softint_disestablish(sc->sc.sc_pcd_si);
    310      1.55       mrg #endif
    311      1.55       mrg 
    312      1.41    dyoung 	return 0;
    313       1.1  augustss }
    314      1.18   thorpej 
    315      1.39    dyoung CFATTACH_DECL3_NEW(ehci_pci, sizeof(struct ehci_pci_softc),
    316      1.35    dyoung     ehci_pci_match, ehci_pci_attach, ehci_pci_detach, ehci_activate, NULL,
    317      1.39    dyoung     ehci_childdet, DVF_DETACH_SHUTDOWN);
    318      1.19  augustss 
    319      1.19  augustss #ifdef EHCI_DEBUG
    320      1.19  augustss static void
    321      1.19  augustss ehci_dump_caps(ehci_softc_t *sc, pci_chipset_tag_t pc, pcitag_t tag)
    322      1.19  augustss {
    323      1.44    cegger 	uint32_t cparams, legctlsts, addr, cap, id;
    324      1.19  augustss 	int maxdump = 10;
    325      1.19  augustss 
    326      1.19  augustss 	cparams = EREAD4(sc, EHCI_HCCPARAMS);
    327      1.19  augustss 	addr = EHCI_HCC_EECP(cparams);
    328      1.19  augustss 	while (addr != 0) {
    329      1.19  augustss 		cap = pci_conf_read(pc, tag, addr);
    330      1.19  augustss 		id = EHCI_CAP_GET_ID(cap);
    331      1.19  augustss 		switch (id) {
    332      1.19  augustss 		case EHCI_CAP_ID_LEGACY:
    333      1.19  augustss 			legctlsts = pci_conf_read(pc, tag,
    334      1.19  augustss 						  addr + PCI_EHCI_USBLEGCTLSTS);
    335      1.20  augustss 			printf("ehci_dump_caps: legsup=0x%08x "
    336      1.20  augustss 			       "legctlsts=0x%08x\n", cap, legctlsts);
    337      1.19  augustss 			break;
    338      1.19  augustss 		default:
    339      1.20  augustss 			printf("ehci_dump_caps: cap=0x%08x\n", cap);
    340      1.19  augustss 			break;
    341      1.19  augustss 		}
    342      1.19  augustss 		if (--maxdump < 0)
    343      1.19  augustss 			break;
    344      1.19  augustss 		addr = EHCI_CAP_GET_NEXT(cap);
    345      1.19  augustss 	}
    346      1.19  augustss }
    347      1.19  augustss #endif
    348      1.19  augustss 
    349      1.19  augustss static void
    350      1.34  jmcneill ehci_release_ownership(ehci_softc_t *sc, pci_chipset_tag_t pc, pcitag_t tag)
    351      1.34  jmcneill {
    352      1.37  drochner 	const char *devname = device_xname(sc->sc_dev);
    353      1.44    cegger 	uint32_t cparams, addr, cap;
    354      1.34  jmcneill 	pcireg_t legsup;
    355      1.34  jmcneill 	int maxcap = 10;
    356      1.34  jmcneill 
    357      1.34  jmcneill 	cparams = EREAD4(sc, EHCI_HCCPARAMS);
    358      1.34  jmcneill 	addr = EHCI_HCC_EECP(cparams);
    359      1.34  jmcneill 	while (addr != 0) {
    360      1.34  jmcneill 		cap = pci_conf_read(pc, tag, addr);
    361      1.34  jmcneill 		if (EHCI_CAP_GET_ID(cap) != EHCI_CAP_ID_LEGACY)
    362      1.34  jmcneill 			goto next;
    363      1.34  jmcneill 		legsup = pci_conf_read(pc, tag, addr + PCI_EHCI_USBLEGSUP);
    364      1.34  jmcneill 		pci_conf_write(pc, tag, addr + PCI_EHCI_USBLEGSUP,
    365      1.34  jmcneill 		    legsup & ~EHCI_LEG_HC_OS_OWNED);
    366      1.34  jmcneill 
    367      1.34  jmcneill next:
    368      1.34  jmcneill 		if (--maxcap < 0) {
    369      1.34  jmcneill 			aprint_normal("%s: broken extended capabilities "
    370      1.34  jmcneill 				      "ignored\n", devname);
    371      1.34  jmcneill 			return;
    372      1.34  jmcneill 		}
    373      1.34  jmcneill 		addr = EHCI_CAP_GET_NEXT(cap);
    374      1.34  jmcneill 	}
    375      1.34  jmcneill }
    376      1.34  jmcneill 
    377      1.34  jmcneill static void
    378      1.19  augustss ehci_get_ownership(ehci_softc_t *sc, pci_chipset_tag_t pc, pcitag_t tag)
    379      1.19  augustss {
    380      1.37  drochner 	const char *devname = device_xname(sc->sc_dev);
    381      1.44    cegger 	uint32_t cparams, addr, cap;
    382      1.33  jmcneill 	pcireg_t legsup;
    383      1.19  augustss 	int maxcap = 10;
    384      1.19  augustss 	int ms;
    385      1.19  augustss 
    386      1.19  augustss #ifdef EHCI_DEBUG
    387      1.20  augustss 	if (ehcidebug)
    388      1.20  augustss 		ehci_dump_caps(sc, pc, tag);
    389      1.19  augustss #endif
    390      1.19  augustss 	cparams = EREAD4(sc, EHCI_HCCPARAMS);
    391      1.19  augustss 	addr = EHCI_HCC_EECP(cparams);
    392      1.19  augustss 	while (addr != 0) {
    393      1.19  augustss 		cap = pci_conf_read(pc, tag, addr);
    394      1.34  jmcneill 		if (EHCI_CAP_GET_ID(cap) != EHCI_CAP_ID_LEGACY)
    395      1.34  jmcneill 			goto next;
    396      1.34  jmcneill 		legsup = pci_conf_read(pc, tag, addr + PCI_EHCI_USBLEGSUP);
    397      1.34  jmcneill 		if (legsup & EHCI_LEG_HC_BIOS_OWNED) {
    398      1.53  jmcneill 			/* Ask BIOS to give up ownership */
    399      1.53  jmcneill 			pci_conf_write(pc, tag, addr + PCI_EHCI_USBLEGSUP,
    400      1.57   tsutsui 			    legsup | EHCI_LEG_HC_OS_OWNED);
    401      1.34  jmcneill 			for (ms = 0; ms < EHCI_MAX_BIOS_WAIT; ms++) {
    402      1.34  jmcneill 				legsup = pci_conf_read(pc, tag,
    403      1.34  jmcneill 				    addr + PCI_EHCI_USBLEGSUP);
    404      1.34  jmcneill 				if (!(legsup & EHCI_LEG_HC_BIOS_OWNED))
    405      1.34  jmcneill 					break;
    406      1.53  jmcneill 				delay(10000);
    407      1.34  jmcneill 			}
    408      1.34  jmcneill 			if (ms == EHCI_MAX_BIOS_WAIT) {
    409      1.34  jmcneill 				aprint_normal("%s: BIOS refuses to give up "
    410      1.34  jmcneill 				    "ownership, using force\n", devname);
    411      1.34  jmcneill 				pci_conf_write(pc, tag,
    412      1.34  jmcneill 				    addr + PCI_EHCI_USBLEGSUP, 0);
    413      1.34  jmcneill 			} else
    414      1.34  jmcneill 				aprint_verbose("%s: BIOS has given up "
    415      1.34  jmcneill 				    "ownership\n", devname);
    416      1.34  jmcneill 		}
    417      1.34  jmcneill 
    418      1.34  jmcneill 		/* Disable SMIs */
    419      1.53  jmcneill 		pci_conf_write(pc, tag, addr + PCI_EHCI_USBLEGCTLSTS, 0);
    420      1.34  jmcneill 
    421      1.34  jmcneill next:
    422      1.21  augustss 		if (--maxcap < 0) {
    423      1.21  augustss 			aprint_normal("%s: broken extended capabilities "
    424      1.21  augustss 				      "ignored\n", devname);
    425      1.19  augustss 			return;
    426      1.21  augustss 		}
    427      1.19  augustss 		addr = EHCI_CAP_GET_NEXT(cap);
    428      1.19  augustss 	}
    429      1.19  augustss 
    430      1.34  jmcneill }
    431      1.34  jmcneill 
    432      1.34  jmcneill static bool
    433      1.47    dyoung ehci_pci_suspend(device_t dv, const pmf_qual_t *qual)
    434      1.34  jmcneill {
    435      1.34  jmcneill 	struct ehci_pci_softc *sc = device_private(dv);
    436      1.28  jmcneill 
    437      1.46    dyoung 	ehci_suspend(dv, qual);
    438      1.34  jmcneill 	ehci_release_ownership(&sc->sc, sc->sc_pc, sc->sc_tag);
    439      1.33  jmcneill 
    440      1.34  jmcneill 	return true;
    441      1.19  augustss }
    442      1.23  jmcneill 
    443      1.32  jmcneill static bool
    444      1.47    dyoung ehci_pci_resume(device_t dv, const pmf_qual_t *qual)
    445      1.23  jmcneill {
    446      1.32  jmcneill 	struct ehci_pci_softc *sc = device_private(dv);
    447      1.23  jmcneill 
    448      1.32  jmcneill 	ehci_get_ownership(&sc->sc, sc->sc_pc, sc->sc_tag);
    449      1.46    dyoung 	return ehci_resume(dv, qual);
    450      1.23  jmcneill }
    451      1.45    cegger 
    452      1.45    cegger static int
    453      1.51    dyoung ehci_sb700_match(const struct pci_attach_args *pa)
    454      1.45    cegger {
    455      1.45    cegger 	if (!(PCI_VENDOR(pa->pa_id) == PCI_VENDOR_ATI &&
    456      1.45    cegger 	    PCI_PRODUCT(pa->pa_id) == PCI_PRODUCT_ATI_SB600_SMB))
    457      1.45    cegger 		return 0;
    458      1.45    cegger 
    459      1.45    cegger 	switch (PCI_REVISION(pa->pa_class)) {
    460      1.45    cegger 	case 0x3a:
    461      1.45    cegger 	case 0x3b:
    462      1.45    cegger 		return 1;
    463      1.45    cegger 	}
    464      1.45    cegger 
    465      1.45    cegger 	return 0;
    466      1.45    cegger }
    467      1.45    cegger 
    468      1.45    cegger static int
    469      1.45    cegger ehci_apply_amd_quirks(struct ehci_pci_softc *sc)
    470      1.45    cegger {
    471      1.45    cegger 	pcireg_t value;
    472  1.58.4.1       snj 
    473      1.45    cegger 	aprint_normal_dev(sc->sc.sc_dev,
    474      1.45    cegger 	    "applying AMD SB600/SB700 USB freeze workaround\n");
    475      1.45    cegger 	value = pci_conf_read(sc->sc_pc, sc->sc_tag, EHCI_SBx00_WORKAROUND_REG);
    476      1.45    cegger 	pci_conf_write(sc->sc_pc, sc->sc_tag, EHCI_SBx00_WORKAROUND_REG,
    477      1.45    cegger 	    value | EHCI_SBx00_WORKAROUND_ENABLE);
    478      1.45    cegger 
    479      1.45    cegger 	return 0;
    480      1.45    cegger }
    481      1.45    cegger 
    482      1.45    cegger enum ehci_pci_quirk_flags
    483      1.45    cegger ehci_pci_lookup_quirkdata(pci_vendor_id_t vendor, pci_product_id_t product)
    484      1.45    cegger {
    485      1.45    cegger 	int i;
    486      1.45    cegger 
    487      1.45    cegger 	for (i = 0; i < __arraycount(ehci_pci_quirks); i++) {
    488      1.45    cegger 		if (vendor == ehci_pci_quirks[i].vendor &&
    489      1.45    cegger 		    product == ehci_pci_quirks[i].product)
    490      1.45    cegger 			return ehci_pci_quirks[i].quirks;
    491      1.45    cegger 	}
    492      1.45    cegger 	return 0;
    493      1.45    cegger }
    494      1.45    cegger 
    495