Home | History | Annotate | Line # | Download | only in usb
ehci.c revision 1.54.2.11
      1  1.54.2.11        he /*	$NetBSD: ehci.c,v 1.54.2.11 2004/07/02 17:12:34 he Exp $	*/
      2        1.1  augustss 
      3        1.1  augustss /*
      4   1.54.2.7      tron  * Copyright (c) 2004 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.54.2.7      tron  * by Lennart Augustsson (lennart (at) augustsson.net) and by Charles M. Hannum.
      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  * 3. All advertising materials mentioning features or use of this software
     19        1.1  augustss  *    must display the following acknowledgement:
     20        1.1  augustss  *        This product includes software developed by the NetBSD
     21        1.1  augustss  *        Foundation, Inc. and its contributors.
     22        1.1  augustss  * 4. Neither the name of The NetBSD Foundation nor the names of its
     23        1.1  augustss  *    contributors may be used to endorse or promote products derived
     24        1.1  augustss  *    from this software without specific prior written permission.
     25        1.1  augustss  *
     26        1.1  augustss  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     27        1.1  augustss  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     28        1.1  augustss  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     29        1.1  augustss  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     30        1.1  augustss  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     31        1.1  augustss  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     32        1.1  augustss  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     33        1.1  augustss  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     34        1.1  augustss  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     35        1.1  augustss  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     36        1.1  augustss  * POSSIBILITY OF SUCH DAMAGE.
     37        1.1  augustss  */
     38        1.1  augustss 
     39        1.1  augustss /*
     40        1.3  augustss  * USB Enhanced Host Controller Driver, a.k.a. USB 2.0 controller.
     41        1.1  augustss  *
     42       1.35     enami  * The EHCI 1.0 spec can be found at
     43       1.34  augustss  * http://developer.intel.com/technology/usb/download/ehci-r10.pdf
     44        1.7  augustss  * and the USB 2.0 spec at
     45       1.43    ichiro  * http://www.usb.org/developers/docs/usb_20.zip
     46        1.1  augustss  *
     47        1.1  augustss  */
     48        1.4     lukem 
     49       1.52  jdolecek /*
     50       1.52  jdolecek  * TODO:
     51       1.52  jdolecek  * 1) hold off explorations by companion controllers until ehci has started.
     52       1.52  jdolecek  *
     53       1.52  jdolecek  * 2) The EHCI driver lacks support for interrupt isochronous transfers, so
     54       1.52  jdolecek  *    devices using them don't work.
     55       1.52  jdolecek  *    Interrupt transfers are not difficult, it's just not done.
     56       1.52  jdolecek  *
     57   1.54.2.6      tron  * 3) The meaty part to implement is the support for USB 2.0 hubs.
     58       1.52  jdolecek  *    They are quite compolicated since the need to be able to do
     59       1.52  jdolecek  *    "transaction translation", i.e., converting to/from USB 2 and USB 1.
     60       1.52  jdolecek  *    So the hub driver needs to handle and schedule these things, to
     61       1.52  jdolecek  *    assign place in frame where different devices get to go. See chapter
     62       1.52  jdolecek  *    on hubs in USB 2.0 for details.
     63       1.52  jdolecek  *
     64   1.54.2.6      tron  * 4) command failures are not recovered correctly
     65       1.52  jdolecek */
     66       1.52  jdolecek 
     67        1.4     lukem #include <sys/cdefs.h>
     68  1.54.2.11        he __KERNEL_RCSID(0, "$NetBSD: ehci.c,v 1.54.2.11 2004/07/02 17:12:34 he Exp $");
     69       1.47  augustss 
     70       1.47  augustss #include "ohci.h"
     71       1.47  augustss #include "uhci.h"
     72        1.1  augustss 
     73        1.1  augustss #include <sys/param.h>
     74        1.1  augustss #include <sys/systm.h>
     75        1.1  augustss #include <sys/kernel.h>
     76        1.1  augustss #include <sys/malloc.h>
     77        1.1  augustss #include <sys/device.h>
     78        1.1  augustss #include <sys/select.h>
     79        1.1  augustss #include <sys/proc.h>
     80        1.1  augustss #include <sys/queue.h>
     81        1.1  augustss 
     82        1.1  augustss #include <machine/bus.h>
     83        1.1  augustss #include <machine/endian.h>
     84        1.1  augustss 
     85        1.1  augustss #include <dev/usb/usb.h>
     86        1.1  augustss #include <dev/usb/usbdi.h>
     87        1.1  augustss #include <dev/usb/usbdivar.h>
     88        1.1  augustss #include <dev/usb/usb_mem.h>
     89        1.1  augustss #include <dev/usb/usb_quirks.h>
     90        1.1  augustss 
     91        1.1  augustss #include <dev/usb/ehcireg.h>
     92        1.1  augustss #include <dev/usb/ehcivar.h>
     93        1.1  augustss 
     94        1.1  augustss #ifdef EHCI_DEBUG
     95        1.1  augustss #define DPRINTF(x)	if (ehcidebug) printf x
     96        1.1  augustss #define DPRINTFN(n,x)	if (ehcidebug>(n)) printf x
     97        1.6  augustss int ehcidebug = 0;
     98       1.15  augustss #ifndef __NetBSD__
     99        1.1  augustss #define bitmask_snprintf(q,f,b,l) snprintf((b), (l), "%b", (q), (f))
    100       1.15  augustss #endif
    101        1.1  augustss #else
    102        1.1  augustss #define DPRINTF(x)
    103        1.1  augustss #define DPRINTFN(n,x)
    104        1.1  augustss #endif
    105        1.1  augustss 
    106        1.5  augustss struct ehci_pipe {
    107        1.5  augustss 	struct usbd_pipe pipe;
    108   1.54.2.1      tron 	int nexttoggle;
    109   1.54.2.1      tron 
    110       1.10  augustss 	ehci_soft_qh_t *sqh;
    111       1.10  augustss 	union {
    112       1.10  augustss 		ehci_soft_qtd_t *qtd;
    113       1.10  augustss 		/* ehci_soft_itd_t *itd; */
    114       1.10  augustss 	} tail;
    115       1.10  augustss 	union {
    116       1.10  augustss 		/* Control pipe */
    117       1.10  augustss 		struct {
    118       1.10  augustss 			usb_dma_t reqdma;
    119       1.10  augustss 			u_int length;
    120       1.19  augustss 			/*ehci_soft_qtd_t *setup, *data, *stat;*/
    121       1.10  augustss 		} ctl;
    122       1.10  augustss 		/* Interrupt pipe */
    123       1.15  augustss 		/* XXX */
    124       1.10  augustss 		/* Bulk pipe */
    125       1.10  augustss 		struct {
    126       1.10  augustss 			u_int length;
    127       1.10  augustss 		} bulk;
    128       1.10  augustss 		/* Iso pipe */
    129       1.15  augustss 		/* XXX */
    130       1.10  augustss 	} u;
    131        1.5  augustss };
    132        1.5  augustss 
    133        1.5  augustss Static void		ehci_shutdown(void *);
    134        1.5  augustss Static void		ehci_power(int, void *);
    135        1.5  augustss 
    136        1.5  augustss Static usbd_status	ehci_open(usbd_pipe_handle);
    137        1.5  augustss Static void		ehci_poll(struct usbd_bus *);
    138        1.5  augustss Static void		ehci_softintr(void *);
    139       1.11  augustss Static int		ehci_intr1(ehci_softc_t *);
    140       1.15  augustss Static void		ehci_waitintr(ehci_softc_t *, usbd_xfer_handle);
    141       1.18  augustss Static void		ehci_check_intr(ehci_softc_t *, struct ehci_xfer *);
    142       1.18  augustss Static void		ehci_idone(struct ehci_xfer *);
    143       1.15  augustss Static void		ehci_timeout(void *);
    144       1.15  augustss Static void		ehci_timeout_task(void *);
    145        1.5  augustss 
    146        1.5  augustss Static usbd_status	ehci_allocm(struct usbd_bus *, usb_dma_t *, u_int32_t);
    147        1.5  augustss Static void		ehci_freem(struct usbd_bus *, usb_dma_t *);
    148        1.5  augustss 
    149        1.5  augustss Static usbd_xfer_handle	ehci_allocx(struct usbd_bus *);
    150        1.5  augustss Static void		ehci_freex(struct usbd_bus *, usbd_xfer_handle);
    151        1.5  augustss 
    152        1.5  augustss Static usbd_status	ehci_root_ctrl_transfer(usbd_xfer_handle);
    153        1.5  augustss Static usbd_status	ehci_root_ctrl_start(usbd_xfer_handle);
    154        1.5  augustss Static void		ehci_root_ctrl_abort(usbd_xfer_handle);
    155        1.5  augustss Static void		ehci_root_ctrl_close(usbd_pipe_handle);
    156        1.5  augustss Static void		ehci_root_ctrl_done(usbd_xfer_handle);
    157        1.5  augustss 
    158        1.5  augustss Static usbd_status	ehci_root_intr_transfer(usbd_xfer_handle);
    159        1.5  augustss Static usbd_status	ehci_root_intr_start(usbd_xfer_handle);
    160        1.5  augustss Static void		ehci_root_intr_abort(usbd_xfer_handle);
    161        1.5  augustss Static void		ehci_root_intr_close(usbd_pipe_handle);
    162        1.5  augustss Static void		ehci_root_intr_done(usbd_xfer_handle);
    163        1.5  augustss 
    164        1.5  augustss Static usbd_status	ehci_device_ctrl_transfer(usbd_xfer_handle);
    165        1.5  augustss Static usbd_status	ehci_device_ctrl_start(usbd_xfer_handle);
    166        1.5  augustss Static void		ehci_device_ctrl_abort(usbd_xfer_handle);
    167        1.5  augustss Static void		ehci_device_ctrl_close(usbd_pipe_handle);
    168        1.5  augustss Static void		ehci_device_ctrl_done(usbd_xfer_handle);
    169        1.5  augustss 
    170        1.5  augustss Static usbd_status	ehci_device_bulk_transfer(usbd_xfer_handle);
    171        1.5  augustss Static usbd_status	ehci_device_bulk_start(usbd_xfer_handle);
    172        1.5  augustss Static void		ehci_device_bulk_abort(usbd_xfer_handle);
    173        1.5  augustss Static void		ehci_device_bulk_close(usbd_pipe_handle);
    174        1.5  augustss Static void		ehci_device_bulk_done(usbd_xfer_handle);
    175        1.5  augustss 
    176        1.5  augustss Static usbd_status	ehci_device_intr_transfer(usbd_xfer_handle);
    177        1.5  augustss Static usbd_status	ehci_device_intr_start(usbd_xfer_handle);
    178        1.5  augustss Static void		ehci_device_intr_abort(usbd_xfer_handle);
    179        1.5  augustss Static void		ehci_device_intr_close(usbd_pipe_handle);
    180        1.5  augustss Static void		ehci_device_intr_done(usbd_xfer_handle);
    181        1.5  augustss 
    182        1.5  augustss Static usbd_status	ehci_device_isoc_transfer(usbd_xfer_handle);
    183        1.5  augustss Static usbd_status	ehci_device_isoc_start(usbd_xfer_handle);
    184        1.5  augustss Static void		ehci_device_isoc_abort(usbd_xfer_handle);
    185        1.5  augustss Static void		ehci_device_isoc_close(usbd_pipe_handle);
    186        1.5  augustss Static void		ehci_device_isoc_done(usbd_xfer_handle);
    187        1.5  augustss 
    188        1.5  augustss Static void		ehci_device_clear_toggle(usbd_pipe_handle pipe);
    189        1.5  augustss Static void		ehci_noop(usbd_pipe_handle pipe);
    190        1.5  augustss 
    191        1.5  augustss Static int		ehci_str(usb_string_descriptor_t *, int, char *);
    192        1.6  augustss Static void		ehci_pcd(ehci_softc_t *, usbd_xfer_handle);
    193        1.6  augustss Static void		ehci_pcd_able(ehci_softc_t *, int);
    194        1.6  augustss Static void		ehci_pcd_enable(void *);
    195        1.6  augustss Static void		ehci_disown(ehci_softc_t *, int, int);
    196        1.5  augustss 
    197        1.9  augustss Static ehci_soft_qh_t  *ehci_alloc_sqh(ehci_softc_t *);
    198        1.9  augustss Static void		ehci_free_sqh(ehci_softc_t *, ehci_soft_qh_t *);
    199        1.9  augustss 
    200        1.9  augustss Static ehci_soft_qtd_t  *ehci_alloc_sqtd(ehci_softc_t *);
    201        1.9  augustss Static void		ehci_free_sqtd(ehci_softc_t *, ehci_soft_qtd_t *);
    202       1.25  augustss Static usbd_status	ehci_alloc_sqtd_chain(struct ehci_pipe *,
    203       1.15  augustss 			    ehci_softc_t *, int, int, usbd_xfer_handle,
    204       1.15  augustss 			    ehci_soft_qtd_t **, ehci_soft_qtd_t **);
    205       1.25  augustss Static void		ehci_free_sqtd_chain(ehci_softc_t *, ehci_soft_qtd_t *,
    206       1.18  augustss 					    ehci_soft_qtd_t *);
    207       1.15  augustss 
    208       1.15  augustss Static usbd_status	ehci_device_request(usbd_xfer_handle xfer);
    209        1.9  augustss 
    210       1.10  augustss Static void		ehci_add_qh(ehci_soft_qh_t *, ehci_soft_qh_t *);
    211       1.10  augustss Static void		ehci_rem_qh(ehci_softc_t *, ehci_soft_qh_t *,
    212       1.10  augustss 				    ehci_soft_qh_t *);
    213       1.23  augustss Static void		ehci_set_qh_qtd(ehci_soft_qh_t *, ehci_soft_qtd_t *);
    214       1.11  augustss Static void		ehci_sync_hc(ehci_softc_t *);
    215       1.10  augustss 
    216       1.10  augustss Static void		ehci_close_pipe(usbd_pipe_handle, ehci_soft_qh_t *);
    217       1.10  augustss Static void		ehci_abort_xfer(usbd_xfer_handle, usbd_status);
    218        1.9  augustss 
    219        1.5  augustss #ifdef EHCI_DEBUG
    220       1.18  augustss Static void		ehci_dump_regs(ehci_softc_t *);
    221       1.39    martin Static void		ehci_dump(void);
    222        1.6  augustss Static ehci_softc_t 	*theehci;
    223       1.15  augustss Static void		ehci_dump_link(ehci_link_t, int);
    224       1.15  augustss Static void		ehci_dump_sqtds(ehci_soft_qtd_t *);
    225        1.9  augustss Static void		ehci_dump_sqtd(ehci_soft_qtd_t *);
    226        1.9  augustss Static void		ehci_dump_qtd(ehci_qtd_t *);
    227        1.9  augustss Static void		ehci_dump_sqh(ehci_soft_qh_t *);
    228       1.38    martin #ifdef DIAGNOSTIC
    229       1.18  augustss Static void		ehci_dump_exfer(struct ehci_xfer *);
    230        1.5  augustss #endif
    231       1.38    martin #endif
    232        1.5  augustss 
    233       1.11  augustss #define EHCI_NULL htole32(EHCI_LINK_TERMINATE)
    234       1.11  augustss 
    235        1.5  augustss #define EHCI_INTR_ENDPT 1
    236        1.5  augustss 
    237       1.18  augustss #define ehci_add_intr_list(sc, ex) \
    238       1.18  augustss 	LIST_INSERT_HEAD(&(sc)->sc_intrhead, (ex), inext);
    239       1.18  augustss #define ehci_del_intr_list(ex) \
    240       1.44  augustss 	do { \
    241       1.44  augustss 		LIST_REMOVE((ex), inext); \
    242       1.44  augustss 		(ex)->inext.le_prev = NULL; \
    243       1.44  augustss 	} while (0)
    244       1.44  augustss #define ehci_active_intr_list(ex) ((ex)->inext.le_prev != NULL)
    245       1.18  augustss 
    246        1.5  augustss Static struct usbd_bus_methods ehci_bus_methods = {
    247        1.5  augustss 	ehci_open,
    248        1.5  augustss 	ehci_softintr,
    249        1.5  augustss 	ehci_poll,
    250        1.5  augustss 	ehci_allocm,
    251        1.5  augustss 	ehci_freem,
    252        1.5  augustss 	ehci_allocx,
    253        1.5  augustss 	ehci_freex,
    254        1.5  augustss };
    255        1.5  augustss 
    256       1.33  augustss Static struct usbd_pipe_methods ehci_root_ctrl_methods = {
    257        1.5  augustss 	ehci_root_ctrl_transfer,
    258        1.5  augustss 	ehci_root_ctrl_start,
    259        1.5  augustss 	ehci_root_ctrl_abort,
    260        1.5  augustss 	ehci_root_ctrl_close,
    261        1.5  augustss 	ehci_noop,
    262        1.5  augustss 	ehci_root_ctrl_done,
    263        1.5  augustss };
    264        1.5  augustss 
    265       1.33  augustss Static struct usbd_pipe_methods ehci_root_intr_methods = {
    266        1.5  augustss 	ehci_root_intr_transfer,
    267        1.5  augustss 	ehci_root_intr_start,
    268        1.5  augustss 	ehci_root_intr_abort,
    269        1.5  augustss 	ehci_root_intr_close,
    270        1.5  augustss 	ehci_noop,
    271        1.5  augustss 	ehci_root_intr_done,
    272        1.5  augustss };
    273        1.5  augustss 
    274       1.33  augustss Static struct usbd_pipe_methods ehci_device_ctrl_methods = {
    275        1.5  augustss 	ehci_device_ctrl_transfer,
    276        1.5  augustss 	ehci_device_ctrl_start,
    277        1.5  augustss 	ehci_device_ctrl_abort,
    278        1.5  augustss 	ehci_device_ctrl_close,
    279        1.5  augustss 	ehci_noop,
    280        1.5  augustss 	ehci_device_ctrl_done,
    281        1.5  augustss };
    282        1.5  augustss 
    283       1.33  augustss Static struct usbd_pipe_methods ehci_device_intr_methods = {
    284        1.5  augustss 	ehci_device_intr_transfer,
    285        1.5  augustss 	ehci_device_intr_start,
    286        1.5  augustss 	ehci_device_intr_abort,
    287        1.5  augustss 	ehci_device_intr_close,
    288        1.5  augustss 	ehci_device_clear_toggle,
    289        1.5  augustss 	ehci_device_intr_done,
    290        1.5  augustss };
    291        1.5  augustss 
    292       1.33  augustss Static struct usbd_pipe_methods ehci_device_bulk_methods = {
    293        1.5  augustss 	ehci_device_bulk_transfer,
    294        1.5  augustss 	ehci_device_bulk_start,
    295        1.5  augustss 	ehci_device_bulk_abort,
    296        1.5  augustss 	ehci_device_bulk_close,
    297        1.5  augustss 	ehci_device_clear_toggle,
    298        1.5  augustss 	ehci_device_bulk_done,
    299        1.5  augustss };
    300        1.5  augustss 
    301        1.5  augustss Static struct usbd_pipe_methods ehci_device_isoc_methods = {
    302        1.5  augustss 	ehci_device_isoc_transfer,
    303        1.5  augustss 	ehci_device_isoc_start,
    304        1.5  augustss 	ehci_device_isoc_abort,
    305        1.5  augustss 	ehci_device_isoc_close,
    306        1.5  augustss 	ehci_noop,
    307        1.5  augustss 	ehci_device_isoc_done,
    308        1.5  augustss };
    309        1.5  augustss 
    310        1.1  augustss usbd_status
    311        1.1  augustss ehci_init(ehci_softc_t *sc)
    312        1.1  augustss {
    313        1.3  augustss 	u_int32_t version, sparams, cparams, hcr;
    314        1.3  augustss 	u_int i;
    315        1.3  augustss 	usbd_status err;
    316       1.11  augustss 	ehci_soft_qh_t *sqh;
    317        1.3  augustss 
    318        1.3  augustss 	DPRINTF(("ehci_init: start\n"));
    319        1.6  augustss #ifdef EHCI_DEBUG
    320        1.6  augustss 	theehci = sc;
    321        1.6  augustss #endif
    322        1.3  augustss 
    323        1.3  augustss 	sc->sc_offs = EREAD1(sc, EHCI_CAPLENGTH);
    324        1.3  augustss 
    325        1.3  augustss 	version = EREAD2(sc, EHCI_HCIVERSION);
    326       1.41   thorpej 	aprint_normal("%s: EHCI version %x.%x\n", USBDEVNAME(sc->sc_bus.bdev),
    327        1.3  augustss 	       version >> 8, version & 0xff);
    328        1.3  augustss 
    329        1.3  augustss 	sparams = EREAD4(sc, EHCI_HCSPARAMS);
    330        1.3  augustss 	DPRINTF(("ehci_init: sparams=0x%x\n", sparams));
    331        1.6  augustss 	sc->sc_npcomp = EHCI_HCS_N_PCC(sparams);
    332        1.3  augustss 	if (EHCI_HCS_N_CC(sparams) != sc->sc_ncomp) {
    333       1.41   thorpej 		aprint_error("%s: wrong number of companions (%d != %d)\n",
    334        1.3  augustss 		       USBDEVNAME(sc->sc_bus.bdev),
    335        1.3  augustss 		       EHCI_HCS_N_CC(sparams), sc->sc_ncomp);
    336       1.47  augustss #if NOHCI == 0 || NUHCI == 0
    337       1.47  augustss 		aprint_error("%s: ohci or uhci probably not configured\n",
    338       1.47  augustss 			     USBDEVNAME(sc->sc_bus.bdev));
    339       1.47  augustss #endif
    340        1.3  augustss 		return (USBD_IOERROR);
    341        1.3  augustss 	}
    342        1.3  augustss 	if (sc->sc_ncomp > 0) {
    343       1.41   thorpej 		aprint_normal("%s: companion controller%s, %d port%s each:",
    344        1.3  augustss 		    USBDEVNAME(sc->sc_bus.bdev), sc->sc_ncomp!=1 ? "s" : "",
    345        1.3  augustss 		    EHCI_HCS_N_PCC(sparams),
    346        1.3  augustss 		    EHCI_HCS_N_PCC(sparams)!=1 ? "s" : "");
    347        1.3  augustss 		for (i = 0; i < sc->sc_ncomp; i++)
    348       1.41   thorpej 			aprint_normal(" %s", USBDEVNAME(sc->sc_comps[i]->bdev));
    349       1.41   thorpej 		aprint_normal("\n");
    350        1.3  augustss 	}
    351        1.5  augustss 	sc->sc_noport = EHCI_HCS_N_PORTS(sparams);
    352        1.3  augustss 	cparams = EREAD4(sc, EHCI_HCCPARAMS);
    353        1.3  augustss 	DPRINTF(("ehci_init: cparams=0x%x\n", cparams));
    354       1.36  augustss 
    355       1.36  augustss 	if (EHCI_HCC_64BIT(cparams)) {
    356       1.36  augustss 		/* MUST clear segment register if 64 bit capable. */
    357       1.36  augustss 		EWRITE4(sc, EHCI_CTRLDSSEGMENT, 0);
    358       1.36  augustss 	}
    359       1.33  augustss 
    360        1.3  augustss 	sc->sc_bus.usbrev = USBREV_2_0;
    361        1.3  augustss 
    362        1.3  augustss 	/* Reset the controller */
    363        1.3  augustss 	DPRINTF(("%s: resetting\n", USBDEVNAME(sc->sc_bus.bdev)));
    364        1.3  augustss 	EOWRITE4(sc, EHCI_USBCMD, 0);	/* Halt controller */
    365        1.3  augustss 	usb_delay_ms(&sc->sc_bus, 1);
    366        1.3  augustss 	EOWRITE4(sc, EHCI_USBCMD, EHCI_CMD_HCRESET);
    367        1.3  augustss 	for (i = 0; i < 100; i++) {
    368       1.34  augustss 		usb_delay_ms(&sc->sc_bus, 1);
    369        1.3  augustss 		hcr = EOREAD4(sc, EHCI_USBCMD) & EHCI_CMD_HCRESET;
    370        1.3  augustss 		if (!hcr)
    371        1.3  augustss 			break;
    372        1.3  augustss 	}
    373        1.3  augustss 	if (hcr) {
    374       1.41   thorpej 		aprint_error("%s: reset timeout\n",
    375       1.41   thorpej 		    USBDEVNAME(sc->sc_bus.bdev));
    376        1.3  augustss 		return (USBD_IOERROR);
    377        1.3  augustss 	}
    378        1.3  augustss 
    379        1.3  augustss 	/* frame list size at default, read back what we got and use that */
    380        1.3  augustss 	switch (EHCI_CMD_FLS(EOREAD4(sc, EHCI_USBCMD))) {
    381        1.3  augustss 	case 0: sc->sc_flsize = 1024*4; break;
    382        1.3  augustss 	case 1: sc->sc_flsize = 512*4; break;
    383        1.3  augustss 	case 2: sc->sc_flsize = 256*4; break;
    384        1.3  augustss 	case 3: return (USBD_IOERROR);
    385        1.3  augustss 	}
    386        1.3  augustss 	err = usb_allocmem(&sc->sc_bus, sc->sc_flsize,
    387        1.3  augustss 			   EHCI_FLALIGN_ALIGN, &sc->sc_fldma);
    388        1.3  augustss 	if (err)
    389        1.3  augustss 		return (err);
    390        1.3  augustss 	DPRINTF(("%s: flsize=%d\n", USBDEVNAME(sc->sc_bus.bdev),sc->sc_flsize));
    391        1.3  augustss 
    392        1.5  augustss 	/* Set up the bus struct. */
    393        1.5  augustss 	sc->sc_bus.methods = &ehci_bus_methods;
    394        1.5  augustss 	sc->sc_bus.pipe_size = sizeof(struct ehci_pipe);
    395        1.5  augustss 
    396        1.5  augustss 	sc->sc_powerhook = powerhook_establish(ehci_power, sc);
    397        1.5  augustss 	sc->sc_shutdownhook = shutdownhook_establish(ehci_shutdown, sc);
    398        1.5  augustss 
    399        1.6  augustss 	sc->sc_eintrs = EHCI_NORMAL_INTRS;
    400        1.6  augustss 
    401       1.11  augustss 	/* Allocate dummy QH that starts the async list. */
    402       1.11  augustss 	sqh = ehci_alloc_sqh(sc);
    403       1.11  augustss 	if (sqh == NULL) {
    404        1.9  augustss 		err = USBD_NOMEM;
    405        1.9  augustss 		goto bad1;
    406        1.9  augustss 	}
    407       1.11  augustss 	/* Fill the QH */
    408       1.11  augustss 	sqh->qh.qh_endp =
    409       1.11  augustss 	    htole32(EHCI_QH_SET_EPS(EHCI_QH_SPEED_HIGH) | EHCI_QH_HRECL);
    410       1.11  augustss 	sqh->qh.qh_link =
    411       1.11  augustss 	    htole32(sqh->physaddr | EHCI_LINK_QH);
    412       1.11  augustss 	sqh->qh.qh_curqtd = EHCI_NULL;
    413       1.11  augustss 	sqh->next = NULL;
    414       1.11  augustss 	/* Fill the overlay qTD */
    415       1.11  augustss 	sqh->qh.qh_qtd.qtd_next = EHCI_NULL;
    416       1.11  augustss 	sqh->qh.qh_qtd.qtd_altnext = EHCI_NULL;
    417       1.26  augustss 	sqh->qh.qh_qtd.qtd_status = htole32(EHCI_QTD_HALTED);
    418       1.11  augustss 	sqh->sqtd = NULL;
    419        1.9  augustss #ifdef EHCI_DEBUG
    420        1.9  augustss 	if (ehcidebug) {
    421       1.27     enami 		ehci_dump_sqh(sqh);
    422        1.9  augustss 	}
    423        1.9  augustss #endif
    424        1.9  augustss 
    425        1.9  augustss 	/* Point to async list */
    426       1.11  augustss 	sc->sc_async_head = sqh;
    427       1.11  augustss 	EOWRITE4(sc, EHCI_ASYNCLISTADDR, sqh->physaddr | EHCI_LINK_QH);
    428        1.9  augustss 
    429        1.9  augustss 	usb_callout_init(sc->sc_tmo_pcd);
    430        1.9  augustss 
    431       1.10  augustss 	lockinit(&sc->sc_doorbell_lock, PZERO, "ehcidb", 0, 0);
    432       1.10  augustss 
    433        1.6  augustss 	/* Enable interrupts */
    434        1.6  augustss 	EOWRITE4(sc, EHCI_USBINTR, sc->sc_eintrs);
    435        1.6  augustss 
    436        1.6  augustss 	/* Turn on controller */
    437        1.6  augustss 	EOWRITE4(sc, EHCI_USBCMD,
    438        1.6  augustss 		 EHCI_CMD_ITC_8 | /* 8 microframes */
    439        1.6  augustss 		 (EOREAD4(sc, EHCI_USBCMD) & EHCI_CMD_FLS_M) |
    440       1.10  augustss 		 EHCI_CMD_ASE |
    441        1.6  augustss 		 /* EHCI_CMD_PSE | */
    442        1.6  augustss 		 EHCI_CMD_RS);
    443        1.6  augustss 
    444        1.6  augustss 	/* Take over port ownership */
    445        1.6  augustss 	EOWRITE4(sc, EHCI_CONFIGFLAG, EHCI_CONF_CF);
    446        1.6  augustss 
    447        1.8  augustss 	for (i = 0; i < 100; i++) {
    448       1.34  augustss 		usb_delay_ms(&sc->sc_bus, 1);
    449        1.8  augustss 		hcr = EOREAD4(sc, EHCI_USBSTS) & EHCI_STS_HCH;
    450        1.8  augustss 		if (!hcr)
    451        1.8  augustss 			break;
    452        1.8  augustss 	}
    453        1.8  augustss 	if (hcr) {
    454       1.41   thorpej 		aprint_error("%s: run timeout\n", USBDEVNAME(sc->sc_bus.bdev));
    455        1.8  augustss 		return (USBD_IOERROR);
    456        1.8  augustss 	}
    457        1.8  augustss 
    458        1.5  augustss 	return (USBD_NORMAL_COMPLETION);
    459        1.9  augustss 
    460        1.9  augustss #if 0
    461       1.11  augustss  bad2:
    462       1.15  augustss 	ehci_free_sqh(sc, sc->sc_async_head);
    463        1.9  augustss #endif
    464        1.9  augustss  bad1:
    465        1.9  augustss 	usb_freemem(&sc->sc_bus, &sc->sc_fldma);
    466        1.9  augustss 	return (err);
    467        1.1  augustss }
    468        1.1  augustss 
    469        1.1  augustss int
    470        1.1  augustss ehci_intr(void *v)
    471        1.1  augustss {
    472        1.6  augustss 	ehci_softc_t *sc = v;
    473        1.6  augustss 
    474       1.17  augustss 	if (sc == NULL || sc->sc_dying)
    475       1.15  augustss 		return (0);
    476       1.15  augustss 
    477        1.6  augustss 	/* If we get an interrupt while polling, then just ignore it. */
    478        1.6  augustss 	if (sc->sc_bus.use_polling) {
    479        1.6  augustss #ifdef DIAGNOSTIC
    480  1.54.2.11        he 		DPRINTFN(16, ("ehci_intr: ignored interrupt while polling\n"));
    481        1.6  augustss #endif
    482        1.6  augustss 		return (0);
    483        1.6  augustss 	}
    484        1.6  augustss 
    485       1.33  augustss 	return (ehci_intr1(sc));
    486        1.6  augustss }
    487        1.6  augustss 
    488        1.6  augustss Static int
    489        1.6  augustss ehci_intr1(ehci_softc_t *sc)
    490        1.6  augustss {
    491        1.6  augustss 	u_int32_t intrs, eintrs;
    492        1.6  augustss 
    493        1.6  augustss 	DPRINTFN(20,("ehci_intr1: enter\n"));
    494        1.6  augustss 
    495        1.6  augustss 	/* In case the interrupt occurs before initialization has completed. */
    496        1.6  augustss 	if (sc == NULL) {
    497        1.6  augustss #ifdef DIAGNOSTIC
    498        1.6  augustss 		printf("ehci_intr: sc == NULL\n");
    499        1.6  augustss #endif
    500        1.6  augustss 		return (0);
    501        1.6  augustss 	}
    502        1.6  augustss 
    503        1.6  augustss 	intrs = EHCI_STS_INTRS(EOREAD4(sc, EHCI_USBSTS));
    504        1.6  augustss 
    505        1.6  augustss 	if (!intrs)
    506        1.6  augustss 		return (0);
    507        1.6  augustss 
    508        1.6  augustss 	EOWRITE4(sc, EHCI_USBSTS, intrs); /* Acknowledge */
    509        1.6  augustss 	eintrs = intrs & sc->sc_eintrs;
    510       1.33  augustss 	DPRINTFN(7, ("ehci_intr: sc=%p intrs=0x%x(0x%x) eintrs=0x%x\n",
    511        1.6  augustss 		     sc, (u_int)intrs, EOREAD4(sc, EHCI_USBSTS),
    512        1.6  augustss 		     (u_int)eintrs));
    513        1.6  augustss 	if (!eintrs)
    514        1.6  augustss 		return (0);
    515        1.6  augustss 
    516        1.6  augustss 	sc->sc_bus.intr_context++;
    517        1.6  augustss 	sc->sc_bus.no_intrs++;
    518       1.10  augustss 	if (eintrs & EHCI_STS_IAA) {
    519       1.10  augustss 		DPRINTF(("ehci_intr1: door bell\n"));
    520       1.11  augustss 		wakeup(&sc->sc_async_head);
    521       1.20  augustss 		eintrs &= ~EHCI_STS_IAA;
    522       1.10  augustss 	}
    523       1.18  augustss 	if (eintrs & (EHCI_STS_INT | EHCI_STS_ERRINT)) {
    524       1.46  augustss 		DPRINTFN(5,("ehci_intr1: %s %s\n",
    525       1.46  augustss 			    eintrs & EHCI_STS_INT ? "INT" : "",
    526       1.46  augustss 			    eintrs & EHCI_STS_ERRINT ? "ERRINT" : ""));
    527       1.18  augustss 		usb_schedsoftintr(&sc->sc_bus);
    528       1.21  augustss 		eintrs &= ~(EHCI_STS_INT | EHCI_STS_ERRINT);
    529        1.6  augustss 	}
    530        1.6  augustss 	if (eintrs & EHCI_STS_HSE) {
    531        1.6  augustss 		printf("%s: unrecoverable error, controller halted\n",
    532        1.6  augustss 		       USBDEVNAME(sc->sc_bus.bdev));
    533        1.6  augustss 		/* XXX what else */
    534        1.6  augustss 	}
    535        1.6  augustss 	if (eintrs & EHCI_STS_PCD) {
    536        1.6  augustss 		ehci_pcd(sc, sc->sc_intrxfer);
    537       1.33  augustss 		/*
    538        1.6  augustss 		 * Disable PCD interrupt for now, because it will be
    539        1.6  augustss 		 * on until the port has been reset.
    540        1.6  augustss 		 */
    541        1.6  augustss 		ehci_pcd_able(sc, 0);
    542        1.6  augustss 		/* Do not allow RHSC interrupts > 1 per second */
    543        1.6  augustss                 usb_callout(sc->sc_tmo_pcd, hz, ehci_pcd_enable, sc);
    544        1.6  augustss 		eintrs &= ~EHCI_STS_PCD;
    545        1.6  augustss 	}
    546        1.6  augustss 
    547        1.6  augustss 	sc->sc_bus.intr_context--;
    548        1.6  augustss 
    549        1.6  augustss 	if (eintrs != 0) {
    550        1.6  augustss 		/* Block unprocessed interrupts. */
    551        1.6  augustss 		sc->sc_eintrs &= ~eintrs;
    552        1.6  augustss 		EOWRITE4(sc, EHCI_USBINTR, sc->sc_eintrs);
    553        1.6  augustss 		printf("%s: blocking intrs 0x%x\n",
    554        1.6  augustss 		       USBDEVNAME(sc->sc_bus.bdev), eintrs);
    555        1.6  augustss 	}
    556        1.6  augustss 
    557        1.6  augustss 	return (1);
    558        1.6  augustss }
    559        1.6  augustss 
    560        1.6  augustss void
    561        1.6  augustss ehci_pcd_able(ehci_softc_t *sc, int on)
    562        1.6  augustss {
    563        1.6  augustss 	DPRINTFN(4, ("ehci_pcd_able: on=%d\n", on));
    564        1.6  augustss 	if (on)
    565        1.6  augustss 		sc->sc_eintrs |= EHCI_STS_PCD;
    566        1.6  augustss 	else
    567        1.6  augustss 		sc->sc_eintrs &= ~EHCI_STS_PCD;
    568        1.6  augustss 	EOWRITE4(sc, EHCI_USBINTR, sc->sc_eintrs);
    569        1.6  augustss }
    570        1.6  augustss 
    571        1.6  augustss void
    572        1.6  augustss ehci_pcd_enable(void *v_sc)
    573        1.6  augustss {
    574        1.6  augustss 	ehci_softc_t *sc = v_sc;
    575        1.6  augustss 
    576        1.6  augustss 	ehci_pcd_able(sc, 1);
    577        1.6  augustss }
    578        1.6  augustss 
    579        1.6  augustss void
    580        1.6  augustss ehci_pcd(ehci_softc_t *sc, usbd_xfer_handle xfer)
    581        1.6  augustss {
    582        1.6  augustss 	usbd_pipe_handle pipe;
    583        1.6  augustss 	u_char *p;
    584        1.6  augustss 	int i, m;
    585        1.6  augustss 
    586        1.6  augustss 	if (xfer == NULL) {
    587        1.6  augustss 		/* Just ignore the change. */
    588        1.6  augustss 		return;
    589        1.6  augustss 	}
    590        1.6  augustss 
    591        1.6  augustss 	pipe = xfer->pipe;
    592        1.6  augustss 
    593       1.30  augustss 	p = KERNADDR(&xfer->dmabuf, 0);
    594        1.6  augustss 	m = min(sc->sc_noport, xfer->length * 8 - 1);
    595        1.6  augustss 	memset(p, 0, xfer->length);
    596        1.6  augustss 	for (i = 1; i <= m; i++) {
    597        1.6  augustss 		/* Pick out CHANGE bits from the status reg. */
    598        1.6  augustss 		if (EOREAD4(sc, EHCI_PORTSC(i)) & EHCI_PS_CLEAR)
    599        1.6  augustss 			p[i/8] |= 1 << (i%8);
    600        1.6  augustss 	}
    601        1.6  augustss 	DPRINTF(("ehci_pcd: change=0x%02x\n", *p));
    602        1.6  augustss 	xfer->actlen = xfer->length;
    603        1.6  augustss 	xfer->status = USBD_NORMAL_COMPLETION;
    604        1.6  augustss 
    605        1.6  augustss 	usb_transfer_complete(xfer);
    606        1.1  augustss }
    607        1.1  augustss 
    608        1.5  augustss void
    609        1.5  augustss ehci_softintr(void *v)
    610        1.5  augustss {
    611       1.18  augustss 	ehci_softc_t *sc = v;
    612       1.53       chs 	struct ehci_xfer *ex, *nextex;
    613       1.18  augustss 
    614       1.18  augustss 	DPRINTFN(10,("%s: ehci_softintr (%d)\n", USBDEVNAME(sc->sc_bus.bdev),
    615       1.18  augustss 		     sc->sc_bus.intr_context));
    616       1.18  augustss 
    617       1.18  augustss 	sc->sc_bus.intr_context++;
    618       1.18  augustss 
    619       1.18  augustss 	/*
    620       1.18  augustss 	 * The only explanation I can think of for why EHCI is as brain dead
    621       1.18  augustss 	 * as UHCI interrupt-wise is that Intel was involved in both.
    622       1.18  augustss 	 * An interrupt just tells us that something is done, we have no
    623       1.18  augustss 	 * clue what, so we need to scan through all active transfers. :-(
    624       1.18  augustss 	 */
    625       1.53       chs 	for (ex = LIST_FIRST(&sc->sc_intrhead); ex; ex = nextex) {
    626       1.53       chs 		nextex = LIST_NEXT(ex, inext);
    627       1.18  augustss 		ehci_check_intr(sc, ex);
    628       1.53       chs 	}
    629       1.18  augustss 
    630       1.29  augustss 	if (sc->sc_softwake) {
    631       1.29  augustss 		sc->sc_softwake = 0;
    632       1.29  augustss 		wakeup(&sc->sc_softwake);
    633       1.29  augustss 	}
    634       1.29  augustss 
    635       1.18  augustss 	sc->sc_bus.intr_context--;
    636       1.18  augustss }
    637       1.18  augustss 
    638       1.18  augustss /* Check for an interrupt. */
    639       1.18  augustss void
    640       1.18  augustss ehci_check_intr(ehci_softc_t *sc, struct ehci_xfer *ex)
    641       1.18  augustss {
    642       1.18  augustss 	ehci_soft_qtd_t *sqtd, *lsqtd;
    643       1.18  augustss 	u_int32_t status;
    644       1.18  augustss 
    645       1.22  augustss 	DPRINTFN(/*15*/2, ("ehci_check_intr: ex=%p\n", ex));
    646       1.18  augustss 
    647       1.18  augustss 	if (ex->sqtdstart == NULL) {
    648       1.18  augustss 		printf("ehci_check_intr: sqtdstart=NULL\n");
    649       1.18  augustss 		return;
    650       1.18  augustss 	}
    651       1.18  augustss 	lsqtd = ex->sqtdend;
    652       1.18  augustss #ifdef DIAGNOSTIC
    653       1.18  augustss 	if (lsqtd == NULL) {
    654       1.18  augustss 		printf("ehci_check_intr: sqtd==0\n");
    655       1.18  augustss 		return;
    656       1.18  augustss 	}
    657       1.18  augustss #endif
    658       1.33  augustss 	/*
    659       1.18  augustss 	 * If the last TD is still active we need to check whether there
    660       1.18  augustss 	 * is a an error somewhere in the middle, or whether there was a
    661       1.18  augustss 	 * short packet (SPD and not ACTIVE).
    662       1.18  augustss 	 */
    663       1.18  augustss 	if (le32toh(lsqtd->qtd.qtd_status) & EHCI_QTD_ACTIVE) {
    664       1.18  augustss 		DPRINTFN(12, ("ehci_check_intr: active ex=%p\n", ex));
    665       1.18  augustss 		for (sqtd = ex->sqtdstart; sqtd != lsqtd; sqtd=sqtd->nextqtd) {
    666       1.18  augustss 			status = le32toh(sqtd->qtd.qtd_status);
    667       1.18  augustss 			/* If there's an active QTD the xfer isn't done. */
    668       1.18  augustss 			if (status & EHCI_QTD_ACTIVE)
    669       1.18  augustss 				break;
    670       1.18  augustss 			/* Any kind of error makes the xfer done. */
    671       1.18  augustss 			if (status & EHCI_QTD_HALTED)
    672       1.18  augustss 				goto done;
    673       1.18  augustss 			/* We want short packets, and it is short: it's done */
    674   1.54.2.4      tron 			if (EHCI_QTD_GET_BYTES(status) != 0)
    675       1.18  augustss 				goto done;
    676       1.18  augustss 		}
    677       1.18  augustss 		DPRINTFN(12, ("ehci_check_intr: ex=%p std=%p still active\n",
    678       1.18  augustss 			      ex, ex->sqtdstart));
    679       1.18  augustss 		return;
    680       1.18  augustss 	}
    681       1.18  augustss  done:
    682       1.18  augustss 	DPRINTFN(12, ("ehci_check_intr: ex=%p done\n", ex));
    683       1.18  augustss 	usb_uncallout(ex->xfer.timeout_handle, ehci_timeout, ex);
    684       1.18  augustss 	ehci_idone(ex);
    685       1.18  augustss }
    686       1.18  augustss 
    687       1.18  augustss void
    688       1.18  augustss ehci_idone(struct ehci_xfer *ex)
    689       1.18  augustss {
    690       1.18  augustss 	usbd_xfer_handle xfer = &ex->xfer;
    691       1.18  augustss 	struct ehci_pipe *epipe = (struct ehci_pipe *)xfer->pipe;
    692       1.18  augustss 	ehci_soft_qtd_t *sqtd;
    693       1.18  augustss 	u_int32_t status = 0, nstatus;
    694       1.18  augustss 	int actlen;
    695       1.18  augustss 
    696       1.22  augustss 	DPRINTFN(/*12*/2, ("ehci_idone: ex=%p\n", ex));
    697       1.18  augustss #ifdef DIAGNOSTIC
    698       1.18  augustss 	{
    699       1.18  augustss 		int s = splhigh();
    700       1.18  augustss 		if (ex->isdone) {
    701       1.18  augustss 			splx(s);
    702       1.18  augustss #ifdef EHCI_DEBUG
    703       1.18  augustss 			printf("ehci_idone: ex is done!\n   ");
    704       1.18  augustss 			ehci_dump_exfer(ex);
    705       1.18  augustss #else
    706       1.18  augustss 			printf("ehci_idone: ex=%p is done!\n", ex);
    707       1.18  augustss #endif
    708       1.18  augustss 			return;
    709       1.18  augustss 		}
    710       1.18  augustss 		ex->isdone = 1;
    711       1.18  augustss 		splx(s);
    712       1.18  augustss 	}
    713       1.18  augustss #endif
    714       1.18  augustss 
    715       1.18  augustss 	if (xfer->status == USBD_CANCELLED ||
    716       1.18  augustss 	    xfer->status == USBD_TIMEOUT) {
    717       1.18  augustss 		DPRINTF(("ehci_idone: aborted xfer=%p\n", xfer));
    718       1.18  augustss 		return;
    719       1.18  augustss 	}
    720       1.18  augustss 
    721       1.18  augustss #ifdef EHCI_DEBUG
    722       1.23  augustss 	DPRINTFN(/*10*/2, ("ehci_idone: xfer=%p, pipe=%p ready\n", xfer, epipe));
    723       1.18  augustss 	if (ehcidebug > 10)
    724       1.18  augustss 		ehci_dump_sqtds(ex->sqtdstart);
    725       1.18  augustss #endif
    726       1.18  augustss 
    727       1.18  augustss 	/* The transfer is done, compute actual length and status. */
    728       1.18  augustss 	actlen = 0;
    729       1.18  augustss 	for (sqtd = ex->sqtdstart; sqtd != NULL; sqtd = sqtd->nextqtd) {
    730       1.18  augustss 		nstatus = le32toh(sqtd->qtd.qtd_status);
    731       1.18  augustss 		if (nstatus & EHCI_QTD_ACTIVE)
    732       1.18  augustss 			break;
    733       1.18  augustss 
    734       1.18  augustss 		status = nstatus;
    735       1.48   mycroft 		/* halt is ok if descriptor is last, and complete */
    736       1.49     enami 		if (sqtd->qtd.qtd_next == EHCI_NULL &&
    737       1.49     enami 		    EHCI_QTD_GET_BYTES(status) == 0)
    738       1.48   mycroft 			status &= ~EHCI_QTD_HALTED;
    739       1.18  augustss 		if (EHCI_QTD_GET_PID(status) !=	EHCI_QTD_PID_SETUP)
    740       1.18  augustss 			actlen += sqtd->len - EHCI_QTD_GET_BYTES(status);
    741       1.18  augustss 	}
    742       1.22  augustss 
    743       1.22  augustss 	/* If there are left over TDs we need to update the toggle. */
    744       1.22  augustss 	if (sqtd != NULL) {
    745   1.54.2.4      tron 		printf("ehci_idone: need toggle update status=%08x nstatus=%08x\n", status, nstatus);
    746   1.54.2.4      tron #if 0
    747   1.54.2.4      tron 		ehci_dump_sqh(epipe->sqh);
    748   1.54.2.4      tron 		ehci_dump_sqtds(ex->sqtdstart);
    749   1.54.2.4      tron #endif
    750   1.54.2.4      tron 		epipe->nexttoggle = EHCI_QTD_GET_TOGGLE(nstatus);
    751       1.22  augustss 	}
    752       1.18  augustss 
    753       1.18  augustss 	status &= EHCI_QTD_STATERRS;
    754       1.23  augustss 	DPRINTFN(/*10*/2, ("ehci_idone: len=%d, actlen=%d, status=0x%x\n",
    755       1.22  augustss 			   xfer->length, actlen, status));
    756       1.18  augustss 	xfer->actlen = actlen;
    757       1.18  augustss 	if (status != 0) {
    758       1.18  augustss #ifdef EHCI_DEBUG
    759       1.18  augustss 		char sbuf[128];
    760       1.18  augustss 
    761       1.18  augustss 		bitmask_snprintf((u_int32_t)status,
    762   1.54.2.9      tron 				 "\20\7HALTED\6BUFERR\5BABBLE\4XACTERR"
    763   1.54.2.9      tron 				 "\3MISSED", sbuf, sizeof(sbuf));
    764       1.18  augustss 
    765       1.22  augustss 		DPRINTFN((status == EHCI_QTD_HALTED)*/*10*/2,
    766       1.18  augustss 			 ("ehci_idone: error, addr=%d, endpt=0x%02x, "
    767       1.18  augustss 			  "status 0x%s\n",
    768       1.18  augustss 			  xfer->pipe->device->address,
    769       1.18  augustss 			  xfer->pipe->endpoint->edesc->bEndpointAddress,
    770       1.18  augustss 			  sbuf));
    771       1.23  augustss 		if (ehcidebug > 2) {
    772       1.23  augustss 			ehci_dump_sqh(epipe->sqh);
    773       1.23  augustss 			ehci_dump_sqtds(ex->sqtdstart);
    774       1.23  augustss 		}
    775       1.18  augustss #endif
    776       1.18  augustss 		if (status == EHCI_QTD_HALTED)
    777       1.18  augustss 			xfer->status = USBD_STALLED;
    778       1.18  augustss 		else
    779       1.18  augustss 			xfer->status = USBD_IOERROR; /* more info XXX */
    780       1.18  augustss 	} else {
    781       1.18  augustss 		xfer->status = USBD_NORMAL_COMPLETION;
    782       1.18  augustss 	}
    783       1.18  augustss 
    784       1.18  augustss 	usb_transfer_complete(xfer);
    785       1.22  augustss 	DPRINTFN(/*12*/2, ("ehci_idone: ex=%p done\n", ex));
    786        1.5  augustss }
    787        1.5  augustss 
    788       1.15  augustss /*
    789       1.15  augustss  * Wait here until controller claims to have an interrupt.
    790       1.18  augustss  * Then call ehci_intr and return.  Use timeout to avoid waiting
    791       1.15  augustss  * too long.
    792       1.15  augustss  */
    793       1.15  augustss void
    794       1.15  augustss ehci_waitintr(ehci_softc_t *sc, usbd_xfer_handle xfer)
    795       1.15  augustss {
    796       1.15  augustss 	int timo = xfer->timeout;
    797       1.15  augustss 	int usecs;
    798       1.15  augustss 	u_int32_t intrs;
    799       1.15  augustss 
    800       1.15  augustss 	xfer->status = USBD_IN_PROGRESS;
    801       1.15  augustss 	for (usecs = timo * 1000000 / hz; usecs > 0; usecs -= 1000) {
    802       1.15  augustss 		usb_delay_ms(&sc->sc_bus, 1);
    803       1.17  augustss 		if (sc->sc_dying)
    804       1.17  augustss 			break;
    805       1.15  augustss 		intrs = EHCI_STS_INTRS(EOREAD4(sc, EHCI_USBSTS)) &
    806       1.15  augustss 			sc->sc_eintrs;
    807       1.15  augustss 		DPRINTFN(15,("ehci_waitintr: 0x%04x\n", intrs));
    808       1.15  augustss #ifdef OHCI_DEBUG
    809       1.15  augustss 		if (ehcidebug > 15)
    810       1.18  augustss 			ehci_dump_regs(sc);
    811       1.15  augustss #endif
    812       1.15  augustss 		if (intrs) {
    813       1.15  augustss 			ehci_intr1(sc);
    814       1.15  augustss 			if (xfer->status != USBD_IN_PROGRESS)
    815       1.15  augustss 				return;
    816       1.15  augustss 		}
    817       1.15  augustss 	}
    818       1.15  augustss 
    819       1.15  augustss 	/* Timeout */
    820       1.15  augustss 	DPRINTF(("ehci_waitintr: timeout\n"));
    821       1.15  augustss 	xfer->status = USBD_TIMEOUT;
    822       1.15  augustss 	usb_transfer_complete(xfer);
    823       1.15  augustss 	/* XXX should free TD */
    824       1.15  augustss }
    825       1.15  augustss 
    826        1.5  augustss void
    827        1.5  augustss ehci_poll(struct usbd_bus *bus)
    828        1.5  augustss {
    829        1.5  augustss 	ehci_softc_t *sc = (ehci_softc_t *)bus;
    830        1.5  augustss #ifdef EHCI_DEBUG
    831        1.5  augustss 	static int last;
    832        1.5  augustss 	int new;
    833        1.6  augustss 	new = EHCI_STS_INTRS(EOREAD4(sc, EHCI_USBSTS));
    834        1.5  augustss 	if (new != last) {
    835        1.5  augustss 		DPRINTFN(10,("ehci_poll: intrs=0x%04x\n", new));
    836        1.5  augustss 		last = new;
    837        1.5  augustss 	}
    838        1.5  augustss #endif
    839        1.5  augustss 
    840        1.6  augustss 	if (EOREAD4(sc, EHCI_USBSTS) & sc->sc_eintrs)
    841        1.5  augustss 		ehci_intr1(sc);
    842        1.5  augustss }
    843        1.5  augustss 
    844        1.1  augustss int
    845        1.1  augustss ehci_detach(struct ehci_softc *sc, int flags)
    846        1.1  augustss {
    847        1.1  augustss 	int rv = 0;
    848        1.1  augustss 
    849        1.1  augustss 	if (sc->sc_child != NULL)
    850        1.1  augustss 		rv = config_detach(sc->sc_child, flags);
    851       1.33  augustss 
    852        1.1  augustss 	if (rv != 0)
    853        1.1  augustss 		return (rv);
    854        1.1  augustss 
    855        1.6  augustss 	usb_uncallout(sc->sc_tmo_pcd, ehci_pcd_enable, sc);
    856        1.6  augustss 
    857        1.1  augustss 	if (sc->sc_powerhook != NULL)
    858        1.1  augustss 		powerhook_disestablish(sc->sc_powerhook);
    859        1.1  augustss 	if (sc->sc_shutdownhook != NULL)
    860        1.1  augustss 		shutdownhook_disestablish(sc->sc_shutdownhook);
    861        1.1  augustss 
    862       1.17  augustss 	usb_delay_ms(&sc->sc_bus, 300); /* XXX let stray task complete */
    863       1.15  augustss 
    864        1.1  augustss 	/* XXX free other data structures XXX */
    865        1.1  augustss 
    866        1.1  augustss 	return (rv);
    867        1.1  augustss }
    868        1.1  augustss 
    869        1.1  augustss 
    870        1.1  augustss int
    871        1.1  augustss ehci_activate(device_ptr_t self, enum devact act)
    872        1.1  augustss {
    873        1.1  augustss 	struct ehci_softc *sc = (struct ehci_softc *)self;
    874        1.1  augustss 	int rv = 0;
    875        1.1  augustss 
    876        1.1  augustss 	switch (act) {
    877        1.1  augustss 	case DVACT_ACTIVATE:
    878        1.1  augustss 		return (EOPNOTSUPP);
    879        1.1  augustss 
    880        1.1  augustss 	case DVACT_DEACTIVATE:
    881        1.1  augustss 		if (sc->sc_child != NULL)
    882        1.1  augustss 			rv = config_deactivate(sc->sc_child);
    883        1.5  augustss 		sc->sc_dying = 1;
    884        1.1  augustss 		break;
    885        1.1  augustss 	}
    886        1.1  augustss 	return (rv);
    887        1.1  augustss }
    888        1.1  augustss 
    889        1.5  augustss /*
    890        1.5  augustss  * Handle suspend/resume.
    891        1.5  augustss  *
    892        1.5  augustss  * We need to switch to polling mode here, because this routine is
    893        1.5  augustss  * called from an intterupt context.  This is all right since we
    894        1.5  augustss  * are almost suspended anyway.
    895        1.5  augustss  */
    896        1.5  augustss void
    897        1.5  augustss ehci_power(int why, void *v)
    898        1.5  augustss {
    899        1.5  augustss 	ehci_softc_t *sc = v;
    900        1.5  augustss 	//u_int32_t ctl;
    901        1.5  augustss 	int s;
    902        1.5  augustss 
    903        1.5  augustss #ifdef EHCI_DEBUG
    904        1.5  augustss 	DPRINTF(("ehci_power: sc=%p, why=%d\n", sc, why));
    905       1.18  augustss 	ehci_dump_regs(sc);
    906        1.5  augustss #endif
    907        1.5  augustss 
    908        1.5  augustss 	s = splhardusb();
    909        1.5  augustss 	switch (why) {
    910        1.5  augustss 	case PWR_SUSPEND:
    911        1.5  augustss 	case PWR_STANDBY:
    912        1.5  augustss 		sc->sc_bus.use_polling++;
    913        1.5  augustss #if 0
    914        1.5  augustss OOO
    915        1.5  augustss 		ctl = OREAD4(sc, EHCI_CONTROL) & ~EHCI_HCFS_MASK;
    916        1.5  augustss 		if (sc->sc_control == 0) {
    917        1.5  augustss 			/*
    918        1.5  augustss 			 * Preserve register values, in case that APM BIOS
    919        1.5  augustss 			 * does not recover them.
    920        1.5  augustss 			 */
    921        1.5  augustss 			sc->sc_control = ctl;
    922        1.5  augustss 			sc->sc_intre = OREAD4(sc, EHCI_INTERRUPT_ENABLE);
    923        1.5  augustss 		}
    924        1.5  augustss 		ctl |= EHCI_HCFS_SUSPEND;
    925        1.5  augustss 		OWRITE4(sc, EHCI_CONTROL, ctl);
    926        1.5  augustss #endif
    927        1.5  augustss 		usb_delay_ms(&sc->sc_bus, USB_RESUME_WAIT);
    928        1.5  augustss 		sc->sc_bus.use_polling--;
    929        1.5  augustss 		break;
    930        1.5  augustss 	case PWR_RESUME:
    931        1.5  augustss 		sc->sc_bus.use_polling++;
    932        1.5  augustss #if 0
    933        1.5  augustss OOO
    934        1.5  augustss 		/* Some broken BIOSes do not recover these values */
    935       1.31  augustss 		OWRITE4(sc, EHCI_HCCA, DMAADDR(&sc->sc_hccadma, 0));
    936        1.5  augustss 		OWRITE4(sc, EHCI_CONTROL_HEAD_ED, sc->sc_ctrl_head->physaddr);
    937        1.5  augustss 		OWRITE4(sc, EHCI_BULK_HEAD_ED, sc->sc_bulk_head->physaddr);
    938        1.5  augustss 		if (sc->sc_intre)
    939        1.5  augustss 			OWRITE4(sc, EHCI_INTERRUPT_ENABLE,
    940        1.5  augustss 				sc->sc_intre & (EHCI_ALL_INTRS | EHCI_MIE));
    941        1.5  augustss 		if (sc->sc_control)
    942        1.5  augustss 			ctl = sc->sc_control;
    943        1.5  augustss 		else
    944        1.5  augustss 			ctl = OREAD4(sc, EHCI_CONTROL);
    945        1.5  augustss 		ctl |= EHCI_HCFS_RESUME;
    946        1.5  augustss 		OWRITE4(sc, EHCI_CONTROL, ctl);
    947        1.5  augustss 		usb_delay_ms(&sc->sc_bus, USB_RESUME_DELAY);
    948        1.5  augustss 		ctl = (ctl & ~EHCI_HCFS_MASK) | EHCI_HCFS_OPERATIONAL;
    949        1.5  augustss 		OWRITE4(sc, EHCI_CONTROL, ctl);
    950        1.5  augustss 		usb_delay_ms(&sc->sc_bus, USB_RESUME_RECOVERY);
    951        1.5  augustss 		sc->sc_control = sc->sc_intre = 0;
    952        1.5  augustss #endif
    953        1.5  augustss 		sc->sc_bus.use_polling--;
    954        1.5  augustss 		break;
    955        1.5  augustss 	case PWR_SOFTSUSPEND:
    956        1.5  augustss 	case PWR_SOFTSTANDBY:
    957        1.5  augustss 	case PWR_SOFTRESUME:
    958        1.5  augustss 		break;
    959        1.5  augustss 	}
    960        1.5  augustss 	splx(s);
    961        1.5  augustss }
    962        1.5  augustss 
    963        1.5  augustss /*
    964        1.5  augustss  * Shut down the controller when the system is going down.
    965        1.5  augustss  */
    966        1.5  augustss void
    967        1.5  augustss ehci_shutdown(void *v)
    968        1.5  augustss {
    969        1.8  augustss 	ehci_softc_t *sc = v;
    970        1.5  augustss 
    971        1.5  augustss 	DPRINTF(("ehci_shutdown: stopping the HC\n"));
    972        1.8  augustss 	EOWRITE4(sc, EHCI_USBCMD, 0);	/* Halt controller */
    973        1.8  augustss 	EOWRITE4(sc, EHCI_USBCMD, EHCI_CMD_HCRESET);
    974        1.5  augustss }
    975        1.5  augustss 
    976        1.5  augustss usbd_status
    977        1.5  augustss ehci_allocm(struct usbd_bus *bus, usb_dma_t *dma, u_int32_t size)
    978        1.5  augustss {
    979        1.5  augustss 	struct ehci_softc *sc = (struct ehci_softc *)bus;
    980       1.25  augustss 	usbd_status err;
    981        1.5  augustss 
    982       1.25  augustss 	err = usb_allocmem(&sc->sc_bus, size, 0, dma);
    983       1.25  augustss #ifdef EHCI_DEBUG
    984       1.25  augustss 	if (err)
    985       1.25  augustss 		printf("ehci_allocm: usb_allocmem()=%d\n", err);
    986       1.25  augustss #endif
    987       1.25  augustss 	return (err);
    988        1.5  augustss }
    989        1.5  augustss 
    990        1.5  augustss void
    991        1.5  augustss ehci_freem(struct usbd_bus *bus, usb_dma_t *dma)
    992        1.5  augustss {
    993        1.5  augustss 	struct ehci_softc *sc = (struct ehci_softc *)bus;
    994        1.5  augustss 
    995        1.5  augustss 	usb_freemem(&sc->sc_bus, dma);
    996        1.5  augustss }
    997        1.5  augustss 
    998        1.5  augustss usbd_xfer_handle
    999        1.5  augustss ehci_allocx(struct usbd_bus *bus)
   1000        1.5  augustss {
   1001        1.5  augustss 	struct ehci_softc *sc = (struct ehci_softc *)bus;
   1002        1.5  augustss 	usbd_xfer_handle xfer;
   1003        1.5  augustss 
   1004        1.5  augustss 	xfer = SIMPLEQ_FIRST(&sc->sc_free_xfers);
   1005       1.28  augustss 	if (xfer != NULL) {
   1006       1.32     lukem 		SIMPLEQ_REMOVE_HEAD(&sc->sc_free_xfers, next);
   1007       1.28  augustss #ifdef DIAGNOSTIC
   1008       1.28  augustss 		if (xfer->busy_free != XFER_FREE) {
   1009       1.28  augustss 			printf("uhci_allocx: xfer=%p not free, 0x%08x\n", xfer,
   1010       1.28  augustss 			       xfer->busy_free);
   1011       1.28  augustss 		}
   1012       1.28  augustss #endif
   1013       1.28  augustss 	} else {
   1014       1.15  augustss 		xfer = malloc(sizeof(struct ehci_xfer), M_USB, M_NOWAIT);
   1015       1.28  augustss 	}
   1016       1.18  augustss 	if (xfer != NULL) {
   1017       1.15  augustss 		memset(xfer, 0, sizeof (struct ehci_xfer));
   1018       1.18  augustss #ifdef DIAGNOSTIC
   1019       1.18  augustss 		EXFER(xfer)->isdone = 1;
   1020       1.18  augustss 		xfer->busy_free = XFER_BUSY;
   1021       1.18  augustss #endif
   1022       1.18  augustss 	}
   1023        1.5  augustss 	return (xfer);
   1024        1.5  augustss }
   1025        1.5  augustss 
   1026        1.5  augustss void
   1027        1.5  augustss ehci_freex(struct usbd_bus *bus, usbd_xfer_handle xfer)
   1028        1.5  augustss {
   1029        1.5  augustss 	struct ehci_softc *sc = (struct ehci_softc *)bus;
   1030        1.5  augustss 
   1031       1.18  augustss #ifdef DIAGNOSTIC
   1032       1.18  augustss 	if (xfer->busy_free != XFER_BUSY) {
   1033       1.18  augustss 		printf("ehci_freex: xfer=%p not busy, 0x%08x\n", xfer,
   1034       1.18  augustss 		       xfer->busy_free);
   1035       1.18  augustss 		return;
   1036       1.18  augustss 	}
   1037       1.18  augustss 	xfer->busy_free = XFER_FREE;
   1038       1.18  augustss 	if (!EXFER(xfer)->isdone) {
   1039       1.18  augustss 		printf("ehci_freex: !isdone\n");
   1040       1.18  augustss 		return;
   1041       1.18  augustss 	}
   1042       1.18  augustss #endif
   1043        1.5  augustss 	SIMPLEQ_INSERT_HEAD(&sc->sc_free_xfers, xfer, next);
   1044        1.5  augustss }
   1045        1.5  augustss 
   1046        1.5  augustss Static void
   1047        1.5  augustss ehci_device_clear_toggle(usbd_pipe_handle pipe)
   1048        1.5  augustss {
   1049       1.15  augustss 	struct ehci_pipe *epipe = (struct ehci_pipe *)pipe;
   1050       1.15  augustss 
   1051       1.23  augustss 	DPRINTF(("ehci_device_clear_toggle: epipe=%p status=0x%x\n",
   1052       1.23  augustss 		 epipe, epipe->sqh->qh.qh_qtd.qtd_status));
   1053       1.22  augustss #ifdef USB_DEBUG
   1054       1.22  augustss 	if (ehcidebug)
   1055       1.22  augustss 		usbd_dump_pipe(pipe);
   1056        1.5  augustss #endif
   1057   1.54.2.1      tron 	epipe->nexttoggle = 0;
   1058        1.5  augustss }
   1059        1.5  augustss 
   1060        1.5  augustss Static void
   1061        1.5  augustss ehci_noop(usbd_pipe_handle pipe)
   1062        1.5  augustss {
   1063        1.5  augustss }
   1064        1.5  augustss 
   1065        1.5  augustss #ifdef EHCI_DEBUG
   1066        1.5  augustss void
   1067       1.18  augustss ehci_dump_regs(ehci_softc_t *sc)
   1068        1.5  augustss {
   1069        1.6  augustss 	int i;
   1070        1.6  augustss 	printf("cmd=0x%08x, sts=0x%08x, ien=0x%08x\n",
   1071        1.6  augustss 	       EOREAD4(sc, EHCI_USBCMD),
   1072        1.6  augustss 	       EOREAD4(sc, EHCI_USBSTS),
   1073        1.6  augustss 	       EOREAD4(sc, EHCI_USBINTR));
   1074       1.29  augustss 	printf("frindex=0x%08x ctrdsegm=0x%08x periodic=0x%08x async=0x%08x\n",
   1075       1.15  augustss 	       EOREAD4(sc, EHCI_FRINDEX),
   1076       1.15  augustss 	       EOREAD4(sc, EHCI_CTRLDSSEGMENT),
   1077       1.15  augustss 	       EOREAD4(sc, EHCI_PERIODICLISTBASE),
   1078       1.15  augustss 	       EOREAD4(sc, EHCI_ASYNCLISTADDR));
   1079        1.6  augustss 	for (i = 1; i <= sc->sc_noport; i++)
   1080       1.33  augustss 		printf("port %d status=0x%08x\n", i,
   1081        1.6  augustss 		       EOREAD4(sc, EHCI_PORTSC(i)));
   1082       1.39    martin }
   1083       1.39    martin 
   1084       1.40    martin /*
   1085       1.40    martin  * Unused function - this is meant to be called from a kernel
   1086       1.40    martin  * debugger.
   1087       1.40    martin  */
   1088       1.39    martin void
   1089       1.39    martin ehci_dump()
   1090       1.39    martin {
   1091       1.39    martin 	ehci_dump_regs(theehci);
   1092        1.6  augustss }
   1093        1.6  augustss 
   1094        1.6  augustss void
   1095       1.15  augustss ehci_dump_link(ehci_link_t link, int type)
   1096        1.9  augustss {
   1097       1.15  augustss 	link = le32toh(link);
   1098       1.15  augustss 	printf("0x%08x", link);
   1099        1.9  augustss 	if (link & EHCI_LINK_TERMINATE)
   1100       1.15  augustss 		printf("<T>");
   1101       1.15  augustss 	else {
   1102       1.15  augustss 		printf("<");
   1103       1.15  augustss 		if (type) {
   1104       1.15  augustss 			switch (EHCI_LINK_TYPE(link)) {
   1105       1.15  augustss 			case EHCI_LINK_ITD: printf("ITD"); break;
   1106       1.15  augustss 			case EHCI_LINK_QH: printf("QH"); break;
   1107       1.15  augustss 			case EHCI_LINK_SITD: printf("SITD"); break;
   1108       1.15  augustss 			case EHCI_LINK_FSTN: printf("FSTN"); break;
   1109       1.16  augustss 			}
   1110       1.15  augustss 		}
   1111        1.9  augustss 		printf(">");
   1112       1.15  augustss 	}
   1113       1.15  augustss }
   1114       1.15  augustss 
   1115       1.15  augustss void
   1116       1.15  augustss ehci_dump_sqtds(ehci_soft_qtd_t *sqtd)
   1117       1.15  augustss {
   1118       1.29  augustss 	int i;
   1119       1.29  augustss 	u_int32_t stop;
   1120       1.29  augustss 
   1121       1.29  augustss 	stop = 0;
   1122       1.29  augustss 	for (i = 0; sqtd && i < 20 && !stop; sqtd = sqtd->nextqtd, i++) {
   1123       1.15  augustss 		ehci_dump_sqtd(sqtd);
   1124       1.29  augustss 		stop = sqtd->qtd.qtd_next & EHCI_LINK_TERMINATE;
   1125       1.29  augustss 	}
   1126       1.29  augustss 	if (sqtd)
   1127       1.29  augustss 		printf("dump aborted, too many TDs\n");
   1128        1.9  augustss }
   1129        1.9  augustss 
   1130        1.9  augustss void
   1131        1.9  augustss ehci_dump_sqtd(ehci_soft_qtd_t *sqtd)
   1132        1.9  augustss {
   1133        1.9  augustss 	printf("QTD(%p) at 0x%08x:\n", sqtd, sqtd->physaddr);
   1134        1.9  augustss 	ehci_dump_qtd(&sqtd->qtd);
   1135        1.9  augustss }
   1136        1.9  augustss 
   1137        1.9  augustss void
   1138        1.9  augustss ehci_dump_qtd(ehci_qtd_t *qtd)
   1139        1.9  augustss {
   1140        1.9  augustss 	u_int32_t s;
   1141       1.15  augustss 	char sbuf[128];
   1142        1.9  augustss 
   1143       1.15  augustss 	printf("  next="); ehci_dump_link(qtd->qtd_next, 0);
   1144       1.15  augustss 	printf(" altnext="); ehci_dump_link(qtd->qtd_altnext, 0);
   1145        1.9  augustss 	printf("\n");
   1146       1.15  augustss 	s = le32toh(qtd->qtd_status);
   1147       1.15  augustss 	bitmask_snprintf(EHCI_QTD_GET_STATUS(s),
   1148       1.15  augustss 			 "\20\10ACTIVE\7HALTED\6BUFERR\5BABBLE\4XACTERR"
   1149       1.15  augustss 			 "\3MISSED\2SPLIT\1PING", sbuf, sizeof(sbuf));
   1150        1.9  augustss 	printf("  status=0x%08x: toggle=%d bytes=0x%x ioc=%d c_page=0x%x\n",
   1151        1.9  augustss 	       s, EHCI_QTD_GET_TOGGLE(s), EHCI_QTD_GET_BYTES(s),
   1152        1.9  augustss 	       EHCI_QTD_GET_IOC(s), EHCI_QTD_GET_C_PAGE(s));
   1153       1.15  augustss 	printf("    cerr=%d pid=%d stat=0x%s\n", EHCI_QTD_GET_CERR(s),
   1154       1.15  augustss 	       EHCI_QTD_GET_PID(s), sbuf);
   1155        1.9  augustss 	for (s = 0; s < 5; s++)
   1156       1.15  augustss 		printf("  buffer[%d]=0x%08x\n", s, le32toh(qtd->qtd_buffer[s]));
   1157        1.9  augustss }
   1158        1.9  augustss 
   1159        1.9  augustss void
   1160        1.9  augustss ehci_dump_sqh(ehci_soft_qh_t *sqh)
   1161        1.9  augustss {
   1162        1.9  augustss 	ehci_qh_t *qh = &sqh->qh;
   1163       1.15  augustss 	u_int32_t endp, endphub;
   1164        1.9  augustss 
   1165        1.9  augustss 	printf("QH(%p) at 0x%08x:\n", sqh, sqh->physaddr);
   1166       1.15  augustss 	printf("  link="); ehci_dump_link(qh->qh_link, 1); printf("\n");
   1167       1.15  augustss 	endp = le32toh(qh->qh_endp);
   1168       1.15  augustss 	printf("  endp=0x%08x\n", endp);
   1169       1.15  augustss 	printf("    addr=0x%02x inact=%d endpt=%d eps=%d dtc=%d hrecl=%d\n",
   1170       1.15  augustss 	       EHCI_QH_GET_ADDR(endp), EHCI_QH_GET_INACT(endp),
   1171       1.15  augustss 	       EHCI_QH_GET_ENDPT(endp),  EHCI_QH_GET_EPS(endp),
   1172       1.15  augustss 	       EHCI_QH_GET_DTC(endp), EHCI_QH_GET_HRECL(endp));
   1173       1.15  augustss 	printf("    mpl=0x%x ctl=%d nrl=%d\n",
   1174       1.15  augustss 	       EHCI_QH_GET_MPL(endp), EHCI_QH_GET_CTL(endp),
   1175       1.15  augustss 	       EHCI_QH_GET_NRL(endp));
   1176       1.15  augustss 	endphub = le32toh(qh->qh_endphub);
   1177       1.15  augustss 	printf("  endphub=0x%08x\n", endphub);
   1178       1.15  augustss 	printf("    smask=0x%02x cmask=0x%02x huba=0x%02x port=%d mult=%d\n",
   1179       1.15  augustss 	       EHCI_QH_GET_SMASK(endphub), EHCI_QH_GET_CMASK(endphub),
   1180       1.15  augustss 	       EHCI_QH_GET_HUBA(endphub), EHCI_QH_GET_PORT(endphub),
   1181       1.15  augustss 	       EHCI_QH_GET_MULT(endphub));
   1182       1.15  augustss 	printf("  curqtd="); ehci_dump_link(qh->qh_curqtd, 0); printf("\n");
   1183       1.12  augustss 	printf("Overlay qTD:\n");
   1184        1.9  augustss 	ehci_dump_qtd(&qh->qh_qtd);
   1185        1.9  augustss }
   1186        1.9  augustss 
   1187       1.38    martin #ifdef DIAGNOSTIC
   1188       1.18  augustss Static void
   1189       1.18  augustss ehci_dump_exfer(struct ehci_xfer *ex)
   1190       1.18  augustss {
   1191       1.18  augustss 	printf("ehci_dump_exfer: ex=%p\n", ex);
   1192       1.18  augustss }
   1193       1.38    martin #endif
   1194        1.5  augustss #endif
   1195        1.5  augustss 
   1196        1.5  augustss usbd_status
   1197        1.5  augustss ehci_open(usbd_pipe_handle pipe)
   1198        1.5  augustss {
   1199        1.5  augustss 	usbd_device_handle dev = pipe->device;
   1200        1.5  augustss 	ehci_softc_t *sc = (ehci_softc_t *)dev->bus;
   1201        1.5  augustss 	usb_endpoint_descriptor_t *ed = pipe->endpoint->edesc;
   1202        1.5  augustss 	u_int8_t addr = dev->address;
   1203        1.5  augustss 	u_int8_t xfertype = ed->bmAttributes & UE_XFERTYPE;
   1204        1.5  augustss 	struct ehci_pipe *epipe = (struct ehci_pipe *)pipe;
   1205       1.10  augustss 	ehci_soft_qh_t *sqh;
   1206       1.10  augustss 	usbd_status err;
   1207       1.10  augustss 	int s;
   1208       1.10  augustss 	int speed, naks;
   1209        1.5  augustss 
   1210        1.5  augustss 	DPRINTFN(1, ("ehci_open: pipe=%p, addr=%d, endpt=%d (%d)\n",
   1211        1.5  augustss 		     pipe, addr, ed->bEndpointAddress, sc->sc_addr));
   1212        1.5  augustss 
   1213       1.17  augustss 	if (sc->sc_dying)
   1214       1.17  augustss 		return (USBD_IOERROR);
   1215       1.17  augustss 
   1216   1.54.2.1      tron 	epipe->nexttoggle = 0;
   1217   1.54.2.1      tron 
   1218        1.5  augustss 	if (addr == sc->sc_addr) {
   1219        1.5  augustss 		switch (ed->bEndpointAddress) {
   1220        1.5  augustss 		case USB_CONTROL_ENDPOINT:
   1221        1.5  augustss 			pipe->methods = &ehci_root_ctrl_methods;
   1222        1.5  augustss 			break;
   1223        1.5  augustss 		case UE_DIR_IN | EHCI_INTR_ENDPT:
   1224        1.5  augustss 			pipe->methods = &ehci_root_intr_methods;
   1225        1.5  augustss 			break;
   1226        1.5  augustss 		default:
   1227        1.5  augustss 			return (USBD_INVAL);
   1228        1.5  augustss 		}
   1229       1.10  augustss 		return (USBD_NORMAL_COMPLETION);
   1230       1.10  augustss 	}
   1231       1.10  augustss 
   1232       1.24  augustss 	/* XXX All this stuff is only valid for async. */
   1233       1.11  augustss 	switch (dev->speed) {
   1234       1.11  augustss 	case USB_SPEED_LOW:  speed = EHCI_QH_SPEED_LOW;  break;
   1235       1.11  augustss 	case USB_SPEED_FULL: speed = EHCI_QH_SPEED_FULL; break;
   1236       1.11  augustss 	case USB_SPEED_HIGH: speed = EHCI_QH_SPEED_HIGH; break;
   1237       1.37    provos 	default: panic("ehci_open: bad device speed %d", dev->speed);
   1238       1.11  augustss 	}
   1239       1.10  augustss 	naks = 8;		/* XXX */
   1240       1.10  augustss 	sqh = ehci_alloc_sqh(sc);
   1241       1.10  augustss 	if (sqh == NULL)
   1242       1.10  augustss 		goto bad0;
   1243       1.10  augustss 	/* qh_link filled when the QH is added */
   1244       1.10  augustss 	sqh->qh.qh_endp = htole32(
   1245       1.10  augustss 		EHCI_QH_SET_ADDR(addr) |
   1246   1.54.2.2      tron 		EHCI_QH_SET_ENDPT(UE_GET_ADDR(ed->bEndpointAddress)) |
   1247   1.54.2.1      tron 		EHCI_QH_SET_EPS(speed) |
   1248   1.54.2.1      tron 		EHCI_QH_DTC |
   1249       1.10  augustss 		EHCI_QH_SET_MPL(UGETW(ed->wMaxPacketSize)) |
   1250       1.10  augustss 		(speed != EHCI_QH_SPEED_HIGH && xfertype == UE_CONTROL ?
   1251       1.10  augustss 		 EHCI_QH_CTL : 0) |
   1252       1.10  augustss 		EHCI_QH_SET_NRL(naks)
   1253       1.10  augustss 		);
   1254       1.10  augustss 	sqh->qh.qh_endphub = htole32(
   1255       1.10  augustss 		EHCI_QH_SET_MULT(1)
   1256       1.11  augustss 		/* XXX TT stuff */
   1257       1.11  augustss 		/* XXX interrupt mask */
   1258       1.10  augustss 		);
   1259       1.11  augustss 	sqh->qh.qh_curqtd = EHCI_NULL;
   1260       1.11  augustss 	/* Fill the overlay qTD */
   1261       1.11  augustss 	sqh->qh.qh_qtd.qtd_next = EHCI_NULL;
   1262       1.11  augustss 	sqh->qh.qh_qtd.qtd_altnext = EHCI_NULL;
   1263       1.15  augustss 	sqh->qh.qh_qtd.qtd_status = htole32(0);
   1264       1.10  augustss 
   1265       1.10  augustss 	epipe->sqh = sqh;
   1266        1.5  augustss 
   1267       1.10  augustss 	switch (xfertype) {
   1268       1.10  augustss 	case UE_CONTROL:
   1269       1.33  augustss 		err = usb_allocmem(&sc->sc_bus, sizeof(usb_device_request_t),
   1270       1.10  augustss 				   0, &epipe->u.ctl.reqdma);
   1271       1.25  augustss #ifdef EHCI_DEBUG
   1272       1.25  augustss 		if (err)
   1273       1.25  augustss 			printf("ehci_open: usb_allocmem()=%d\n", err);
   1274       1.25  augustss #endif
   1275       1.10  augustss 		if (err)
   1276       1.11  augustss 			goto bad1;
   1277       1.11  augustss 		pipe->methods = &ehci_device_ctrl_methods;
   1278       1.10  augustss 		s = splusb();
   1279       1.11  augustss 		ehci_add_qh(sqh, sc->sc_async_head);
   1280       1.10  augustss 		splx(s);
   1281       1.10  augustss 		break;
   1282       1.10  augustss 	case UE_BULK:
   1283       1.10  augustss 		pipe->methods = &ehci_device_bulk_methods;
   1284       1.10  augustss 		s = splusb();
   1285       1.11  augustss 		ehci_add_qh(sqh, sc->sc_async_head);
   1286       1.10  augustss 		splx(s);
   1287       1.10  augustss 		break;
   1288       1.24  augustss 	case UE_INTERRUPT:
   1289       1.24  augustss 		pipe->methods = &ehci_device_intr_methods;
   1290       1.24  augustss 		return (USBD_INVAL);
   1291       1.24  augustss 	case UE_ISOCHRONOUS:
   1292       1.24  augustss 		pipe->methods = &ehci_device_isoc_methods;
   1293       1.24  augustss 		return (USBD_INVAL);
   1294       1.10  augustss 	default:
   1295       1.10  augustss 		return (USBD_INVAL);
   1296        1.5  augustss 	}
   1297        1.5  augustss 	return (USBD_NORMAL_COMPLETION);
   1298        1.5  augustss 
   1299       1.11  augustss  bad1:
   1300       1.11  augustss 	ehci_free_sqh(sc, sqh);
   1301        1.5  augustss  bad0:
   1302        1.5  augustss 	return (USBD_NOMEM);
   1303       1.10  augustss }
   1304       1.10  augustss 
   1305       1.10  augustss /*
   1306       1.10  augustss  * Add an ED to the schedule.  Called at splusb().
   1307       1.10  augustss  */
   1308       1.10  augustss void
   1309       1.10  augustss ehci_add_qh(ehci_soft_qh_t *sqh, ehci_soft_qh_t *head)
   1310       1.10  augustss {
   1311       1.10  augustss 	SPLUSBCHECK;
   1312       1.10  augustss 
   1313       1.10  augustss 	sqh->next = head->next;
   1314       1.10  augustss 	sqh->qh.qh_link = head->qh.qh_link;
   1315       1.10  augustss 	head->next = sqh;
   1316       1.15  augustss 	head->qh.qh_link = htole32(sqh->physaddr | EHCI_LINK_QH);
   1317       1.10  augustss 
   1318       1.10  augustss #ifdef EHCI_DEBUG
   1319       1.22  augustss 	if (ehcidebug > 5) {
   1320       1.10  augustss 		printf("ehci_add_qh:\n");
   1321       1.10  augustss 		ehci_dump_sqh(sqh);
   1322       1.10  augustss 	}
   1323        1.5  augustss #endif
   1324        1.5  augustss }
   1325        1.5  augustss 
   1326       1.10  augustss /*
   1327       1.10  augustss  * Remove an ED from the schedule.  Called at splusb().
   1328       1.10  augustss  */
   1329       1.10  augustss void
   1330       1.10  augustss ehci_rem_qh(ehci_softc_t *sc, ehci_soft_qh_t *sqh, ehci_soft_qh_t *head)
   1331       1.10  augustss {
   1332       1.33  augustss 	ehci_soft_qh_t *p;
   1333       1.10  augustss 
   1334       1.10  augustss 	SPLUSBCHECK;
   1335       1.10  augustss 	/* XXX */
   1336       1.42  augustss 	for (p = head; p != NULL && p->next != sqh; p = p->next)
   1337       1.10  augustss 		;
   1338       1.10  augustss 	if (p == NULL)
   1339       1.37    provos 		panic("ehci_rem_qh: ED not found");
   1340       1.10  augustss 	p->next = sqh->next;
   1341       1.10  augustss 	p->qh.qh_link = sqh->qh.qh_link;
   1342       1.10  augustss 
   1343       1.11  augustss 	ehci_sync_hc(sc);
   1344       1.11  augustss }
   1345       1.11  augustss 
   1346       1.23  augustss void
   1347       1.23  augustss ehci_set_qh_qtd(ehci_soft_qh_t *sqh, ehci_soft_qtd_t *sqtd)
   1348       1.23  augustss {
   1349       1.23  augustss 	/* Halt while we are messing. */
   1350       1.23  augustss 	sqh->qh.qh_qtd.qtd_status |= htole32(EHCI_QTD_HALTED);
   1351       1.23  augustss 	sqh->qh.qh_curqtd = 0;
   1352       1.23  augustss 	sqh->qh.qh_qtd.qtd_next = htole32(sqtd->physaddr);
   1353       1.23  augustss 	sqh->sqtd = sqtd;
   1354  1.54.2.10      tron 	/* Clear halt */
   1355  1.54.2.10      tron 	sqh->qh.qh_qtd.qtd_status &= htole32(~EHCI_QTD_HALTED);
   1356       1.23  augustss }
   1357       1.23  augustss 
   1358       1.11  augustss /*
   1359       1.11  augustss  * Ensure that the HC has released all references to the QH.  We do this
   1360       1.11  augustss  * by asking for a Async Advance Doorbell interrupt and then we wait for
   1361       1.11  augustss  * the interrupt.
   1362       1.11  augustss  * To make this easier we first obtain exclusive use of the doorbell.
   1363       1.11  augustss  */
   1364       1.11  augustss void
   1365       1.11  augustss ehci_sync_hc(ehci_softc_t *sc)
   1366       1.11  augustss {
   1367       1.15  augustss 	int s, error;
   1368       1.11  augustss 
   1369       1.12  augustss 	if (sc->sc_dying) {
   1370       1.12  augustss 		DPRINTFN(2,("ehci_sync_hc: dying\n"));
   1371       1.12  augustss 		return;
   1372       1.12  augustss 	}
   1373       1.12  augustss 	DPRINTFN(2,("ehci_sync_hc: enter\n"));
   1374       1.10  augustss 	lockmgr(&sc->sc_doorbell_lock, LK_EXCLUSIVE, NULL); /* get doorbell */
   1375       1.10  augustss 	s = splhardusb();
   1376       1.10  augustss 	/* ask for doorbell */
   1377       1.10  augustss 	EOWRITE4(sc, EHCI_USBCMD, EOREAD4(sc, EHCI_USBCMD) | EHCI_CMD_IAAD);
   1378       1.15  augustss 	DPRINTFN(1,("ehci_sync_hc: cmd=0x%08x sts=0x%08x\n",
   1379       1.15  augustss 		    EOREAD4(sc, EHCI_USBCMD), EOREAD4(sc, EHCI_USBSTS)));
   1380       1.15  augustss 	error = tsleep(&sc->sc_async_head, PZERO, "ehcidi", hz); /* bell wait */
   1381       1.15  augustss 	DPRINTFN(1,("ehci_sync_hc: cmd=0x%08x sts=0x%08x\n",
   1382       1.15  augustss 		    EOREAD4(sc, EHCI_USBCMD), EOREAD4(sc, EHCI_USBSTS)));
   1383       1.10  augustss 	splx(s);
   1384       1.10  augustss 	lockmgr(&sc->sc_doorbell_lock, LK_RELEASE, NULL); /* release doorbell */
   1385       1.15  augustss #ifdef DIAGNOSTIC
   1386       1.15  augustss 	if (error)
   1387       1.15  augustss 		printf("ehci_sync_hc: tsleep() = %d\n", error);
   1388       1.15  augustss #endif
   1389       1.12  augustss 	DPRINTFN(2,("ehci_sync_hc: exit\n"));
   1390       1.10  augustss }
   1391       1.10  augustss 
   1392        1.5  augustss /***********/
   1393        1.5  augustss 
   1394        1.5  augustss /*
   1395        1.5  augustss  * Data structures and routines to emulate the root hub.
   1396        1.5  augustss  */
   1397        1.5  augustss Static usb_device_descriptor_t ehci_devd = {
   1398        1.5  augustss 	USB_DEVICE_DESCRIPTOR_SIZE,
   1399        1.5  augustss 	UDESC_DEVICE,		/* type */
   1400        1.5  augustss 	{0x00, 0x02},		/* USB version */
   1401        1.5  augustss 	UDCLASS_HUB,		/* class */
   1402        1.5  augustss 	UDSUBCLASS_HUB,		/* subclass */
   1403       1.11  augustss 	UDPROTO_HSHUBSTT,	/* protocol */
   1404        1.5  augustss 	64,			/* max packet */
   1405        1.5  augustss 	{0},{0},{0x00,0x01},	/* device id */
   1406        1.5  augustss 	1,2,0,			/* string indicies */
   1407        1.5  augustss 	1			/* # of configurations */
   1408        1.5  augustss };
   1409        1.5  augustss 
   1410       1.11  augustss Static usb_device_qualifier_t ehci_odevd = {
   1411       1.11  augustss 	USB_DEVICE_DESCRIPTOR_SIZE,
   1412       1.11  augustss 	UDESC_DEVICE_QUALIFIER,	/* type */
   1413       1.11  augustss 	{0x00, 0x02},		/* USB version */
   1414       1.11  augustss 	UDCLASS_HUB,		/* class */
   1415       1.11  augustss 	UDSUBCLASS_HUB,		/* subclass */
   1416       1.11  augustss 	UDPROTO_FSHUB,		/* protocol */
   1417       1.11  augustss 	64,			/* max packet */
   1418       1.11  augustss 	1,			/* # of configurations */
   1419       1.11  augustss 	0
   1420       1.11  augustss };
   1421       1.11  augustss 
   1422        1.5  augustss Static usb_config_descriptor_t ehci_confd = {
   1423        1.5  augustss 	USB_CONFIG_DESCRIPTOR_SIZE,
   1424        1.5  augustss 	UDESC_CONFIG,
   1425        1.5  augustss 	{USB_CONFIG_DESCRIPTOR_SIZE +
   1426        1.5  augustss 	 USB_INTERFACE_DESCRIPTOR_SIZE +
   1427        1.5  augustss 	 USB_ENDPOINT_DESCRIPTOR_SIZE},
   1428        1.5  augustss 	1,
   1429        1.5  augustss 	1,
   1430        1.5  augustss 	0,
   1431        1.5  augustss 	UC_SELF_POWERED,
   1432        1.5  augustss 	0			/* max power */
   1433        1.5  augustss };
   1434        1.5  augustss 
   1435        1.5  augustss Static usb_interface_descriptor_t ehci_ifcd = {
   1436        1.5  augustss 	USB_INTERFACE_DESCRIPTOR_SIZE,
   1437        1.5  augustss 	UDESC_INTERFACE,
   1438        1.5  augustss 	0,
   1439        1.5  augustss 	0,
   1440        1.5  augustss 	1,
   1441        1.5  augustss 	UICLASS_HUB,
   1442        1.5  augustss 	UISUBCLASS_HUB,
   1443       1.11  augustss 	UIPROTO_HSHUBSTT,
   1444        1.5  augustss 	0
   1445        1.5  augustss };
   1446        1.5  augustss 
   1447        1.5  augustss Static usb_endpoint_descriptor_t ehci_endpd = {
   1448        1.5  augustss 	USB_ENDPOINT_DESCRIPTOR_SIZE,
   1449        1.5  augustss 	UDESC_ENDPOINT,
   1450        1.5  augustss 	UE_DIR_IN | EHCI_INTR_ENDPT,
   1451        1.5  augustss 	UE_INTERRUPT,
   1452        1.5  augustss 	{8, 0},			/* max packet */
   1453        1.5  augustss 	255
   1454        1.5  augustss };
   1455        1.5  augustss 
   1456        1.5  augustss Static usb_hub_descriptor_t ehci_hubd = {
   1457        1.5  augustss 	USB_HUB_DESCRIPTOR_SIZE,
   1458        1.5  augustss 	UDESC_HUB,
   1459        1.5  augustss 	0,
   1460        1.5  augustss 	{0,0},
   1461        1.5  augustss 	0,
   1462        1.5  augustss 	0,
   1463        1.5  augustss 	{0},
   1464        1.5  augustss };
   1465        1.5  augustss 
   1466        1.5  augustss Static int
   1467        1.5  augustss ehci_str(p, l, s)
   1468        1.5  augustss 	usb_string_descriptor_t *p;
   1469        1.5  augustss 	int l;
   1470        1.5  augustss 	char *s;
   1471        1.5  augustss {
   1472        1.5  augustss 	int i;
   1473        1.5  augustss 
   1474        1.5  augustss 	if (l == 0)
   1475        1.5  augustss 		return (0);
   1476        1.5  augustss 	p->bLength = 2 * strlen(s) + 2;
   1477        1.5  augustss 	if (l == 1)
   1478        1.5  augustss 		return (1);
   1479        1.5  augustss 	p->bDescriptorType = UDESC_STRING;
   1480        1.5  augustss 	l -= 2;
   1481        1.5  augustss 	for (i = 0; s[i] && l > 1; i++, l -= 2)
   1482        1.5  augustss 		USETW2(p->bString[i], 0, s[i]);
   1483        1.5  augustss 	return (2*i+2);
   1484        1.5  augustss }
   1485        1.5  augustss 
   1486        1.5  augustss /*
   1487        1.5  augustss  * Simulate a hardware hub by handling all the necessary requests.
   1488        1.5  augustss  */
   1489        1.5  augustss Static usbd_status
   1490        1.5  augustss ehci_root_ctrl_transfer(usbd_xfer_handle xfer)
   1491        1.5  augustss {
   1492        1.5  augustss 	usbd_status err;
   1493        1.5  augustss 
   1494        1.5  augustss 	/* Insert last in queue. */
   1495        1.5  augustss 	err = usb_insert_transfer(xfer);
   1496        1.5  augustss 	if (err)
   1497        1.5  augustss 		return (err);
   1498        1.5  augustss 
   1499        1.5  augustss 	/* Pipe isn't running, start first */
   1500        1.5  augustss 	return (ehci_root_ctrl_start(SIMPLEQ_FIRST(&xfer->pipe->queue)));
   1501        1.5  augustss }
   1502        1.5  augustss 
   1503        1.5  augustss Static usbd_status
   1504        1.5  augustss ehci_root_ctrl_start(usbd_xfer_handle xfer)
   1505        1.5  augustss {
   1506        1.5  augustss 	ehci_softc_t *sc = (ehci_softc_t *)xfer->pipe->device->bus;
   1507        1.5  augustss 	usb_device_request_t *req;
   1508        1.5  augustss 	void *buf = NULL;
   1509        1.5  augustss 	int port, i;
   1510        1.5  augustss 	int s, len, value, index, l, totlen = 0;
   1511        1.5  augustss 	usb_port_status_t ps;
   1512        1.5  augustss 	usb_hub_descriptor_t hubd;
   1513        1.5  augustss 	usbd_status err;
   1514        1.5  augustss 	u_int32_t v;
   1515        1.5  augustss 
   1516        1.5  augustss 	if (sc->sc_dying)
   1517        1.5  augustss 		return (USBD_IOERROR);
   1518        1.5  augustss 
   1519        1.5  augustss #ifdef DIAGNOSTIC
   1520        1.5  augustss 	if (!(xfer->rqflags & URQ_REQUEST))
   1521        1.5  augustss 		/* XXX panic */
   1522        1.5  augustss 		return (USBD_INVAL);
   1523        1.5  augustss #endif
   1524        1.5  augustss 	req = &xfer->request;
   1525        1.5  augustss 
   1526       1.33  augustss 	DPRINTFN(4,("ehci_root_ctrl_control type=0x%02x request=%02x\n",
   1527        1.5  augustss 		    req->bmRequestType, req->bRequest));
   1528        1.5  augustss 
   1529        1.5  augustss 	len = UGETW(req->wLength);
   1530        1.5  augustss 	value = UGETW(req->wValue);
   1531        1.5  augustss 	index = UGETW(req->wIndex);
   1532        1.5  augustss 
   1533        1.5  augustss 	if (len != 0)
   1534       1.30  augustss 		buf = KERNADDR(&xfer->dmabuf, 0);
   1535        1.5  augustss 
   1536        1.5  augustss #define C(x,y) ((x) | ((y) << 8))
   1537        1.5  augustss 	switch(C(req->bRequest, req->bmRequestType)) {
   1538        1.5  augustss 	case C(UR_CLEAR_FEATURE, UT_WRITE_DEVICE):
   1539        1.5  augustss 	case C(UR_CLEAR_FEATURE, UT_WRITE_INTERFACE):
   1540        1.5  augustss 	case C(UR_CLEAR_FEATURE, UT_WRITE_ENDPOINT):
   1541       1.33  augustss 		/*
   1542        1.5  augustss 		 * DEVICE_REMOTE_WAKEUP and ENDPOINT_HALT are no-ops
   1543        1.5  augustss 		 * for the integrated root hub.
   1544        1.5  augustss 		 */
   1545        1.5  augustss 		break;
   1546        1.5  augustss 	case C(UR_GET_CONFIG, UT_READ_DEVICE):
   1547        1.5  augustss 		if (len > 0) {
   1548        1.5  augustss 			*(u_int8_t *)buf = sc->sc_conf;
   1549        1.5  augustss 			totlen = 1;
   1550        1.5  augustss 		}
   1551        1.5  augustss 		break;
   1552        1.5  augustss 	case C(UR_GET_DESCRIPTOR, UT_READ_DEVICE):
   1553        1.5  augustss 		DPRINTFN(8,("ehci_root_ctrl_control wValue=0x%04x\n", value));
   1554        1.5  augustss 		switch(value >> 8) {
   1555        1.5  augustss 		case UDESC_DEVICE:
   1556        1.5  augustss 			if ((value & 0xff) != 0) {
   1557        1.5  augustss 				err = USBD_IOERROR;
   1558        1.5  augustss 				goto ret;
   1559        1.5  augustss 			}
   1560        1.5  augustss 			totlen = l = min(len, USB_DEVICE_DESCRIPTOR_SIZE);
   1561        1.5  augustss 			USETW(ehci_devd.idVendor, sc->sc_id_vendor);
   1562        1.5  augustss 			memcpy(buf, &ehci_devd, l);
   1563        1.5  augustss 			break;
   1564       1.33  augustss 		/*
   1565       1.11  augustss 		 * We can't really operate at another speed, but the spec says
   1566       1.11  augustss 		 * we need this descriptor.
   1567       1.11  augustss 		 */
   1568       1.11  augustss 		case UDESC_DEVICE_QUALIFIER:
   1569       1.11  augustss 			if ((value & 0xff) != 0) {
   1570       1.11  augustss 				err = USBD_IOERROR;
   1571       1.11  augustss 				goto ret;
   1572       1.11  augustss 			}
   1573       1.11  augustss 			totlen = l = min(len, USB_DEVICE_DESCRIPTOR_SIZE);
   1574       1.11  augustss 			memcpy(buf, &ehci_odevd, l);
   1575       1.11  augustss 			break;
   1576       1.33  augustss 		/*
   1577       1.11  augustss 		 * We can't really operate at another speed, but the spec says
   1578       1.11  augustss 		 * we need this descriptor.
   1579       1.11  augustss 		 */
   1580       1.11  augustss 		case UDESC_OTHER_SPEED_CONFIGURATION:
   1581        1.5  augustss 		case UDESC_CONFIG:
   1582        1.5  augustss 			if ((value & 0xff) != 0) {
   1583        1.5  augustss 				err = USBD_IOERROR;
   1584        1.5  augustss 				goto ret;
   1585        1.5  augustss 			}
   1586        1.5  augustss 			totlen = l = min(len, USB_CONFIG_DESCRIPTOR_SIZE);
   1587        1.5  augustss 			memcpy(buf, &ehci_confd, l);
   1588       1.11  augustss 			((usb_config_descriptor_t *)buf)->bDescriptorType =
   1589       1.11  augustss 				value >> 8;
   1590        1.5  augustss 			buf = (char *)buf + l;
   1591        1.5  augustss 			len -= l;
   1592        1.5  augustss 			l = min(len, USB_INTERFACE_DESCRIPTOR_SIZE);
   1593        1.5  augustss 			totlen += l;
   1594        1.5  augustss 			memcpy(buf, &ehci_ifcd, l);
   1595        1.5  augustss 			buf = (char *)buf + l;
   1596        1.5  augustss 			len -= l;
   1597        1.5  augustss 			l = min(len, USB_ENDPOINT_DESCRIPTOR_SIZE);
   1598        1.5  augustss 			totlen += l;
   1599        1.5  augustss 			memcpy(buf, &ehci_endpd, l);
   1600        1.5  augustss 			break;
   1601        1.5  augustss 		case UDESC_STRING:
   1602        1.5  augustss 			if (len == 0)
   1603        1.5  augustss 				break;
   1604        1.5  augustss 			*(u_int8_t *)buf = 0;
   1605        1.5  augustss 			totlen = 1;
   1606        1.5  augustss 			switch (value & 0xff) {
   1607        1.5  augustss 			case 1: /* Vendor */
   1608        1.5  augustss 				totlen = ehci_str(buf, len, sc->sc_vendor);
   1609        1.5  augustss 				break;
   1610        1.5  augustss 			case 2: /* Product */
   1611        1.5  augustss 				totlen = ehci_str(buf, len, "EHCI root hub");
   1612        1.5  augustss 				break;
   1613        1.5  augustss 			}
   1614        1.5  augustss 			break;
   1615        1.5  augustss 		default:
   1616        1.5  augustss 			err = USBD_IOERROR;
   1617        1.5  augustss 			goto ret;
   1618        1.5  augustss 		}
   1619        1.5  augustss 		break;
   1620        1.5  augustss 	case C(UR_GET_INTERFACE, UT_READ_INTERFACE):
   1621        1.5  augustss 		if (len > 0) {
   1622        1.5  augustss 			*(u_int8_t *)buf = 0;
   1623        1.5  augustss 			totlen = 1;
   1624        1.5  augustss 		}
   1625        1.5  augustss 		break;
   1626        1.5  augustss 	case C(UR_GET_STATUS, UT_READ_DEVICE):
   1627        1.5  augustss 		if (len > 1) {
   1628        1.5  augustss 			USETW(((usb_status_t *)buf)->wStatus,UDS_SELF_POWERED);
   1629        1.5  augustss 			totlen = 2;
   1630        1.5  augustss 		}
   1631        1.5  augustss 		break;
   1632        1.5  augustss 	case C(UR_GET_STATUS, UT_READ_INTERFACE):
   1633        1.5  augustss 	case C(UR_GET_STATUS, UT_READ_ENDPOINT):
   1634        1.5  augustss 		if (len > 1) {
   1635        1.5  augustss 			USETW(((usb_status_t *)buf)->wStatus, 0);
   1636        1.5  augustss 			totlen = 2;
   1637        1.5  augustss 		}
   1638        1.5  augustss 		break;
   1639        1.5  augustss 	case C(UR_SET_ADDRESS, UT_WRITE_DEVICE):
   1640        1.5  augustss 		if (value >= USB_MAX_DEVICES) {
   1641        1.5  augustss 			err = USBD_IOERROR;
   1642        1.5  augustss 			goto ret;
   1643        1.5  augustss 		}
   1644        1.5  augustss 		sc->sc_addr = value;
   1645        1.5  augustss 		break;
   1646        1.5  augustss 	case C(UR_SET_CONFIG, UT_WRITE_DEVICE):
   1647        1.5  augustss 		if (value != 0 && value != 1) {
   1648        1.5  augustss 			err = USBD_IOERROR;
   1649        1.5  augustss 			goto ret;
   1650        1.5  augustss 		}
   1651        1.5  augustss 		sc->sc_conf = value;
   1652        1.5  augustss 		break;
   1653        1.5  augustss 	case C(UR_SET_DESCRIPTOR, UT_WRITE_DEVICE):
   1654        1.5  augustss 		break;
   1655        1.5  augustss 	case C(UR_SET_FEATURE, UT_WRITE_DEVICE):
   1656        1.5  augustss 	case C(UR_SET_FEATURE, UT_WRITE_INTERFACE):
   1657        1.5  augustss 	case C(UR_SET_FEATURE, UT_WRITE_ENDPOINT):
   1658        1.5  augustss 		err = USBD_IOERROR;
   1659        1.5  augustss 		goto ret;
   1660        1.5  augustss 	case C(UR_SET_INTERFACE, UT_WRITE_INTERFACE):
   1661        1.5  augustss 		break;
   1662        1.5  augustss 	case C(UR_SYNCH_FRAME, UT_WRITE_ENDPOINT):
   1663        1.5  augustss 		break;
   1664        1.5  augustss 	/* Hub requests */
   1665        1.5  augustss 	case C(UR_CLEAR_FEATURE, UT_WRITE_CLASS_DEVICE):
   1666        1.5  augustss 		break;
   1667        1.5  augustss 	case C(UR_CLEAR_FEATURE, UT_WRITE_CLASS_OTHER):
   1668        1.5  augustss 		DPRINTFN(8, ("ehci_root_ctrl_control: UR_CLEAR_PORT_FEATURE "
   1669        1.5  augustss 			     "port=%d feature=%d\n",
   1670        1.5  augustss 			     index, value));
   1671        1.5  augustss 		if (index < 1 || index > sc->sc_noport) {
   1672        1.5  augustss 			err = USBD_IOERROR;
   1673        1.5  augustss 			goto ret;
   1674        1.5  augustss 		}
   1675        1.5  augustss 		port = EHCI_PORTSC(index);
   1676        1.5  augustss 		v = EOREAD4(sc, port) &~ EHCI_PS_CLEAR;
   1677        1.5  augustss 		switch(value) {
   1678        1.5  augustss 		case UHF_PORT_ENABLE:
   1679        1.5  augustss 			EOWRITE4(sc, port, v &~ EHCI_PS_PE);
   1680        1.5  augustss 			break;
   1681        1.5  augustss 		case UHF_PORT_SUSPEND:
   1682        1.5  augustss 			EOWRITE4(sc, port, v &~ EHCI_PS_SUSP);
   1683        1.5  augustss 			break;
   1684        1.5  augustss 		case UHF_PORT_POWER:
   1685        1.5  augustss 			EOWRITE4(sc, port, v &~ EHCI_PS_PP);
   1686        1.5  augustss 			break;
   1687       1.14  augustss 		case UHF_PORT_TEST:
   1688       1.14  augustss 			DPRINTFN(2,("ehci_root_ctrl_transfer: clear port test "
   1689       1.14  augustss 				    "%d\n", index));
   1690       1.14  augustss 			break;
   1691       1.14  augustss 		case UHF_PORT_INDICATOR:
   1692       1.14  augustss 			DPRINTFN(2,("ehci_root_ctrl_transfer: clear port ind "
   1693       1.14  augustss 				    "%d\n", index));
   1694       1.14  augustss 			EOWRITE4(sc, port, v &~ EHCI_PS_PIC);
   1695       1.14  augustss 			break;
   1696        1.5  augustss 		case UHF_C_PORT_CONNECTION:
   1697        1.5  augustss 			EOWRITE4(sc, port, v | EHCI_PS_CSC);
   1698        1.5  augustss 			break;
   1699        1.5  augustss 		case UHF_C_PORT_ENABLE:
   1700        1.5  augustss 			EOWRITE4(sc, port, v | EHCI_PS_PEC);
   1701        1.5  augustss 			break;
   1702        1.5  augustss 		case UHF_C_PORT_SUSPEND:
   1703        1.5  augustss 			/* how? */
   1704        1.5  augustss 			break;
   1705        1.5  augustss 		case UHF_C_PORT_OVER_CURRENT:
   1706        1.5  augustss 			EOWRITE4(sc, port, v | EHCI_PS_OCC);
   1707        1.5  augustss 			break;
   1708        1.5  augustss 		case UHF_C_PORT_RESET:
   1709        1.6  augustss 			sc->sc_isreset = 0;
   1710        1.5  augustss 			break;
   1711        1.5  augustss 		default:
   1712        1.5  augustss 			err = USBD_IOERROR;
   1713        1.5  augustss 			goto ret;
   1714        1.5  augustss 		}
   1715        1.5  augustss #if 0
   1716        1.5  augustss 		switch(value) {
   1717        1.5  augustss 		case UHF_C_PORT_CONNECTION:
   1718        1.5  augustss 		case UHF_C_PORT_ENABLE:
   1719        1.5  augustss 		case UHF_C_PORT_SUSPEND:
   1720        1.5  augustss 		case UHF_C_PORT_OVER_CURRENT:
   1721        1.5  augustss 		case UHF_C_PORT_RESET:
   1722        1.5  augustss 			/* Enable RHSC interrupt if condition is cleared. */
   1723        1.5  augustss 			if ((OREAD4(sc, port) >> 16) == 0)
   1724        1.6  augustss 				ehci_pcd_able(sc, 1);
   1725        1.5  augustss 			break;
   1726        1.5  augustss 		default:
   1727        1.5  augustss 			break;
   1728        1.5  augustss 		}
   1729        1.5  augustss #endif
   1730        1.5  augustss 		break;
   1731        1.5  augustss 	case C(UR_GET_DESCRIPTOR, UT_READ_CLASS_DEVICE):
   1732       1.51    toshii 		if ((value & 0xff) != 0) {
   1733        1.5  augustss 			err = USBD_IOERROR;
   1734        1.5  augustss 			goto ret;
   1735        1.5  augustss 		}
   1736        1.5  augustss 		hubd = ehci_hubd;
   1737        1.5  augustss 		hubd.bNbrPorts = sc->sc_noport;
   1738        1.5  augustss 		v = EOREAD4(sc, EHCI_HCSPARAMS);
   1739        1.5  augustss 		USETW(hubd.wHubCharacteristics,
   1740       1.14  augustss 		    EHCI_HCS_PPC(v) ? UHD_PWR_INDIVIDUAL : UHD_PWR_NO_SWITCH |
   1741       1.14  augustss 		    EHCI_HCS_P_INCICATOR(EREAD4(sc, EHCI_HCSPARAMS))
   1742       1.14  augustss 		        ? UHD_PORT_IND : 0);
   1743        1.5  augustss 		hubd.bPwrOn2PwrGood = 200; /* XXX can't find out? */
   1744       1.33  augustss 		for (i = 0, l = sc->sc_noport; l > 0; i++, l -= 8, v >>= 8)
   1745        1.5  augustss 			hubd.DeviceRemovable[i++] = 0; /* XXX can't find out? */
   1746        1.5  augustss 		hubd.bDescLength = USB_HUB_DESCRIPTOR_SIZE + i;
   1747        1.5  augustss 		l = min(len, hubd.bDescLength);
   1748        1.5  augustss 		totlen = l;
   1749        1.5  augustss 		memcpy(buf, &hubd, l);
   1750        1.5  augustss 		break;
   1751        1.5  augustss 	case C(UR_GET_STATUS, UT_READ_CLASS_DEVICE):
   1752        1.5  augustss 		if (len != 4) {
   1753        1.5  augustss 			err = USBD_IOERROR;
   1754        1.5  augustss 			goto ret;
   1755        1.5  augustss 		}
   1756        1.5  augustss 		memset(buf, 0, len); /* ? XXX */
   1757        1.5  augustss 		totlen = len;
   1758        1.5  augustss 		break;
   1759        1.5  augustss 	case C(UR_GET_STATUS, UT_READ_CLASS_OTHER):
   1760        1.5  augustss 		DPRINTFN(8,("ehci_root_ctrl_transfer: get port status i=%d\n",
   1761        1.5  augustss 			    index));
   1762        1.5  augustss 		if (index < 1 || index > sc->sc_noport) {
   1763        1.5  augustss 			err = USBD_IOERROR;
   1764        1.5  augustss 			goto ret;
   1765        1.5  augustss 		}
   1766        1.5  augustss 		if (len != 4) {
   1767        1.5  augustss 			err = USBD_IOERROR;
   1768        1.5  augustss 			goto ret;
   1769        1.5  augustss 		}
   1770        1.5  augustss 		v = EOREAD4(sc, EHCI_PORTSC(index));
   1771        1.5  augustss 		DPRINTFN(8,("ehci_root_ctrl_transfer: port status=0x%04x\n",
   1772        1.5  augustss 			    v));
   1773       1.11  augustss 		i = UPS_HIGH_SPEED;
   1774        1.5  augustss 		if (v & EHCI_PS_CS)	i |= UPS_CURRENT_CONNECT_STATUS;
   1775        1.5  augustss 		if (v & EHCI_PS_PE)	i |= UPS_PORT_ENABLED;
   1776        1.5  augustss 		if (v & EHCI_PS_SUSP)	i |= UPS_SUSPEND;
   1777        1.5  augustss 		if (v & EHCI_PS_OCA)	i |= UPS_OVERCURRENT_INDICATOR;
   1778        1.5  augustss 		if (v & EHCI_PS_PR)	i |= UPS_RESET;
   1779        1.5  augustss 		if (v & EHCI_PS_PP)	i |= UPS_PORT_POWER;
   1780        1.5  augustss 		USETW(ps.wPortStatus, i);
   1781        1.5  augustss 		i = 0;
   1782        1.5  augustss 		if (v & EHCI_PS_CSC)	i |= UPS_C_CONNECT_STATUS;
   1783        1.5  augustss 		if (v & EHCI_PS_PEC)	i |= UPS_C_PORT_ENABLED;
   1784        1.5  augustss 		if (v & EHCI_PS_OCC)	i |= UPS_C_OVERCURRENT_INDICATOR;
   1785        1.6  augustss 		if (sc->sc_isreset)	i |= UPS_C_PORT_RESET;
   1786        1.5  augustss 		USETW(ps.wPortChange, i);
   1787        1.5  augustss 		l = min(len, sizeof ps);
   1788        1.5  augustss 		memcpy(buf, &ps, l);
   1789        1.5  augustss 		totlen = l;
   1790        1.5  augustss 		break;
   1791        1.5  augustss 	case C(UR_SET_DESCRIPTOR, UT_WRITE_CLASS_DEVICE):
   1792        1.5  augustss 		err = USBD_IOERROR;
   1793        1.5  augustss 		goto ret;
   1794        1.5  augustss 	case C(UR_SET_FEATURE, UT_WRITE_CLASS_DEVICE):
   1795        1.5  augustss 		break;
   1796        1.5  augustss 	case C(UR_SET_FEATURE, UT_WRITE_CLASS_OTHER):
   1797        1.5  augustss 		if (index < 1 || index > sc->sc_noport) {
   1798        1.5  augustss 			err = USBD_IOERROR;
   1799        1.5  augustss 			goto ret;
   1800        1.5  augustss 		}
   1801        1.5  augustss 		port = EHCI_PORTSC(index);
   1802        1.5  augustss 		v = EOREAD4(sc, port) &~ EHCI_PS_CLEAR;
   1803        1.5  augustss 		switch(value) {
   1804        1.5  augustss 		case UHF_PORT_ENABLE:
   1805        1.5  augustss 			EOWRITE4(sc, port, v | EHCI_PS_PE);
   1806        1.5  augustss 			break;
   1807        1.5  augustss 		case UHF_PORT_SUSPEND:
   1808        1.5  augustss 			EOWRITE4(sc, port, v | EHCI_PS_SUSP);
   1809        1.5  augustss 			break;
   1810        1.5  augustss 		case UHF_PORT_RESET:
   1811        1.5  augustss 			DPRINTFN(5,("ehci_root_ctrl_transfer: reset port %d\n",
   1812        1.5  augustss 				    index));
   1813        1.6  augustss 			if (EHCI_PS_IS_LOWSPEED(v)) {
   1814        1.6  augustss 				/* Low speed device, give up ownership. */
   1815        1.6  augustss 				ehci_disown(sc, index, 1);
   1816        1.6  augustss 				break;
   1817        1.6  augustss 			}
   1818        1.8  augustss 			/* Start reset sequence. */
   1819        1.8  augustss 			v &= ~ (EHCI_PS_PE | EHCI_PS_PR);
   1820        1.5  augustss 			EOWRITE4(sc, port, v | EHCI_PS_PR);
   1821        1.8  augustss 			/* Wait for reset to complete. */
   1822       1.13  augustss 			usb_delay_ms(&sc->sc_bus, USB_PORT_ROOT_RESET_DELAY);
   1823       1.17  augustss 			if (sc->sc_dying) {
   1824       1.17  augustss 				err = USBD_IOERROR;
   1825       1.17  augustss 				goto ret;
   1826       1.17  augustss 			}
   1827        1.8  augustss 			/* Terminate reset sequence. */
   1828        1.8  augustss 			EOWRITE4(sc, port, v);
   1829        1.8  augustss 			/* Wait for HC to complete reset. */
   1830       1.13  augustss 			usb_delay_ms(&sc->sc_bus, EHCI_PORT_RESET_COMPLETE);
   1831       1.17  augustss 			if (sc->sc_dying) {
   1832       1.17  augustss 				err = USBD_IOERROR;
   1833       1.17  augustss 				goto ret;
   1834       1.17  augustss 			}
   1835        1.8  augustss 			v = EOREAD4(sc, port);
   1836        1.8  augustss 			DPRINTF(("ehci after reset, status=0x%08x\n", v));
   1837        1.8  augustss 			if (v & EHCI_PS_PR) {
   1838        1.8  augustss 				printf("%s: port reset timeout\n",
   1839        1.8  augustss 				       USBDEVNAME(sc->sc_bus.bdev));
   1840        1.8  augustss 				return (USBD_TIMEOUT);
   1841        1.5  augustss 			}
   1842        1.8  augustss 			if (!(v & EHCI_PS_PE)) {
   1843        1.6  augustss 				/* Not a high speed device, give up ownership.*/
   1844        1.6  augustss 				ehci_disown(sc, index, 0);
   1845        1.6  augustss 				break;
   1846        1.6  augustss 			}
   1847        1.6  augustss 			sc->sc_isreset = 1;
   1848        1.8  augustss 			DPRINTF(("ehci port %d reset, status = 0x%08x\n",
   1849        1.6  augustss 				 index, v));
   1850        1.5  augustss 			break;
   1851        1.5  augustss 		case UHF_PORT_POWER:
   1852        1.5  augustss 			DPRINTFN(2,("ehci_root_ctrl_transfer: set port power "
   1853        1.5  augustss 				    "%d\n", index));
   1854        1.5  augustss 			EOWRITE4(sc, port, v | EHCI_PS_PP);
   1855        1.5  augustss 			break;
   1856       1.11  augustss 		case UHF_PORT_TEST:
   1857       1.11  augustss 			DPRINTFN(2,("ehci_root_ctrl_transfer: set port test "
   1858       1.11  augustss 				    "%d\n", index));
   1859       1.11  augustss 			break;
   1860       1.11  augustss 		case UHF_PORT_INDICATOR:
   1861       1.11  augustss 			DPRINTFN(2,("ehci_root_ctrl_transfer: set port ind "
   1862       1.11  augustss 				    "%d\n", index));
   1863       1.14  augustss 			EOWRITE4(sc, port, v | EHCI_PS_PIC);
   1864       1.11  augustss 			break;
   1865        1.5  augustss 		default:
   1866        1.5  augustss 			err = USBD_IOERROR;
   1867        1.5  augustss 			goto ret;
   1868        1.5  augustss 		}
   1869        1.5  augustss 		break;
   1870       1.11  augustss 	case C(UR_CLEAR_TT_BUFFER, UT_WRITE_CLASS_OTHER):
   1871       1.11  augustss 	case C(UR_RESET_TT, UT_WRITE_CLASS_OTHER):
   1872       1.11  augustss 	case C(UR_GET_TT_STATE, UT_READ_CLASS_OTHER):
   1873       1.11  augustss 	case C(UR_STOP_TT, UT_WRITE_CLASS_OTHER):
   1874       1.11  augustss 		break;
   1875        1.5  augustss 	default:
   1876        1.5  augustss 		err = USBD_IOERROR;
   1877        1.5  augustss 		goto ret;
   1878        1.5  augustss 	}
   1879        1.5  augustss 	xfer->actlen = totlen;
   1880        1.5  augustss 	err = USBD_NORMAL_COMPLETION;
   1881        1.5  augustss  ret:
   1882        1.5  augustss 	xfer->status = err;
   1883        1.5  augustss 	s = splusb();
   1884        1.5  augustss 	usb_transfer_complete(xfer);
   1885        1.5  augustss 	splx(s);
   1886        1.5  augustss 	return (USBD_IN_PROGRESS);
   1887        1.6  augustss }
   1888        1.6  augustss 
   1889        1.6  augustss void
   1890        1.6  augustss ehci_disown(ehci_softc_t *sc, int index, int lowspeed)
   1891        1.6  augustss {
   1892       1.24  augustss 	int port;
   1893        1.6  augustss 	u_int32_t v;
   1894        1.6  augustss 
   1895        1.6  augustss 	DPRINTF(("ehci_disown: index=%d lowspeed=%d\n", index, lowspeed));
   1896        1.6  augustss #ifdef DIAGNOSTIC
   1897        1.6  augustss 	if (sc->sc_npcomp != 0) {
   1898       1.24  augustss 		int i = (index-1) / sc->sc_npcomp;
   1899        1.6  augustss 		if (i >= sc->sc_ncomp)
   1900        1.6  augustss 			printf("%s: strange port\n",
   1901        1.6  augustss 			       USBDEVNAME(sc->sc_bus.bdev));
   1902        1.6  augustss 		else
   1903        1.6  augustss 			printf("%s: handing over %s speed device on "
   1904        1.6  augustss 			       "port %d to %s\n",
   1905        1.6  augustss 			       USBDEVNAME(sc->sc_bus.bdev),
   1906        1.6  augustss 			       lowspeed ? "low" : "full",
   1907        1.6  augustss 			       index, USBDEVNAME(sc->sc_comps[i]->bdev));
   1908        1.6  augustss 	} else {
   1909        1.6  augustss 		printf("%s: npcomp == 0\n", USBDEVNAME(sc->sc_bus.bdev));
   1910        1.6  augustss 	}
   1911        1.6  augustss #endif
   1912        1.6  augustss 	port = EHCI_PORTSC(index);
   1913        1.6  augustss 	v = EOREAD4(sc, port) &~ EHCI_PS_CLEAR;
   1914        1.6  augustss 	EOWRITE4(sc, port, v | EHCI_PS_PO);
   1915        1.5  augustss }
   1916        1.5  augustss 
   1917        1.5  augustss /* Abort a root control request. */
   1918        1.5  augustss Static void
   1919        1.5  augustss ehci_root_ctrl_abort(usbd_xfer_handle xfer)
   1920        1.5  augustss {
   1921        1.5  augustss 	/* Nothing to do, all transfers are synchronous. */
   1922        1.5  augustss }
   1923        1.5  augustss 
   1924        1.5  augustss /* Close the root pipe. */
   1925        1.5  augustss Static void
   1926        1.5  augustss ehci_root_ctrl_close(usbd_pipe_handle pipe)
   1927        1.5  augustss {
   1928        1.5  augustss 	DPRINTF(("ehci_root_ctrl_close\n"));
   1929        1.5  augustss 	/* Nothing to do. */
   1930        1.5  augustss }
   1931        1.5  augustss 
   1932        1.5  augustss void
   1933        1.5  augustss ehci_root_intr_done(usbd_xfer_handle xfer)
   1934        1.5  augustss {
   1935        1.5  augustss 	xfer->hcpriv = NULL;
   1936        1.5  augustss }
   1937        1.5  augustss 
   1938        1.5  augustss Static usbd_status
   1939        1.5  augustss ehci_root_intr_transfer(usbd_xfer_handle xfer)
   1940        1.5  augustss {
   1941        1.5  augustss 	usbd_status err;
   1942        1.5  augustss 
   1943        1.5  augustss 	/* Insert last in queue. */
   1944        1.5  augustss 	err = usb_insert_transfer(xfer);
   1945        1.5  augustss 	if (err)
   1946        1.5  augustss 		return (err);
   1947        1.5  augustss 
   1948        1.5  augustss 	/* Pipe isn't running, start first */
   1949        1.5  augustss 	return (ehci_root_intr_start(SIMPLEQ_FIRST(&xfer->pipe->queue)));
   1950        1.5  augustss }
   1951        1.5  augustss 
   1952        1.5  augustss Static usbd_status
   1953        1.5  augustss ehci_root_intr_start(usbd_xfer_handle xfer)
   1954        1.5  augustss {
   1955        1.5  augustss 	usbd_pipe_handle pipe = xfer->pipe;
   1956        1.5  augustss 	ehci_softc_t *sc = (ehci_softc_t *)pipe->device->bus;
   1957        1.5  augustss 
   1958        1.5  augustss 	if (sc->sc_dying)
   1959        1.5  augustss 		return (USBD_IOERROR);
   1960        1.5  augustss 
   1961        1.5  augustss 	sc->sc_intrxfer = xfer;
   1962        1.5  augustss 
   1963        1.5  augustss 	return (USBD_IN_PROGRESS);
   1964        1.5  augustss }
   1965        1.5  augustss 
   1966        1.5  augustss /* Abort a root interrupt request. */
   1967        1.5  augustss Static void
   1968        1.5  augustss ehci_root_intr_abort(usbd_xfer_handle xfer)
   1969        1.5  augustss {
   1970        1.5  augustss 	int s;
   1971        1.5  augustss 
   1972        1.5  augustss 	if (xfer->pipe->intrxfer == xfer) {
   1973        1.5  augustss 		DPRINTF(("ehci_root_intr_abort: remove\n"));
   1974        1.5  augustss 		xfer->pipe->intrxfer = NULL;
   1975        1.5  augustss 	}
   1976        1.5  augustss 	xfer->status = USBD_CANCELLED;
   1977        1.5  augustss 	s = splusb();
   1978        1.5  augustss 	usb_transfer_complete(xfer);
   1979        1.5  augustss 	splx(s);
   1980        1.5  augustss }
   1981        1.5  augustss 
   1982        1.5  augustss /* Close the root pipe. */
   1983        1.5  augustss Static void
   1984        1.5  augustss ehci_root_intr_close(usbd_pipe_handle pipe)
   1985        1.5  augustss {
   1986        1.5  augustss 	ehci_softc_t *sc = (ehci_softc_t *)pipe->device->bus;
   1987       1.33  augustss 
   1988        1.5  augustss 	DPRINTF(("ehci_root_intr_close\n"));
   1989        1.5  augustss 
   1990        1.5  augustss 	sc->sc_intrxfer = NULL;
   1991        1.5  augustss }
   1992        1.5  augustss 
   1993        1.5  augustss void
   1994        1.5  augustss ehci_root_ctrl_done(usbd_xfer_handle xfer)
   1995        1.5  augustss {
   1996        1.5  augustss 	xfer->hcpriv = NULL;
   1997        1.9  augustss }
   1998        1.9  augustss 
   1999        1.9  augustss /************************/
   2000        1.9  augustss 
   2001        1.9  augustss ehci_soft_qh_t *
   2002        1.9  augustss ehci_alloc_sqh(ehci_softc_t *sc)
   2003        1.9  augustss {
   2004        1.9  augustss 	ehci_soft_qh_t *sqh;
   2005        1.9  augustss 	usbd_status err;
   2006        1.9  augustss 	int i, offs;
   2007        1.9  augustss 	usb_dma_t dma;
   2008        1.9  augustss 
   2009        1.9  augustss 	if (sc->sc_freeqhs == NULL) {
   2010        1.9  augustss 		DPRINTFN(2, ("ehci_alloc_sqh: allocating chunk\n"));
   2011        1.9  augustss 		err = usb_allocmem(&sc->sc_bus, EHCI_SQH_SIZE * EHCI_SQH_CHUNK,
   2012        1.9  augustss 			  EHCI_PAGE_SIZE, &dma);
   2013       1.25  augustss #ifdef EHCI_DEBUG
   2014       1.25  augustss 		if (err)
   2015       1.25  augustss 			printf("ehci_alloc_sqh: usb_allocmem()=%d\n", err);
   2016       1.25  augustss #endif
   2017        1.9  augustss 		if (err)
   2018       1.11  augustss 			return (NULL);
   2019        1.9  augustss 		for(i = 0; i < EHCI_SQH_CHUNK; i++) {
   2020        1.9  augustss 			offs = i * EHCI_SQH_SIZE;
   2021       1.30  augustss 			sqh = KERNADDR(&dma, offs);
   2022       1.31  augustss 			sqh->physaddr = DMAADDR(&dma, offs);
   2023        1.9  augustss 			sqh->next = sc->sc_freeqhs;
   2024        1.9  augustss 			sc->sc_freeqhs = sqh;
   2025        1.9  augustss 		}
   2026        1.9  augustss 	}
   2027        1.9  augustss 	sqh = sc->sc_freeqhs;
   2028        1.9  augustss 	sc->sc_freeqhs = sqh->next;
   2029        1.9  augustss 	memset(&sqh->qh, 0, sizeof(ehci_qh_t));
   2030       1.11  augustss 	sqh->next = NULL;
   2031        1.9  augustss 	return (sqh);
   2032        1.9  augustss }
   2033        1.9  augustss 
   2034        1.9  augustss void
   2035        1.9  augustss ehci_free_sqh(ehci_softc_t *sc, ehci_soft_qh_t *sqh)
   2036        1.9  augustss {
   2037        1.9  augustss 	sqh->next = sc->sc_freeqhs;
   2038        1.9  augustss 	sc->sc_freeqhs = sqh;
   2039        1.9  augustss }
   2040        1.9  augustss 
   2041        1.9  augustss ehci_soft_qtd_t *
   2042        1.9  augustss ehci_alloc_sqtd(ehci_softc_t *sc)
   2043        1.9  augustss {
   2044        1.9  augustss 	ehci_soft_qtd_t *sqtd;
   2045        1.9  augustss 	usbd_status err;
   2046        1.9  augustss 	int i, offs;
   2047        1.9  augustss 	usb_dma_t dma;
   2048        1.9  augustss 	int s;
   2049        1.9  augustss 
   2050        1.9  augustss 	if (sc->sc_freeqtds == NULL) {
   2051        1.9  augustss 		DPRINTFN(2, ("ehci_alloc_sqtd: allocating chunk\n"));
   2052        1.9  augustss 		err = usb_allocmem(&sc->sc_bus, EHCI_SQTD_SIZE*EHCI_SQTD_CHUNK,
   2053        1.9  augustss 			  EHCI_PAGE_SIZE, &dma);
   2054       1.25  augustss #ifdef EHCI_DEBUG
   2055       1.25  augustss 		if (err)
   2056       1.25  augustss 			printf("ehci_alloc_sqtd: usb_allocmem()=%d\n", err);
   2057       1.25  augustss #endif
   2058        1.9  augustss 		if (err)
   2059        1.9  augustss 			return (NULL);
   2060        1.9  augustss 		s = splusb();
   2061        1.9  augustss 		for(i = 0; i < EHCI_SQTD_CHUNK; i++) {
   2062        1.9  augustss 			offs = i * EHCI_SQTD_SIZE;
   2063       1.30  augustss 			sqtd = KERNADDR(&dma, offs);
   2064       1.31  augustss 			sqtd->physaddr = DMAADDR(&dma, offs);
   2065        1.9  augustss 			sqtd->nextqtd = sc->sc_freeqtds;
   2066        1.9  augustss 			sc->sc_freeqtds = sqtd;
   2067        1.9  augustss 		}
   2068        1.9  augustss 		splx(s);
   2069        1.9  augustss 	}
   2070        1.9  augustss 
   2071        1.9  augustss 	s = splusb();
   2072        1.9  augustss 	sqtd = sc->sc_freeqtds;
   2073        1.9  augustss 	sc->sc_freeqtds = sqtd->nextqtd;
   2074        1.9  augustss 	memset(&sqtd->qtd, 0, sizeof(ehci_qtd_t));
   2075        1.9  augustss 	sqtd->nextqtd = NULL;
   2076        1.9  augustss 	sqtd->xfer = NULL;
   2077        1.9  augustss 	splx(s);
   2078        1.9  augustss 
   2079        1.9  augustss 	return (sqtd);
   2080        1.9  augustss }
   2081        1.9  augustss 
   2082        1.9  augustss void
   2083        1.9  augustss ehci_free_sqtd(ehci_softc_t *sc, ehci_soft_qtd_t *sqtd)
   2084        1.9  augustss {
   2085        1.9  augustss 	int s;
   2086        1.9  augustss 
   2087        1.9  augustss 	s = splusb();
   2088        1.9  augustss 	sqtd->nextqtd = sc->sc_freeqtds;
   2089        1.9  augustss 	sc->sc_freeqtds = sqtd;
   2090        1.9  augustss 	splx(s);
   2091        1.9  augustss }
   2092        1.9  augustss 
   2093       1.15  augustss usbd_status
   2094       1.25  augustss ehci_alloc_sqtd_chain(struct ehci_pipe *epipe, ehci_softc_t *sc,
   2095       1.15  augustss 		     int alen, int rd, usbd_xfer_handle xfer,
   2096       1.15  augustss 		     ehci_soft_qtd_t **sp, ehci_soft_qtd_t **ep)
   2097       1.15  augustss {
   2098       1.15  augustss 	ehci_soft_qtd_t *next, *cur;
   2099       1.22  augustss 	ehci_physaddr_t dataphys, dataphyspage, dataphyslastpage, nextphys;
   2100       1.15  augustss 	u_int32_t qtdstatus;
   2101   1.54.2.1      tron 	int len, curlen, mps;
   2102   1.54.2.1      tron 	int i, tog;
   2103       1.15  augustss 	usb_dma_t *dma = &xfer->dmabuf;
   2104       1.15  augustss 
   2105       1.25  augustss 	DPRINTFN(alen<4*4096,("ehci_alloc_sqtd_chain: start len=%d\n", alen));
   2106       1.15  augustss 
   2107       1.15  augustss 	len = alen;
   2108       1.31  augustss 	dataphys = DMAADDR(dma, 0);
   2109       1.22  augustss 	dataphyslastpage = EHCI_PAGE(dataphys + len - 1);
   2110   1.54.2.1      tron #if 0
   2111   1.54.2.1      tron printf("status=%08x toggle=%d\n", epipe->sqh->qh.qh_qtd.qtd_status,
   2112   1.54.2.1      tron     epipe->nexttoggle);
   2113   1.54.2.1      tron #endif
   2114       1.15  augustss 	qtdstatus = htole32(
   2115       1.26  augustss 	    EHCI_QTD_ACTIVE |
   2116       1.15  augustss 	    EHCI_QTD_SET_PID(rd ? EHCI_QTD_PID_IN : EHCI_QTD_PID_OUT) |
   2117       1.15  augustss 	    EHCI_QTD_SET_CERR(3)
   2118       1.15  augustss 	    /* IOC set below */
   2119       1.15  augustss 	    /* BYTES set below */
   2120       1.15  augustss 	    );
   2121   1.54.2.1      tron 	mps = UGETW(epipe->pipe.endpoint->edesc->wMaxPacketSize);
   2122   1.54.2.1      tron 	tog = epipe->nexttoggle;
   2123  1.54.2.10      tron 	qtdstatus |= EHCI_QTD_SET_TOGGLE(tog);
   2124       1.15  augustss 
   2125       1.15  augustss 	cur = ehci_alloc_sqtd(sc);
   2126       1.25  augustss 	*sp = cur;
   2127       1.15  augustss 	if (cur == NULL)
   2128       1.15  augustss 		goto nomem;
   2129       1.15  augustss 	for (;;) {
   2130       1.22  augustss 		dataphyspage = EHCI_PAGE(dataphys);
   2131       1.26  augustss 		/* The EHCI hardware can handle at most 5 pages. */
   2132       1.33  augustss 		if (dataphyslastpage - dataphyspage <
   2133       1.26  augustss 		    EHCI_QTD_NBUFFERS * EHCI_PAGE_SIZE) {
   2134       1.15  augustss 			/* we can handle it in this QTD */
   2135       1.15  augustss 			curlen = len;
   2136       1.15  augustss 		} else {
   2137       1.15  augustss 			/* must use multiple TDs, fill as much as possible. */
   2138       1.33  augustss 			curlen = EHCI_QTD_NBUFFERS * EHCI_PAGE_SIZE -
   2139       1.22  augustss 				 EHCI_PAGE_OFFSET(dataphys);
   2140       1.25  augustss #ifdef DIAGNOSTIC
   2141       1.25  augustss 			if (curlen > len) {
   2142       1.26  augustss 				printf("ehci_alloc_sqtd_chain: curlen=0x%x "
   2143       1.26  augustss 				       "len=0x%x offs=0x%x\n", curlen, len,
   2144       1.26  augustss 				       EHCI_PAGE_OFFSET(dataphys));
   2145       1.26  augustss 				printf("lastpage=0x%x page=0x%x phys=0x%x\n",
   2146       1.26  augustss 				       dataphyslastpage, dataphyspage,
   2147       1.26  augustss 				       dataphys);
   2148       1.25  augustss 				curlen = len;
   2149       1.25  augustss 			}
   2150       1.25  augustss #endif
   2151       1.15  augustss 			/* the length must be a multiple of the max size */
   2152   1.54.2.1      tron 			curlen -= curlen % mps;
   2153       1.25  augustss 			DPRINTFN(1,("ehci_alloc_sqtd_chain: multiple QTDs, "
   2154       1.25  augustss 				    "curlen=%d\n", curlen));
   2155       1.15  augustss #ifdef DIAGNOSTIC
   2156       1.15  augustss 			if (curlen == 0)
   2157       1.37    provos 				panic("ehci_alloc_std: curlen == 0");
   2158       1.15  augustss #endif
   2159       1.15  augustss 		}
   2160       1.25  augustss 		DPRINTFN(4,("ehci_alloc_sqtd_chain: dataphys=0x%08x "
   2161       1.22  augustss 			    "dataphyslastpage=0x%08x len=%d curlen=%d\n",
   2162       1.22  augustss 			    dataphys, dataphyslastpage,
   2163       1.15  augustss 			    len, curlen));
   2164       1.15  augustss 		len -= curlen;
   2165       1.15  augustss 
   2166       1.15  augustss 		if (len != 0) {
   2167       1.15  augustss 			next = ehci_alloc_sqtd(sc);
   2168       1.15  augustss 			if (next == NULL)
   2169       1.15  augustss 				goto nomem;
   2170  1.54.2.11        he 			nextphys = htole32(next->physaddr);
   2171       1.15  augustss 		} else {
   2172       1.15  augustss 			next = NULL;
   2173       1.15  augustss 			nextphys = EHCI_NULL;
   2174       1.15  augustss 		}
   2175       1.15  augustss 
   2176       1.15  augustss 		for (i = 0; i * EHCI_PAGE_SIZE < curlen; i++) {
   2177       1.15  augustss 			ehci_physaddr_t a = dataphys + i * EHCI_PAGE_SIZE;
   2178       1.15  augustss 			if (i != 0) /* use offset only in first buffer */
   2179       1.15  augustss 				a = EHCI_PAGE(a);
   2180       1.15  augustss 			cur->qtd.qtd_buffer[i] = htole32(a);
   2181       1.48   mycroft 			cur->qtd.qtd_buffer_hi[i] = 0;
   2182       1.25  augustss #ifdef DIAGNOSTIC
   2183       1.25  augustss 			if (i >= EHCI_QTD_NBUFFERS) {
   2184       1.25  augustss 				printf("ehci_alloc_sqtd_chain: i=%d\n", i);
   2185       1.25  augustss 				goto nomem;
   2186       1.25  augustss 			}
   2187       1.25  augustss #endif
   2188       1.15  augustss 		}
   2189       1.15  augustss 		cur->nextqtd = next;
   2190  1.54.2.11        he 		cur->qtd.qtd_next = cur->qtd.qtd_altnext = nextphys;
   2191       1.15  augustss 		cur->qtd.qtd_status =
   2192       1.15  augustss 		    qtdstatus | htole32(EHCI_QTD_SET_BYTES(curlen));
   2193       1.15  augustss 		cur->xfer = xfer;
   2194       1.18  augustss 		cur->len = curlen;
   2195       1.29  augustss 		DPRINTFN(10,("ehci_alloc_sqtd_chain: cbp=0x%08x end=0x%08x\n",
   2196       1.29  augustss 			    dataphys, dataphys + curlen));
   2197   1.54.2.1      tron 		/* adjust the toggle based on the number of packets in this
   2198   1.54.2.1      tron 		   qtd */
   2199   1.54.2.1      tron 		if (((curlen + mps - 1) / mps) & 1) {
   2200   1.54.2.1      tron 			tog ^= 1;
   2201  1.54.2.10      tron 			qtdstatus ^= EHCI_QTD_TOGGLE_MASK;
   2202   1.54.2.1      tron 		}
   2203       1.15  augustss 		if (len == 0)
   2204       1.15  augustss 			break;
   2205       1.25  augustss 		DPRINTFN(10,("ehci_alloc_sqtd_chain: extend chain\n"));
   2206       1.15  augustss 		dataphys += curlen;
   2207       1.15  augustss 		cur = next;
   2208       1.15  augustss 	}
   2209       1.15  augustss 	cur->qtd.qtd_status |= htole32(EHCI_QTD_IOC);
   2210       1.15  augustss 	*ep = cur;
   2211   1.54.2.1      tron 	epipe->nexttoggle = tog;
   2212       1.15  augustss 
   2213       1.29  augustss 	DPRINTFN(10,("ehci_alloc_sqtd_chain: return sqtd=%p sqtdend=%p\n",
   2214       1.29  augustss 		     *sp, *ep));
   2215       1.29  augustss 
   2216       1.15  augustss 	return (USBD_NORMAL_COMPLETION);
   2217       1.15  augustss 
   2218       1.15  augustss  nomem:
   2219       1.15  augustss 	/* XXX free chain */
   2220       1.25  augustss 	DPRINTFN(-1,("ehci_alloc_sqtd_chain: no memory\n"));
   2221       1.15  augustss 	return (USBD_NOMEM);
   2222       1.15  augustss }
   2223       1.15  augustss 
   2224       1.18  augustss Static void
   2225       1.25  augustss ehci_free_sqtd_chain(ehci_softc_t *sc, ehci_soft_qtd_t *sqtd,
   2226       1.18  augustss 		    ehci_soft_qtd_t *sqtdend)
   2227       1.18  augustss {
   2228       1.18  augustss 	ehci_soft_qtd_t *p;
   2229       1.25  augustss 	int i;
   2230       1.18  augustss 
   2231       1.29  augustss 	DPRINTFN(10,("ehci_free_sqtd_chain: sqtd=%p sqtdend=%p\n",
   2232       1.29  augustss 		     sqtd, sqtdend));
   2233       1.29  augustss 
   2234       1.25  augustss 	for (i = 0; sqtd != sqtdend; sqtd = p, i++) {
   2235       1.18  augustss 		p = sqtd->nextqtd;
   2236       1.18  augustss 		ehci_free_sqtd(sc, sqtd);
   2237       1.18  augustss 	}
   2238       1.18  augustss }
   2239       1.18  augustss 
   2240       1.15  augustss /****************/
   2241       1.15  augustss 
   2242        1.9  augustss /*
   2243       1.10  augustss  * Close a reqular pipe.
   2244       1.10  augustss  * Assumes that there are no pending transactions.
   2245       1.10  augustss  */
   2246       1.10  augustss void
   2247       1.10  augustss ehci_close_pipe(usbd_pipe_handle pipe, ehci_soft_qh_t *head)
   2248       1.10  augustss {
   2249       1.10  augustss 	struct ehci_pipe *epipe = (struct ehci_pipe *)pipe;
   2250       1.10  augustss 	ehci_softc_t *sc = (ehci_softc_t *)pipe->device->bus;
   2251       1.10  augustss 	ehci_soft_qh_t *sqh = epipe->sqh;
   2252       1.10  augustss 	int s;
   2253       1.10  augustss 
   2254       1.10  augustss 	s = splusb();
   2255       1.10  augustss 	ehci_rem_qh(sc, sqh, head);
   2256       1.10  augustss 	splx(s);
   2257       1.10  augustss 	ehci_free_sqh(sc, epipe->sqh);
   2258       1.10  augustss }
   2259       1.10  augustss 
   2260       1.33  augustss /*
   2261       1.10  augustss  * Abort a device request.
   2262       1.10  augustss  * If this routine is called at splusb() it guarantees that the request
   2263       1.10  augustss  * will be removed from the hardware scheduling and that the callback
   2264       1.10  augustss  * for it will be called with USBD_CANCELLED status.
   2265       1.10  augustss  * It's impossible to guarantee that the requested transfer will not
   2266       1.10  augustss  * have happened since the hardware runs concurrently.
   2267       1.10  augustss  * If the transaction has already happened we rely on the ordinary
   2268       1.10  augustss  * interrupt processing to process it.
   2269       1.26  augustss  * XXX This is most probably wrong.
   2270       1.10  augustss  */
   2271       1.10  augustss void
   2272       1.10  augustss ehci_abort_xfer(usbd_xfer_handle xfer, usbd_status status)
   2273       1.10  augustss {
   2274       1.26  augustss #define exfer EXFER(xfer)
   2275       1.10  augustss 	struct ehci_pipe *epipe = (struct ehci_pipe *)xfer->pipe;
   2276       1.17  augustss 	ehci_softc_t *sc = (ehci_softc_t *)epipe->pipe.device->bus;
   2277       1.26  augustss 	ehci_soft_qh_t *sqh = epipe->sqh;
   2278       1.26  augustss 	ehci_soft_qtd_t *sqtd;
   2279       1.26  augustss 	ehci_physaddr_t cur;
   2280       1.26  augustss 	u_int32_t qhstatus;
   2281       1.11  augustss 	int s;
   2282       1.26  augustss 	int hit;
   2283       1.10  augustss 
   2284       1.24  augustss 	DPRINTF(("ehci_abort_xfer: xfer=%p pipe=%p\n", xfer, epipe));
   2285       1.10  augustss 
   2286       1.17  augustss 	if (sc->sc_dying) {
   2287       1.17  augustss 		/* If we're dying, just do the software part. */
   2288       1.17  augustss 		s = splusb();
   2289       1.17  augustss 		xfer->status = status;	/* make software ignore it */
   2290       1.17  augustss 		usb_uncallout(xfer->timeout_handle, ehci_timeout, xfer);
   2291       1.17  augustss 		usb_transfer_complete(xfer);
   2292       1.17  augustss 		splx(s);
   2293       1.17  augustss 		return;
   2294       1.17  augustss 	}
   2295       1.17  augustss 
   2296       1.10  augustss 	if (xfer->device->bus->intr_context || !curproc)
   2297       1.37    provos 		panic("ehci_abort_xfer: not in process context");
   2298       1.10  augustss 
   2299       1.11  augustss 	/*
   2300       1.11  augustss 	 * Step 1: Make interrupt routine and hardware ignore xfer.
   2301       1.11  augustss 	 */
   2302       1.11  augustss 	s = splusb();
   2303       1.11  augustss 	xfer->status = status;	/* make software ignore it */
   2304       1.15  augustss 	usb_uncallout(xfer->timeout_handle, ehci_timeout, xfer);
   2305       1.26  augustss 	qhstatus = sqh->qh.qh_qtd.qtd_status;
   2306       1.26  augustss 	sqh->qh.qh_qtd.qtd_status = qhstatus | htole32(EHCI_QTD_HALTED);
   2307       1.26  augustss 	for (sqtd = exfer->sqtdstart; ; sqtd = sqtd->nextqtd) {
   2308       1.26  augustss 		sqtd->qtd.qtd_status |= htole32(EHCI_QTD_HALTED);
   2309       1.26  augustss 		if (sqtd == exfer->sqtdend)
   2310       1.26  augustss 			break;
   2311       1.26  augustss 	}
   2312       1.11  augustss 	splx(s);
   2313       1.11  augustss 
   2314       1.33  augustss 	/*
   2315       1.11  augustss 	 * Step 2: Wait until we know hardware has finished any possible
   2316       1.11  augustss 	 * use of the xfer.  Also make sure the soft interrupt routine
   2317       1.11  augustss 	 * has run.
   2318       1.11  augustss 	 */
   2319       1.26  augustss 	ehci_sync_hc(sc);
   2320       1.29  augustss 	s = splusb();
   2321       1.29  augustss 	sc->sc_softwake = 1;
   2322       1.29  augustss 	usb_schedsoftintr(&sc->sc_bus);
   2323       1.29  augustss 	tsleep(&sc->sc_softwake, PZERO, "ehciab", 0);
   2324       1.29  augustss 	splx(s);
   2325       1.33  augustss 
   2326       1.33  augustss 	/*
   2327       1.11  augustss 	 * Step 3: Remove any vestiges of the xfer from the hardware.
   2328       1.11  augustss 	 * The complication here is that the hardware may have executed
   2329       1.11  augustss 	 * beyond the xfer we're trying to abort.  So as we're scanning
   2330       1.11  augustss 	 * the TDs of this xfer we check if the hardware points to
   2331       1.11  augustss 	 * any of them.
   2332       1.11  augustss 	 */
   2333       1.11  augustss 	s = splusb();		/* XXX why? */
   2334       1.26  augustss 	cur = EHCI_LINK_ADDR(le32toh(sqh->qh.qh_curqtd));
   2335       1.26  augustss 	hit = 0;
   2336       1.26  augustss 	for (sqtd = exfer->sqtdstart; ; sqtd = sqtd->nextqtd) {
   2337       1.26  augustss 		hit |= cur == sqtd->physaddr;
   2338       1.26  augustss 		if (sqtd == exfer->sqtdend)
   2339       1.26  augustss 			break;
   2340       1.26  augustss 	}
   2341       1.26  augustss 	sqtd = sqtd->nextqtd;
   2342       1.26  augustss 	/* Zap curqtd register if hardware pointed inside the xfer. */
   2343       1.26  augustss 	if (hit && sqtd != NULL) {
   2344       1.26  augustss 		DPRINTFN(1,("ehci_abort_xfer: cur=0x%08x\n", sqtd->physaddr));
   2345       1.26  augustss 		sqh->qh.qh_curqtd = htole32(sqtd->physaddr); /* unlink qTDs */
   2346       1.26  augustss 		sqh->qh.qh_qtd.qtd_status = qhstatus;
   2347       1.26  augustss 	} else {
   2348       1.26  augustss 		DPRINTFN(1,("ehci_abort_xfer: no hit\n"));
   2349       1.26  augustss 	}
   2350       1.11  augustss 
   2351       1.11  augustss 	/*
   2352       1.26  augustss 	 * Step 4: Execute callback.
   2353       1.11  augustss 	 */
   2354       1.18  augustss #ifdef DIAGNOSTIC
   2355       1.26  augustss 	exfer->isdone = 1;
   2356       1.18  augustss #endif
   2357       1.11  augustss 	usb_transfer_complete(xfer);
   2358       1.11  augustss 
   2359       1.11  augustss 	splx(s);
   2360       1.26  augustss #undef exfer
   2361       1.10  augustss }
   2362       1.10  augustss 
   2363       1.15  augustss void
   2364       1.15  augustss ehci_timeout(void *addr)
   2365       1.15  augustss {
   2366       1.15  augustss 	struct ehci_xfer *exfer = addr;
   2367       1.17  augustss 	struct ehci_pipe *epipe = (struct ehci_pipe *)exfer->xfer.pipe;
   2368       1.17  augustss 	ehci_softc_t *sc = (ehci_softc_t *)epipe->pipe.device->bus;
   2369       1.15  augustss 
   2370       1.15  augustss 	DPRINTF(("ehci_timeout: exfer=%p\n", exfer));
   2371       1.22  augustss #ifdef USB_DEBUG
   2372       1.26  augustss 	if (ehcidebug > 1)
   2373       1.22  augustss 		usbd_dump_pipe(exfer->xfer.pipe);
   2374       1.22  augustss #endif
   2375       1.15  augustss 
   2376       1.17  augustss 	if (sc->sc_dying) {
   2377       1.17  augustss 		ehci_abort_xfer(&exfer->xfer, USBD_TIMEOUT);
   2378       1.17  augustss 		return;
   2379       1.17  augustss 	}
   2380       1.17  augustss 
   2381       1.15  augustss 	/* Execute the abort in a process context. */
   2382       1.15  augustss 	usb_init_task(&exfer->abort_task, ehci_timeout_task, addr);
   2383       1.15  augustss 	usb_add_task(exfer->xfer.pipe->device, &exfer->abort_task);
   2384       1.15  augustss }
   2385       1.15  augustss 
   2386       1.15  augustss void
   2387       1.15  augustss ehci_timeout_task(void *addr)
   2388       1.15  augustss {
   2389       1.15  augustss 	usbd_xfer_handle xfer = addr;
   2390       1.15  augustss 	int s;
   2391       1.15  augustss 
   2392       1.15  augustss 	DPRINTF(("ehci_timeout_task: xfer=%p\n", xfer));
   2393       1.15  augustss 
   2394       1.15  augustss 	s = splusb();
   2395       1.15  augustss 	ehci_abort_xfer(xfer, USBD_TIMEOUT);
   2396       1.15  augustss 	splx(s);
   2397       1.15  augustss }
   2398       1.15  augustss 
   2399        1.5  augustss /************************/
   2400        1.5  augustss 
   2401       1.10  augustss Static usbd_status
   2402       1.10  augustss ehci_device_ctrl_transfer(usbd_xfer_handle xfer)
   2403       1.10  augustss {
   2404       1.10  augustss 	usbd_status err;
   2405       1.10  augustss 
   2406       1.10  augustss 	/* Insert last in queue. */
   2407       1.10  augustss 	err = usb_insert_transfer(xfer);
   2408       1.10  augustss 	if (err)
   2409       1.10  augustss 		return (err);
   2410       1.10  augustss 
   2411       1.10  augustss 	/* Pipe isn't running, start first */
   2412       1.10  augustss 	return (ehci_device_ctrl_start(SIMPLEQ_FIRST(&xfer->pipe->queue)));
   2413       1.10  augustss }
   2414       1.10  augustss 
   2415       1.12  augustss Static usbd_status
   2416       1.12  augustss ehci_device_ctrl_start(usbd_xfer_handle xfer)
   2417       1.12  augustss {
   2418       1.15  augustss 	ehci_softc_t *sc = (ehci_softc_t *)xfer->pipe->device->bus;
   2419       1.15  augustss 	usbd_status err;
   2420       1.15  augustss 
   2421       1.15  augustss 	if (sc->sc_dying)
   2422       1.15  augustss 		return (USBD_IOERROR);
   2423       1.15  augustss 
   2424       1.15  augustss #ifdef DIAGNOSTIC
   2425       1.15  augustss 	if (!(xfer->rqflags & URQ_REQUEST)) {
   2426       1.15  augustss 		/* XXX panic */
   2427       1.15  augustss 		printf("ehci_device_ctrl_transfer: not a request\n");
   2428       1.15  augustss 		return (USBD_INVAL);
   2429       1.15  augustss 	}
   2430       1.15  augustss #endif
   2431       1.15  augustss 
   2432       1.15  augustss 	err = ehci_device_request(xfer);
   2433       1.15  augustss 	if (err)
   2434       1.15  augustss 		return (err);
   2435       1.15  augustss 
   2436       1.15  augustss 	if (sc->sc_bus.use_polling)
   2437       1.15  augustss 		ehci_waitintr(sc, xfer);
   2438       1.15  augustss 	return (USBD_IN_PROGRESS);
   2439       1.12  augustss }
   2440       1.10  augustss 
   2441       1.10  augustss void
   2442       1.10  augustss ehci_device_ctrl_done(usbd_xfer_handle xfer)
   2443       1.10  augustss {
   2444       1.18  augustss 	struct ehci_xfer *ex = EXFER(xfer);
   2445       1.18  augustss 	ehci_softc_t *sc = (ehci_softc_t *)xfer->pipe->device->bus;
   2446       1.25  augustss 	/*struct ehci_pipe *epipe = (struct ehci_pipe *)xfer->pipe;*/
   2447       1.18  augustss 
   2448       1.10  augustss 	DPRINTFN(10,("ehci_ctrl_done: xfer=%p\n", xfer));
   2449       1.10  augustss 
   2450       1.10  augustss #ifdef DIAGNOSTIC
   2451       1.10  augustss 	if (!(xfer->rqflags & URQ_REQUEST)) {
   2452       1.37    provos 		panic("ehci_ctrl_done: not a request");
   2453       1.10  augustss 	}
   2454       1.10  augustss #endif
   2455       1.18  augustss 
   2456       1.44  augustss 	if (xfer->status != USBD_NOMEM && ehci_active_intr_list(ex)) {
   2457       1.25  augustss 		ehci_del_intr_list(ex);	/* remove from active list */
   2458       1.25  augustss 		ehci_free_sqtd_chain(sc, ex->sqtdstart, NULL);
   2459       1.25  augustss 	}
   2460       1.18  augustss 
   2461       1.25  augustss 	DPRINTFN(5, ("ehci_ctrl_done: length=%d\n", xfer->actlen));
   2462       1.10  augustss }
   2463       1.10  augustss 
   2464       1.10  augustss /* Abort a device control request. */
   2465       1.10  augustss Static void
   2466       1.10  augustss ehci_device_ctrl_abort(usbd_xfer_handle xfer)
   2467       1.10  augustss {
   2468       1.10  augustss 	DPRINTF(("ehci_device_ctrl_abort: xfer=%p\n", xfer));
   2469       1.10  augustss 	ehci_abort_xfer(xfer, USBD_CANCELLED);
   2470       1.10  augustss }
   2471       1.10  augustss 
   2472       1.10  augustss /* Close a device control pipe. */
   2473       1.10  augustss Static void
   2474       1.10  augustss ehci_device_ctrl_close(usbd_pipe_handle pipe)
   2475       1.10  augustss {
   2476       1.10  augustss 	ehci_softc_t *sc = (ehci_softc_t *)pipe->device->bus;
   2477       1.10  augustss 	/*struct ehci_pipe *epipe = (struct ehci_pipe *)pipe;*/
   2478       1.10  augustss 
   2479       1.10  augustss 	DPRINTF(("ehci_device_ctrl_close: pipe=%p\n", pipe));
   2480       1.11  augustss 	ehci_close_pipe(pipe, sc->sc_async_head);
   2481       1.15  augustss }
   2482       1.15  augustss 
   2483       1.15  augustss usbd_status
   2484       1.15  augustss ehci_device_request(usbd_xfer_handle xfer)
   2485       1.15  augustss {
   2486       1.18  augustss #define exfer EXFER(xfer)
   2487       1.15  augustss 	struct ehci_pipe *epipe = (struct ehci_pipe *)xfer->pipe;
   2488       1.15  augustss 	usb_device_request_t *req = &xfer->request;
   2489       1.15  augustss 	usbd_device_handle dev = epipe->pipe.device;
   2490       1.15  augustss 	ehci_softc_t *sc = (ehci_softc_t *)dev->bus;
   2491       1.15  augustss 	int addr = dev->address;
   2492       1.15  augustss 	ehci_soft_qtd_t *setup, *stat, *next;
   2493       1.15  augustss 	ehci_soft_qh_t *sqh;
   2494       1.15  augustss 	int isread;
   2495       1.15  augustss 	int len;
   2496       1.15  augustss 	usbd_status err;
   2497       1.15  augustss 	int s;
   2498       1.15  augustss 
   2499       1.15  augustss 	isread = req->bmRequestType & UT_READ;
   2500       1.15  augustss 	len = UGETW(req->wLength);
   2501       1.15  augustss 
   2502       1.15  augustss 	DPRINTFN(3,("ehci_device_control type=0x%02x, request=0x%02x, "
   2503       1.15  augustss 		    "wValue=0x%04x, wIndex=0x%04x len=%d, addr=%d, endpt=%d\n",
   2504       1.15  augustss 		    req->bmRequestType, req->bRequest, UGETW(req->wValue),
   2505       1.33  augustss 		    UGETW(req->wIndex), len, addr,
   2506       1.15  augustss 		    epipe->pipe.endpoint->edesc->bEndpointAddress));
   2507       1.15  augustss 
   2508       1.15  augustss 	setup = ehci_alloc_sqtd(sc);
   2509       1.15  augustss 	if (setup == NULL) {
   2510       1.15  augustss 		err = USBD_NOMEM;
   2511       1.15  augustss 		goto bad1;
   2512       1.15  augustss 	}
   2513       1.15  augustss 	stat = ehci_alloc_sqtd(sc);
   2514       1.15  augustss 	if (stat == NULL) {
   2515       1.15  augustss 		err = USBD_NOMEM;
   2516       1.15  augustss 		goto bad2;
   2517       1.15  augustss 	}
   2518       1.15  augustss 
   2519       1.15  augustss 	sqh = epipe->sqh;
   2520       1.15  augustss 	epipe->u.ctl.length = len;
   2521       1.15  augustss 
   2522   1.54.2.8      tron 	/* Update device address and length since they may have changed
   2523   1.54.2.8      tron 	   during the setup of the control pipe in usbd_new_device(). */
   2524       1.15  augustss 	/* XXX This only needs to be done once, but it's too early in open. */
   2525       1.15  augustss 	/* XXXX Should not touch ED here! */
   2526       1.33  augustss 	sqh->qh.qh_endp =
   2527   1.54.2.1      tron 	    (sqh->qh.qh_endp & htole32(~(EHCI_QH_ADDRMASK | EHCI_QH_MPLMASK))) |
   2528       1.15  augustss 	    htole32(
   2529       1.15  augustss 	     EHCI_QH_SET_ADDR(addr) |
   2530       1.15  augustss 	     EHCI_QH_SET_MPL(UGETW(epipe->pipe.endpoint->edesc->wMaxPacketSize))
   2531       1.15  augustss 	    );
   2532       1.15  augustss 
   2533       1.15  augustss 	/* Set up data transaction */
   2534       1.15  augustss 	if (len != 0) {
   2535       1.15  augustss 		ehci_soft_qtd_t *end;
   2536       1.15  augustss 
   2537   1.54.2.1      tron 		/* Start toggle at 1. */
   2538   1.54.2.1      tron 		epipe->nexttoggle = 1;
   2539       1.25  augustss 		err = ehci_alloc_sqtd_chain(epipe, sc, len, isread, xfer,
   2540       1.15  augustss 			  &next, &end);
   2541       1.15  augustss 		if (err)
   2542       1.15  augustss 			goto bad3;
   2543       1.15  augustss 		end->nextqtd = stat;
   2544       1.33  augustss 		end->qtd.qtd_next =
   2545       1.15  augustss 		end->qtd.qtd_altnext = htole32(stat->physaddr);
   2546       1.15  augustss 	} else {
   2547       1.15  augustss 		next = stat;
   2548       1.15  augustss 	}
   2549       1.15  augustss 
   2550       1.30  augustss 	memcpy(KERNADDR(&epipe->u.ctl.reqdma, 0), req, sizeof *req);
   2551       1.15  augustss 
   2552   1.54.2.1      tron 	/* Clear toggle */
   2553       1.15  augustss 	setup->qtd.qtd_status = htole32(
   2554       1.26  augustss 	    EHCI_QTD_ACTIVE |
   2555       1.15  augustss 	    EHCI_QTD_SET_PID(EHCI_QTD_PID_SETUP) |
   2556       1.15  augustss 	    EHCI_QTD_SET_CERR(3) |
   2557  1.54.2.10      tron 	    EHCI_QTD_SET_TOGGLE(0) |
   2558       1.15  augustss 	    EHCI_QTD_SET_BYTES(sizeof *req)
   2559       1.15  augustss 	    );
   2560       1.31  augustss 	setup->qtd.qtd_buffer[0] = htole32(DMAADDR(&epipe->u.ctl.reqdma, 0));
   2561       1.48   mycroft 	setup->qtd.qtd_buffer_hi[0] = 0;
   2562       1.15  augustss 	setup->nextqtd = next;
   2563       1.15  augustss 	setup->qtd.qtd_next = setup->qtd.qtd_altnext = htole32(next->physaddr);
   2564       1.15  augustss 	setup->xfer = xfer;
   2565       1.18  augustss 	setup->len = sizeof *req;
   2566       1.15  augustss 
   2567       1.15  augustss 	stat->qtd.qtd_status = htole32(
   2568       1.26  augustss 	    EHCI_QTD_ACTIVE |
   2569       1.15  augustss 	    EHCI_QTD_SET_PID(isread ? EHCI_QTD_PID_OUT : EHCI_QTD_PID_IN) |
   2570       1.15  augustss 	    EHCI_QTD_SET_CERR(3) |
   2571  1.54.2.10      tron 	    EHCI_QTD_SET_TOGGLE(1) |
   2572       1.15  augustss 	    EHCI_QTD_IOC
   2573       1.15  augustss 	    );
   2574       1.15  augustss 	stat->qtd.qtd_buffer[0] = 0; /* XXX not needed? */
   2575       1.48   mycroft 	stat->qtd.qtd_buffer_hi[0] = 0; /* XXX not needed? */
   2576       1.15  augustss 	stat->nextqtd = NULL;
   2577       1.15  augustss 	stat->qtd.qtd_next = stat->qtd.qtd_altnext = EHCI_NULL;
   2578       1.15  augustss 	stat->xfer = xfer;
   2579       1.18  augustss 	stat->len = 0;
   2580       1.15  augustss 
   2581       1.15  augustss #ifdef EHCI_DEBUG
   2582       1.23  augustss 	if (ehcidebug > 5) {
   2583       1.15  augustss 		DPRINTF(("ehci_device_request:\n"));
   2584       1.15  augustss 		ehci_dump_sqh(sqh);
   2585       1.15  augustss 		ehci_dump_sqtds(setup);
   2586       1.15  augustss 	}
   2587       1.15  augustss #endif
   2588       1.15  augustss 
   2589       1.18  augustss 	exfer->sqtdstart = setup;
   2590       1.18  augustss 	exfer->sqtdend = stat;
   2591       1.18  augustss #ifdef DIAGNOSTIC
   2592       1.18  augustss 	if (!exfer->isdone) {
   2593       1.18  augustss 		printf("ehci_device_request: not done, exfer=%p\n", exfer);
   2594       1.18  augustss 	}
   2595       1.18  augustss 	exfer->isdone = 0;
   2596       1.18  augustss #endif
   2597       1.18  augustss 
   2598       1.15  augustss 	/* Insert qTD in QH list. */
   2599       1.15  augustss 	s = splusb();
   2600       1.23  augustss 	ehci_set_qh_qtd(sqh, setup);
   2601       1.15  augustss 	if (xfer->timeout && !sc->sc_bus.use_polling) {
   2602       1.45   tsutsui                 usb_callout(xfer->timeout_handle, mstohz(xfer->timeout),
   2603       1.15  augustss 			    ehci_timeout, xfer);
   2604       1.15  augustss 	}
   2605       1.18  augustss 	ehci_add_intr_list(sc, exfer);
   2606       1.18  augustss 	xfer->status = USBD_IN_PROGRESS;
   2607       1.15  augustss 	splx(s);
   2608       1.15  augustss 
   2609       1.17  augustss #ifdef EHCI_DEBUG
   2610       1.15  augustss 	if (ehcidebug > 10) {
   2611       1.15  augustss 		DPRINTF(("ehci_device_request: status=%x\n",
   2612       1.15  augustss 			 EOREAD4(sc, EHCI_USBSTS)));
   2613       1.23  augustss 		delay(10000);
   2614       1.18  augustss 		ehci_dump_regs(sc);
   2615       1.15  augustss 		ehci_dump_sqh(sc->sc_async_head);
   2616       1.15  augustss 		ehci_dump_sqh(sqh);
   2617       1.15  augustss 		ehci_dump_sqtds(setup);
   2618       1.15  augustss 	}
   2619       1.15  augustss #endif
   2620       1.15  augustss 
   2621       1.15  augustss 	return (USBD_NORMAL_COMPLETION);
   2622       1.15  augustss 
   2623       1.15  augustss  bad3:
   2624       1.15  augustss 	ehci_free_sqtd(sc, stat);
   2625       1.15  augustss  bad2:
   2626       1.15  augustss 	ehci_free_sqtd(sc, setup);
   2627       1.15  augustss  bad1:
   2628       1.25  augustss 	DPRINTFN(-1,("ehci_device_request: no memory\n"));
   2629       1.25  augustss 	xfer->status = err;
   2630       1.25  augustss 	usb_transfer_complete(xfer);
   2631       1.15  augustss 	return (err);
   2632       1.18  augustss #undef exfer
   2633       1.10  augustss }
   2634       1.10  augustss 
   2635       1.10  augustss /************************/
   2636        1.5  augustss 
   2637       1.19  augustss Static usbd_status
   2638       1.19  augustss ehci_device_bulk_transfer(usbd_xfer_handle xfer)
   2639       1.19  augustss {
   2640       1.19  augustss 	usbd_status err;
   2641       1.19  augustss 
   2642       1.19  augustss 	/* Insert last in queue. */
   2643       1.19  augustss 	err = usb_insert_transfer(xfer);
   2644       1.19  augustss 	if (err)
   2645       1.19  augustss 		return (err);
   2646       1.19  augustss 
   2647       1.19  augustss 	/* Pipe isn't running, start first */
   2648       1.19  augustss 	return (ehci_device_bulk_start(SIMPLEQ_FIRST(&xfer->pipe->queue)));
   2649       1.19  augustss }
   2650       1.19  augustss 
   2651       1.19  augustss usbd_status
   2652       1.19  augustss ehci_device_bulk_start(usbd_xfer_handle xfer)
   2653       1.19  augustss {
   2654       1.19  augustss #define exfer EXFER(xfer)
   2655       1.19  augustss 	struct ehci_pipe *epipe = (struct ehci_pipe *)xfer->pipe;
   2656       1.19  augustss 	usbd_device_handle dev = epipe->pipe.device;
   2657       1.19  augustss 	ehci_softc_t *sc = (ehci_softc_t *)dev->bus;
   2658       1.19  augustss 	ehci_soft_qtd_t *data, *dataend;
   2659       1.19  augustss 	ehci_soft_qh_t *sqh;
   2660       1.19  augustss 	usbd_status err;
   2661       1.19  augustss 	int len, isread, endpt;
   2662       1.19  augustss 	int s;
   2663       1.19  augustss 
   2664       1.22  augustss 	DPRINTFN(2, ("ehci_device_bulk_transfer: xfer=%p len=%d flags=%d\n",
   2665       1.19  augustss 		     xfer, xfer->length, xfer->flags));
   2666       1.19  augustss 
   2667       1.19  augustss 	if (sc->sc_dying)
   2668       1.19  augustss 		return (USBD_IOERROR);
   2669       1.19  augustss 
   2670       1.19  augustss #ifdef DIAGNOSTIC
   2671       1.19  augustss 	if (xfer->rqflags & URQ_REQUEST)
   2672       1.37    provos 		panic("ehci_device_bulk_transfer: a request");
   2673       1.19  augustss #endif
   2674       1.19  augustss 
   2675       1.19  augustss 	len = xfer->length;
   2676       1.19  augustss 	endpt = epipe->pipe.endpoint->edesc->bEndpointAddress;
   2677       1.19  augustss 	isread = UE_GET_DIR(endpt) == UE_DIR_IN;
   2678       1.19  augustss 	sqh = epipe->sqh;
   2679       1.19  augustss 
   2680       1.19  augustss 	epipe->u.bulk.length = len;
   2681       1.19  augustss 
   2682       1.25  augustss 	err = ehci_alloc_sqtd_chain(epipe, sc, len, isread, xfer, &data,
   2683       1.19  augustss 				   &dataend);
   2684       1.25  augustss 	if (err) {
   2685       1.25  augustss 		DPRINTFN(-1,("ehci_device_bulk_transfer: no memory\n"));
   2686       1.25  augustss 		xfer->status = err;
   2687       1.25  augustss 		usb_transfer_complete(xfer);
   2688       1.19  augustss 		return (err);
   2689       1.25  augustss 	}
   2690       1.19  augustss 
   2691       1.19  augustss #ifdef EHCI_DEBUG
   2692       1.23  augustss 	if (ehcidebug > 5) {
   2693       1.19  augustss 		DPRINTF(("ehci_device_bulk_transfer: data(1)\n"));
   2694       1.23  augustss 		ehci_dump_sqh(sqh);
   2695       1.19  augustss 		ehci_dump_sqtds(data);
   2696       1.19  augustss 	}
   2697       1.19  augustss #endif
   2698       1.19  augustss 
   2699       1.19  augustss 	/* Set up interrupt info. */
   2700       1.19  augustss 	exfer->sqtdstart = data;
   2701       1.19  augustss 	exfer->sqtdend = dataend;
   2702       1.19  augustss #ifdef DIAGNOSTIC
   2703       1.19  augustss 	if (!exfer->isdone) {
   2704       1.19  augustss 		printf("ehci_device_bulk_transfer: not done, ex=%p\n", exfer);
   2705       1.19  augustss 	}
   2706       1.19  augustss 	exfer->isdone = 0;
   2707       1.19  augustss #endif
   2708       1.19  augustss 
   2709       1.19  augustss 	s = splusb();
   2710       1.23  augustss 	ehci_set_qh_qtd(sqh, data);
   2711       1.19  augustss 	if (xfer->timeout && !sc->sc_bus.use_polling) {
   2712       1.45   tsutsui 		usb_callout(xfer->timeout_handle, mstohz(xfer->timeout),
   2713       1.19  augustss 			    ehci_timeout, xfer);
   2714       1.19  augustss 	}
   2715       1.19  augustss 	ehci_add_intr_list(sc, exfer);
   2716       1.19  augustss 	xfer->status = USBD_IN_PROGRESS;
   2717       1.19  augustss 	splx(s);
   2718       1.19  augustss 
   2719       1.19  augustss #ifdef EHCI_DEBUG
   2720       1.19  augustss 	if (ehcidebug > 10) {
   2721       1.19  augustss 		DPRINTF(("ehci_device_bulk_transfer: data(2)\n"));
   2722       1.23  augustss 		delay(10000);
   2723       1.29  augustss 		DPRINTF(("ehci_device_bulk_transfer: data(3)\n"));
   2724       1.23  augustss 		ehci_dump_regs(sc);
   2725       1.29  augustss #if 0
   2726       1.29  augustss 		printf("async_head:\n");
   2727       1.23  augustss 		ehci_dump_sqh(sc->sc_async_head);
   2728       1.29  augustss #endif
   2729       1.29  augustss 		printf("sqh:\n");
   2730       1.23  augustss 		ehci_dump_sqh(sqh);
   2731       1.19  augustss 		ehci_dump_sqtds(data);
   2732       1.19  augustss 	}
   2733       1.19  augustss #endif
   2734       1.19  augustss 
   2735       1.19  augustss 	if (sc->sc_bus.use_polling)
   2736       1.19  augustss 		ehci_waitintr(sc, xfer);
   2737       1.19  augustss 
   2738       1.19  augustss 	return (USBD_IN_PROGRESS);
   2739       1.19  augustss #undef exfer
   2740       1.19  augustss }
   2741       1.19  augustss 
   2742       1.19  augustss Static void
   2743       1.19  augustss ehci_device_bulk_abort(usbd_xfer_handle xfer)
   2744       1.19  augustss {
   2745       1.19  augustss 	DPRINTF(("ehci_device_bulk_abort: xfer=%p\n", xfer));
   2746       1.19  augustss 	ehci_abort_xfer(xfer, USBD_CANCELLED);
   2747       1.19  augustss }
   2748       1.19  augustss 
   2749       1.33  augustss /*
   2750       1.19  augustss  * Close a device bulk pipe.
   2751       1.19  augustss  */
   2752       1.19  augustss Static void
   2753       1.19  augustss ehci_device_bulk_close(usbd_pipe_handle pipe)
   2754       1.19  augustss {
   2755       1.19  augustss 	ehci_softc_t *sc = (ehci_softc_t *)pipe->device->bus;
   2756       1.19  augustss 
   2757       1.19  augustss 	DPRINTF(("ehci_device_bulk_close: pipe=%p\n", pipe));
   2758       1.19  augustss 	ehci_close_pipe(pipe, sc->sc_async_head);
   2759       1.19  augustss }
   2760       1.19  augustss 
   2761       1.19  augustss void
   2762       1.19  augustss ehci_device_bulk_done(usbd_xfer_handle xfer)
   2763       1.19  augustss {
   2764       1.19  augustss 	struct ehci_xfer *ex = EXFER(xfer);
   2765       1.19  augustss 	ehci_softc_t *sc = (ehci_softc_t *)xfer->pipe->device->bus;
   2766       1.19  augustss 	/*struct ehci_pipe *epipe = (struct ehci_pipe *)xfer->pipe;*/
   2767       1.19  augustss 
   2768       1.33  augustss 	DPRINTFN(10,("ehci_bulk_done: xfer=%p, actlen=%d\n",
   2769       1.19  augustss 		     xfer, xfer->actlen));
   2770       1.19  augustss 
   2771       1.44  augustss 	if (xfer->status != USBD_NOMEM && ehci_active_intr_list(ex)) {
   2772       1.25  augustss 		ehci_del_intr_list(ex);	/* remove from active list */
   2773       1.44  augustss 		ehci_free_sqtd_chain(sc, ex->sqtdstart, NULL);
   2774       1.25  augustss 	}
   2775       1.19  augustss 
   2776       1.19  augustss 	DPRINTFN(5, ("ehci_bulk_done: length=%d\n", xfer->actlen));
   2777       1.19  augustss }
   2778        1.5  augustss 
   2779       1.10  augustss /************************/
   2780       1.10  augustss 
   2781        1.5  augustss Static usbd_status	ehci_device_intr_transfer(usbd_xfer_handle xfer) { return USBD_IOERROR; }
   2782        1.5  augustss Static usbd_status	ehci_device_intr_start(usbd_xfer_handle xfer) { return USBD_IOERROR; }
   2783        1.5  augustss Static void		ehci_device_intr_abort(usbd_xfer_handle xfer) { }
   2784        1.5  augustss Static void		ehci_device_intr_close(usbd_pipe_handle pipe) { }
   2785        1.5  augustss Static void		ehci_device_intr_done(usbd_xfer_handle xfer) { }
   2786       1.10  augustss 
   2787       1.10  augustss /************************/
   2788        1.5  augustss 
   2789        1.5  augustss Static usbd_status	ehci_device_isoc_transfer(usbd_xfer_handle xfer) { return USBD_IOERROR; }
   2790        1.5  augustss Static usbd_status	ehci_device_isoc_start(usbd_xfer_handle xfer) { return USBD_IOERROR; }
   2791        1.5  augustss Static void		ehci_device_isoc_abort(usbd_xfer_handle xfer) { }
   2792        1.5  augustss Static void		ehci_device_isoc_close(usbd_pipe_handle pipe) { }
   2793        1.5  augustss Static void		ehci_device_isoc_done(usbd_xfer_handle xfer) { }
   2794