Home | History | Annotate | Line # | Download | only in usb
uhci.c revision 1.117
      1  1.117  augustss /*	$NetBSD: uhci.c,v 1.117 2000/05/30 09:26:06 augustss Exp $	*/
      2   1.67  augustss /*	$FreeBSD: src/sys/dev/usb/uhci.c,v 1.33 1999/11/17 22:33:41 n_hibma Exp $	*/
      3    1.1  augustss 
      4    1.1  augustss /*
      5    1.1  augustss  * Copyright (c) 1998 The NetBSD Foundation, Inc.
      6    1.1  augustss  * All rights reserved.
      7    1.1  augustss  *
      8   1.11  augustss  * This code is derived from software contributed to The NetBSD Foundation
      9  1.113  augustss  * by Lennart Augustsson (lennart (at) augustsson.net) at
     10   1.11  augustss  * Carlstedt Research & Technology.
     11    1.1  augustss  *
     12    1.1  augustss  * Redistribution and use in source and binary forms, with or without
     13    1.1  augustss  * modification, are permitted provided that the following conditions
     14    1.1  augustss  * are met:
     15    1.1  augustss  * 1. Redistributions of source code must retain the above copyright
     16    1.1  augustss  *    notice, this list of conditions and the following disclaimer.
     17    1.1  augustss  * 2. Redistributions in binary form must reproduce the above copyright
     18    1.1  augustss  *    notice, this list of conditions and the following disclaimer in the
     19    1.1  augustss  *    documentation and/or other materials provided with the distribution.
     20    1.1  augustss  * 3. All advertising materials mentioning features or use of this software
     21    1.1  augustss  *    must display the following acknowledgement:
     22    1.1  augustss  *        This product includes software developed by the NetBSD
     23    1.1  augustss  *        Foundation, Inc. and its contributors.
     24    1.1  augustss  * 4. Neither the name of The NetBSD Foundation nor the names of its
     25    1.1  augustss  *    contributors may be used to endorse or promote products derived
     26    1.1  augustss  *    from this software without specific prior written permission.
     27    1.1  augustss  *
     28    1.1  augustss  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     29    1.1  augustss  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     30    1.1  augustss  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     31    1.1  augustss  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     32    1.1  augustss  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     33    1.1  augustss  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     34    1.1  augustss  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     35    1.1  augustss  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     36    1.1  augustss  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     37    1.1  augustss  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     38    1.1  augustss  * POSSIBILITY OF SUCH DAMAGE.
     39    1.1  augustss  */
     40    1.1  augustss 
     41    1.1  augustss /*
     42    1.1  augustss  * USB Universal Host Controller driver.
     43   1.28  augustss  * Handles e.g. PIIX3 and PIIX4.
     44    1.1  augustss  *
     45    1.1  augustss  * UHCI spec: http://www.intel.com/design/usb/uhci11d.pdf
     46   1.28  augustss  * USB spec: http://www.usb.org/developers/data/usb11.pdf
     47   1.71  augustss  * PIIXn spec: ftp://download.intel.com/design/intarch/datashts/29055002.pdf
     48   1.71  augustss  *             ftp://download.intel.com/design/intarch/datashts/29056201.pdf
     49    1.1  augustss  */
     50    1.1  augustss 
     51    1.1  augustss #include <sys/param.h>
     52    1.1  augustss #include <sys/systm.h>
     53    1.1  augustss #include <sys/kernel.h>
     54    1.1  augustss #include <sys/malloc.h>
     55   1.37  augustss #if defined(__NetBSD__) || defined(__OpenBSD__)
     56    1.1  augustss #include <sys/device.h>
     57   1.67  augustss #include <sys/select.h>
     58   1.13  augustss #elif defined(__FreeBSD__)
     59   1.13  augustss #include <sys/module.h>
     60   1.13  augustss #include <sys/bus.h>
     61   1.67  augustss #include <machine/bus_pio.h>
     62   1.67  augustss #if defined(DIAGNOSTIC) && defined(__i386__)
     63   1.67  augustss #include <machine/cpu.h>
     64   1.67  augustss #endif
     65   1.13  augustss #endif
     66    1.1  augustss #include <sys/proc.h>
     67    1.1  augustss #include <sys/queue.h>
     68    1.1  augustss 
     69    1.7  augustss #include <machine/bus.h>
     70   1.39  augustss #include <machine/endian.h>
     71    1.7  augustss 
     72    1.1  augustss #include <dev/usb/usb.h>
     73    1.1  augustss #include <dev/usb/usbdi.h>
     74    1.1  augustss #include <dev/usb/usbdivar.h>
     75    1.7  augustss #include <dev/usb/usb_mem.h>
     76    1.1  augustss #include <dev/usb/usb_quirks.h>
     77    1.1  augustss 
     78    1.1  augustss #include <dev/usb/uhcireg.h>
     79    1.1  augustss #include <dev/usb/uhcivar.h>
     80    1.1  augustss 
     81   1.13  augustss #if defined(__FreeBSD__)
     82   1.13  augustss #include <machine/clock.h>
     83   1.13  augustss 
     84   1.13  augustss #define delay(d)		DELAY(d)
     85   1.13  augustss #endif
     86   1.13  augustss 
     87    1.1  augustss #define MS_TO_TICKS(ms) ((ms) * hz / 1000)
     88    1.1  augustss 
     89   1.37  augustss #if defined(__OpenBSD__)
     90   1.37  augustss struct cfdriver uhci_cd = {
     91   1.37  augustss 	NULL, "uhci", DV_DULL
     92   1.37  augustss };
     93   1.37  augustss #endif
     94   1.37  augustss 
     95   1.67  augustss #ifdef UHCI_DEBUG
     96   1.92  augustss uhci_softc_t *thesc;
     97   1.59  augustss #define DPRINTF(x)	if (uhcidebug) printf x
     98   1.59  augustss #define DPRINTFN(n,x)	if (uhcidebug>(n)) printf x
     99   1.67  augustss int uhcidebug = 0;
    100   1.59  augustss #else
    101   1.59  augustss #define DPRINTF(x)
    102   1.59  augustss #define DPRINTFN(n,x)
    103   1.59  augustss #endif
    104   1.59  augustss 
    105   1.39  augustss /*
    106   1.39  augustss  * The UHCI controller is little endian, so on big endian machines
    107   1.39  augustss  * the data strored in memory needs to be swapped.
    108   1.39  augustss  */
    109  1.107  augustss #if defined(__FreeBSD__) || defined(__OpenBSD__)
    110   1.39  augustss #if BYTE_ORDER == BIG_ENDIAN
    111   1.88   tsutsui #define htole32(x) (bswap32(x))
    112   1.88   tsutsui #define le32toh(x) (bswap32(x))
    113   1.39  augustss #else
    114   1.88   tsutsui #define htole32(x) (x)
    115   1.88   tsutsui #define le32toh(x) (x)
    116   1.88   tsutsui #endif
    117   1.39  augustss #endif
    118   1.39  augustss 
    119    1.1  augustss struct uhci_pipe {
    120    1.1  augustss 	struct usbd_pipe pipe;
    121   1.32  augustss 	int nexttoggle;
    122   1.92  augustss 
    123   1.92  augustss 	u_char aborting;
    124   1.92  augustss 	usbd_xfer_handle abortstart, abortend;
    125   1.92  augustss 
    126    1.1  augustss 	/* Info needed for different pipe kinds. */
    127    1.1  augustss 	union {
    128    1.1  augustss 		/* Control pipe */
    129    1.1  augustss 		struct {
    130    1.1  augustss 			uhci_soft_qh_t *sqh;
    131    1.7  augustss 			usb_dma_t reqdma;
    132   1.16  augustss 			uhci_soft_td_t *setup, *stat;
    133    1.1  augustss 			u_int length;
    134    1.1  augustss 		} ctl;
    135    1.1  augustss 		/* Interrupt pipe */
    136    1.1  augustss 		struct {
    137    1.1  augustss 			int npoll;
    138    1.1  augustss 			uhci_soft_qh_t **qhs;
    139    1.1  augustss 		} intr;
    140    1.1  augustss 		/* Bulk pipe */
    141    1.1  augustss 		struct {
    142    1.1  augustss 			uhci_soft_qh_t *sqh;
    143    1.1  augustss 			u_int length;
    144    1.1  augustss 			int isread;
    145    1.1  augustss 		} bulk;
    146   1.16  augustss 		/* Iso pipe */
    147   1.16  augustss 		struct iso {
    148   1.16  augustss 			uhci_soft_td_t **stds;
    149   1.48  augustss 			int next, inuse;
    150   1.16  augustss 		} iso;
    151    1.1  augustss 	} u;
    152    1.1  augustss };
    153    1.1  augustss 
    154  1.101  augustss Static void		uhci_busreset __P((uhci_softc_t *));
    155  1.101  augustss Static void		uhci_shutdown __P((void *v));
    156  1.101  augustss Static void		uhci_power __P((int, void *));
    157  1.101  augustss Static usbd_status	uhci_run __P((uhci_softc_t *, int run));
    158  1.101  augustss Static uhci_soft_td_t *uhci_alloc_std __P((uhci_softc_t *));
    159  1.101  augustss Static void		uhci_free_std __P((uhci_softc_t *, uhci_soft_td_t *));
    160  1.101  augustss Static uhci_soft_qh_t *uhci_alloc_sqh __P((uhci_softc_t *));
    161  1.101  augustss Static void		uhci_free_sqh __P((uhci_softc_t *, uhci_soft_qh_t *));
    162   1.16  augustss #if 0
    163  1.101  augustss Static void		uhci_enter_ctl_q __P((uhci_softc_t *, uhci_soft_qh_t *,
    164    1.1  augustss 				      uhci_intr_info_t *));
    165  1.101  augustss Static void		uhci_exit_ctl_q __P((uhci_softc_t *, uhci_soft_qh_t *));
    166   1.16  augustss #endif
    167    1.1  augustss 
    168  1.101  augustss Static void		uhci_free_std_chain __P((uhci_softc_t *,
    169    1.1  augustss 					 uhci_soft_td_t *, uhci_soft_td_t *));
    170  1.101  augustss Static usbd_status	uhci_alloc_std_chain __P((struct uhci_pipe *,
    171   1.73  augustss 			    uhci_softc_t *, int, int, u_int16_t, usb_dma_t *,
    172   1.63  augustss 			    uhci_soft_td_t **, uhci_soft_td_t **));
    173  1.101  augustss Static void		uhci_poll_hub __P((void *));
    174  1.101  augustss Static void		uhci_waitintr __P((uhci_softc_t *,
    175   1.63  augustss 			    usbd_xfer_handle));
    176  1.101  augustss Static void		uhci_check_intr __P((uhci_softc_t *,
    177   1.63  augustss 			    uhci_intr_info_t *));
    178  1.101  augustss Static void		uhci_idone __P((uhci_intr_info_t *));
    179   1.92  augustss 
    180  1.101  augustss Static void		uhci_abort_xfer __P((usbd_xfer_handle,
    181   1.63  augustss 			    usbd_status status));
    182  1.101  augustss 
    183  1.101  augustss Static void		uhci_timeout __P((void *));
    184  1.101  augustss Static void		uhci_add_ctrl __P((uhci_softc_t *, uhci_soft_qh_t *));
    185  1.101  augustss Static void		uhci_add_bulk __P((uhci_softc_t *, uhci_soft_qh_t *));
    186  1.101  augustss Static void		uhci_remove_ctrl __P((uhci_softc_t *,uhci_soft_qh_t *));
    187  1.101  augustss Static void		uhci_remove_bulk __P((uhci_softc_t *,uhci_soft_qh_t *));
    188  1.101  augustss Static int		uhci_str __P((usb_string_descriptor_t *, int, char *));
    189   1.68  augustss 
    190  1.101  augustss Static usbd_status	uhci_setup_isoc __P((usbd_pipe_handle pipe));
    191  1.101  augustss Static void		uhci_device_isoc_enter __P((usbd_xfer_handle));
    192   1.63  augustss 
    193  1.101  augustss Static usbd_status	uhci_allocm __P((struct usbd_bus *, usb_dma_t *,
    194   1.63  augustss 			    u_int32_t));
    195  1.101  augustss Static void		uhci_freem __P((struct usbd_bus *, usb_dma_t *));
    196   1.63  augustss 
    197  1.101  augustss Static usbd_xfer_handle	uhci_allocx __P((struct usbd_bus *));
    198  1.101  augustss Static void		uhci_freex __P((struct usbd_bus *, usbd_xfer_handle));
    199   1.76  augustss 
    200  1.101  augustss Static usbd_status	uhci_device_ctrl_transfer __P((usbd_xfer_handle));
    201  1.101  augustss Static usbd_status	uhci_device_ctrl_start __P((usbd_xfer_handle));
    202  1.101  augustss Static void		uhci_device_ctrl_abort __P((usbd_xfer_handle));
    203  1.101  augustss Static void		uhci_device_ctrl_close __P((usbd_pipe_handle));
    204  1.101  augustss Static void		uhci_device_ctrl_done  __P((usbd_xfer_handle));
    205  1.101  augustss 
    206  1.101  augustss Static usbd_status	uhci_device_intr_transfer __P((usbd_xfer_handle));
    207  1.101  augustss Static usbd_status	uhci_device_intr_start __P((usbd_xfer_handle));
    208  1.101  augustss Static void		uhci_device_intr_abort __P((usbd_xfer_handle));
    209  1.101  augustss Static void		uhci_device_intr_close __P((usbd_pipe_handle));
    210  1.101  augustss Static void		uhci_device_intr_done  __P((usbd_xfer_handle));
    211  1.101  augustss 
    212  1.101  augustss Static usbd_status	uhci_device_bulk_transfer __P((usbd_xfer_handle));
    213  1.101  augustss Static usbd_status	uhci_device_bulk_start __P((usbd_xfer_handle));
    214  1.101  augustss Static void		uhci_device_bulk_abort __P((usbd_xfer_handle));
    215  1.101  augustss Static void		uhci_device_bulk_close __P((usbd_pipe_handle));
    216  1.101  augustss Static void		uhci_device_bulk_done  __P((usbd_xfer_handle));
    217  1.101  augustss 
    218  1.101  augustss Static usbd_status	uhci_device_isoc_transfer __P((usbd_xfer_handle));
    219  1.101  augustss Static usbd_status	uhci_device_isoc_start __P((usbd_xfer_handle));
    220  1.101  augustss Static void		uhci_device_isoc_abort __P((usbd_xfer_handle));
    221  1.101  augustss Static void		uhci_device_isoc_close __P((usbd_pipe_handle));
    222  1.101  augustss Static void		uhci_device_isoc_done  __P((usbd_xfer_handle));
    223  1.101  augustss 
    224  1.101  augustss Static usbd_status	uhci_root_ctrl_transfer __P((usbd_xfer_handle));
    225  1.101  augustss Static usbd_status	uhci_root_ctrl_start __P((usbd_xfer_handle));
    226  1.101  augustss Static void		uhci_root_ctrl_abort __P((usbd_xfer_handle));
    227  1.101  augustss Static void		uhci_root_ctrl_close __P((usbd_pipe_handle));
    228  1.101  augustss Static void		uhci_root_ctrl_done  __P((usbd_xfer_handle));
    229  1.101  augustss 
    230  1.101  augustss Static usbd_status	uhci_root_intr_transfer __P((usbd_xfer_handle));
    231  1.101  augustss Static usbd_status	uhci_root_intr_start __P((usbd_xfer_handle));
    232  1.101  augustss Static void		uhci_root_intr_abort __P((usbd_xfer_handle));
    233  1.101  augustss Static void		uhci_root_intr_close __P((usbd_pipe_handle));
    234  1.101  augustss Static void		uhci_root_intr_done  __P((usbd_xfer_handle));
    235  1.101  augustss 
    236  1.101  augustss Static usbd_status	uhci_open __P((usbd_pipe_handle));
    237  1.101  augustss Static void		uhci_poll __P((struct usbd_bus *));
    238  1.101  augustss Static void		uhci_softintr __P((struct usbd_bus *));
    239  1.101  augustss 
    240  1.101  augustss Static usbd_status	uhci_device_request __P((usbd_xfer_handle xfer));
    241  1.101  augustss 
    242  1.101  augustss Static void		uhci_add_intr __P((uhci_softc_t *, uhci_soft_qh_t *));
    243  1.101  augustss Static void		uhci_remove_intr __P((uhci_softc_t*, uhci_soft_qh_t*));
    244  1.101  augustss Static usbd_status	uhci_device_setintr __P((uhci_softc_t *sc,
    245   1.63  augustss 			    struct uhci_pipe *pipe, int ival));
    246    1.1  augustss 
    247  1.101  augustss Static void		uhci_device_clear_toggle __P((usbd_pipe_handle pipe));
    248  1.101  augustss Static void		uhci_noop __P((usbd_pipe_handle pipe));
    249   1.38  augustss 
    250  1.101  augustss Static __inline__ uhci_soft_qh_t *uhci_find_prev_qh
    251   1.92  augustss     __P((uhci_soft_qh_t *, uhci_soft_qh_t *));
    252   1.92  augustss 
    253   1.59  augustss #ifdef UHCI_DEBUG
    254  1.110  augustss Static void		uhci_dump_all __P((uhci_softc_t *));
    255  1.101  augustss Static void		uhci_dumpregs __P((uhci_softc_t *));
    256  1.101  augustss Static void		uhci_dump_qhs __P((uhci_soft_qh_t *));
    257  1.101  augustss Static void		uhci_dump_qh __P((uhci_soft_qh_t *));
    258  1.101  augustss Static void		uhci_dump_tds __P((uhci_soft_td_t *));
    259  1.101  augustss Static void		uhci_dump_td __P((uhci_soft_td_t *));
    260  1.101  augustss Static void		uhci_dump_ii __P((uhci_intr_info_t *ii));
    261  1.116     jhawk void			uhci_dump __P((void));
    262    1.1  augustss #endif
    263    1.1  augustss 
    264  1.112  augustss #define UBARR(sc) bus_space_barrier((sc)->iot, (sc)->ioh, 0, (sc)->sc_size, \
    265  1.112  augustss 			BUS_SPACE_BARRIER_READ|BUS_SPACE_BARRIER_WRITE)
    266  1.112  augustss #define UWRITE1(sc, r, x) \
    267  1.112  augustss  do { UBARR(sc); bus_space_write_1((sc)->iot, (sc)->ioh, (r), (x)); } while (0)
    268  1.112  augustss #define UWRITE2(sc, r, x) \
    269  1.112  augustss  do { UBARR(sc); bus_space_write_2((sc)->iot, (sc)->ioh, (r), (x)); } while (0)
    270  1.112  augustss #define UWRITE4(sc, r, x) \
    271  1.112  augustss  do { UBARR(sc); bus_space_write_4((sc)->iot, (sc)->ioh, (r), (x)); } while (0)
    272  1.112  augustss #define UREAD1(sc, r) (UBARR(sc), bus_space_read_1((sc)->iot, (sc)->ioh, (r)))
    273  1.112  augustss #define UREAD2(sc, r) (UBARR(sc), bus_space_read_2((sc)->iot, (sc)->ioh, (r)))
    274  1.112  augustss #define UREAD4(sc, r) (UBARR(sc), bus_space_read_4((sc)->iot, (sc)->ioh, (r)))
    275    1.1  augustss 
    276    1.1  augustss #define UHCICMD(sc, cmd) UWRITE2(sc, UHCI_CMD, cmd)
    277    1.1  augustss #define UHCISTS(sc) UREAD2(sc, UHCI_STS)
    278    1.1  augustss 
    279    1.1  augustss #define UHCI_RESET_TIMEOUT 100	/* reset timeout */
    280    1.1  augustss 
    281    1.1  augustss #define UHCI_CURFRAME(sc) (UREAD2(sc, UHCI_FRNUM) & UHCI_FRNUM_MASK)
    282    1.1  augustss 
    283    1.1  augustss #define UHCI_INTR_ENDPT 1
    284    1.1  augustss 
    285   1.48  augustss struct usbd_bus_methods uhci_bus_methods = {
    286   1.48  augustss 	uhci_open,
    287   1.85  augustss 	uhci_softintr,
    288   1.48  augustss 	uhci_poll,
    289   1.48  augustss 	uhci_allocm,
    290   1.48  augustss 	uhci_freem,
    291   1.76  augustss 	uhci_allocx,
    292   1.76  augustss 	uhci_freex,
    293   1.48  augustss };
    294   1.48  augustss 
    295   1.48  augustss struct usbd_pipe_methods uhci_root_ctrl_methods = {
    296    1.1  augustss 	uhci_root_ctrl_transfer,
    297   1.16  augustss 	uhci_root_ctrl_start,
    298    1.1  augustss 	uhci_root_ctrl_abort,
    299    1.1  augustss 	uhci_root_ctrl_close,
    300   1.38  augustss 	uhci_noop,
    301   1.84  augustss 	uhci_root_ctrl_done,
    302    1.1  augustss };
    303    1.1  augustss 
    304   1.48  augustss struct usbd_pipe_methods uhci_root_intr_methods = {
    305    1.1  augustss 	uhci_root_intr_transfer,
    306   1.16  augustss 	uhci_root_intr_start,
    307    1.1  augustss 	uhci_root_intr_abort,
    308    1.1  augustss 	uhci_root_intr_close,
    309   1.38  augustss 	uhci_noop,
    310   1.41  augustss 	uhci_root_intr_done,
    311    1.1  augustss };
    312    1.1  augustss 
    313   1.48  augustss struct usbd_pipe_methods uhci_device_ctrl_methods = {
    314    1.1  augustss 	uhci_device_ctrl_transfer,
    315   1.16  augustss 	uhci_device_ctrl_start,
    316    1.1  augustss 	uhci_device_ctrl_abort,
    317    1.1  augustss 	uhci_device_ctrl_close,
    318   1.38  augustss 	uhci_noop,
    319   1.41  augustss 	uhci_device_ctrl_done,
    320    1.1  augustss };
    321    1.1  augustss 
    322   1.48  augustss struct usbd_pipe_methods uhci_device_intr_methods = {
    323    1.1  augustss 	uhci_device_intr_transfer,
    324   1.16  augustss 	uhci_device_intr_start,
    325    1.1  augustss 	uhci_device_intr_abort,
    326    1.1  augustss 	uhci_device_intr_close,
    327   1.38  augustss 	uhci_device_clear_toggle,
    328   1.41  augustss 	uhci_device_intr_done,
    329    1.1  augustss };
    330    1.1  augustss 
    331   1.48  augustss struct usbd_pipe_methods uhci_device_bulk_methods = {
    332    1.1  augustss 	uhci_device_bulk_transfer,
    333   1.16  augustss 	uhci_device_bulk_start,
    334    1.1  augustss 	uhci_device_bulk_abort,
    335    1.1  augustss 	uhci_device_bulk_close,
    336   1.38  augustss 	uhci_device_clear_toggle,
    337   1.41  augustss 	uhci_device_bulk_done,
    338    1.1  augustss };
    339    1.1  augustss 
    340   1.48  augustss struct usbd_pipe_methods uhci_device_isoc_methods = {
    341   1.16  augustss 	uhci_device_isoc_transfer,
    342   1.16  augustss 	uhci_device_isoc_start,
    343   1.16  augustss 	uhci_device_isoc_abort,
    344   1.16  augustss 	uhci_device_isoc_close,
    345   1.38  augustss 	uhci_noop,
    346   1.41  augustss 	uhci_device_isoc_done,
    347   1.16  augustss };
    348   1.16  augustss 
    349   1.92  augustss #define uhci_add_intr_info(sc, ii) \
    350   1.92  augustss 	LIST_INSERT_HEAD(&(sc)->sc_intrhead, (ii), list);
    351   1.92  augustss #define uhci_del_intr_info(ii) \
    352   1.92  augustss 	LIST_REMOVE((ii), list)
    353   1.92  augustss 
    354  1.101  augustss Static __inline__ uhci_soft_qh_t *
    355   1.92  augustss uhci_find_prev_qh(pqh, sqh)
    356   1.92  augustss 	uhci_soft_qh_t *pqh, *sqh;
    357   1.92  augustss {
    358   1.92  augustss 	DPRINTFN(15,("uhci_find_prev_qh: pqh=%p sqh=%p\n", pqh, sqh));
    359   1.92  augustss 
    360   1.92  augustss 	for (; pqh->hlink != sqh; pqh = pqh->hlink) {
    361   1.92  augustss #if defined(DIAGNOSTIC) || defined(UHCI_DEBUG)
    362   1.92  augustss 		if (le32toh(pqh->qh.qh_hlink) & UHCI_PTR_T) {
    363  1.102  augustss 			printf("uhci_find_prev_qh: QH not found\n");
    364   1.92  augustss 			return (NULL);
    365   1.92  augustss 		}
    366   1.92  augustss #endif
    367   1.92  augustss 	}
    368   1.92  augustss 	return (pqh);
    369   1.92  augustss }
    370   1.92  augustss 
    371    1.1  augustss void
    372    1.1  augustss uhci_busreset(sc)
    373    1.1  augustss 	uhci_softc_t *sc;
    374    1.1  augustss {
    375    1.1  augustss 	UHCICMD(sc, UHCI_CMD_GRESET);	/* global reset */
    376   1.20  augustss 	usb_delay_ms(&sc->sc_bus, USB_BUS_RESET_DELAY); /* wait a little */
    377    1.1  augustss 	UHCICMD(sc, 0);			/* do nothing */
    378    1.1  augustss }
    379    1.1  augustss 
    380    1.1  augustss usbd_status
    381    1.1  augustss uhci_init(sc)
    382    1.1  augustss 	uhci_softc_t *sc;
    383    1.1  augustss {
    384   1.63  augustss 	usbd_status err;
    385    1.1  augustss 	int i, j;
    386    1.1  augustss 	uhci_soft_qh_t *csqh, *bsqh, *sqh;
    387    1.1  augustss 	uhci_soft_td_t *std;
    388    1.1  augustss 
    389    1.1  augustss 	DPRINTFN(1,("uhci_init: start\n"));
    390    1.1  augustss 
    391   1.67  augustss #ifdef UHCI_DEBUG
    392   1.92  augustss 	thesc = sc;
    393   1.92  augustss 
    394    1.1  augustss 	if (uhcidebug > 2)
    395    1.1  augustss 		uhci_dumpregs(sc);
    396    1.1  augustss #endif
    397    1.1  augustss 
    398    1.1  augustss 	uhci_run(sc, 0);			/* stop the controller */
    399    1.1  augustss 	UWRITE2(sc, UHCI_INTR, 0);		/* disable interrupts */
    400    1.1  augustss 
    401   1.24  augustss 	uhci_busreset(sc);
    402   1.24  augustss 
    403    1.1  augustss 	/* Allocate and initialize real frame array. */
    404   1.63  augustss 	err = usb_allocmem(&sc->sc_bus,
    405   1.63  augustss 		  UHCI_FRAMELIST_COUNT * sizeof(uhci_physaddr_t),
    406   1.63  augustss 		  UHCI_FRAMELIST_ALIGN, &sc->sc_dma);
    407   1.63  augustss 	if (err)
    408   1.63  augustss 		return (err);
    409   1.30  augustss 	sc->sc_pframes = KERNADDR(&sc->sc_dma);
    410    1.1  augustss 	UWRITE2(sc, UHCI_FRNUM, 0);		/* set frame number to 0 */
    411   1.36  augustss 	UWRITE4(sc, UHCI_FLBASEADDR, DMAADDR(&sc->sc_dma)); /* set frame list*/
    412    1.1  augustss 
    413    1.1  augustss 	/* Allocate the dummy QH where bulk traffic will be queued. */
    414    1.1  augustss 	bsqh = uhci_alloc_sqh(sc);
    415   1.63  augustss 	if (bsqh == NULL)
    416    1.1  augustss 		return (USBD_NOMEM);
    417   1.88   tsutsui 	bsqh->qh.qh_hlink = htole32(UHCI_PTR_T);	/* end of QH chain */
    418   1.88   tsutsui 	bsqh->qh.qh_elink = htole32(UHCI_PTR_T);
    419    1.1  augustss 	sc->sc_bulk_start = sc->sc_bulk_end = bsqh;
    420    1.1  augustss 
    421    1.1  augustss 	/* Allocate the dummy QH where control traffic will be queued. */
    422    1.1  augustss 	csqh = uhci_alloc_sqh(sc);
    423   1.63  augustss 	if (csqh == NULL)
    424    1.1  augustss 		return (USBD_NOMEM);
    425   1.42  augustss 	csqh->hlink = bsqh;
    426   1.88   tsutsui 	csqh->qh.qh_hlink = htole32(bsqh->physaddr | UHCI_PTR_Q);
    427   1.88   tsutsui 	csqh->qh.qh_elink = htole32(UHCI_PTR_T);
    428    1.1  augustss 	sc->sc_ctl_start = sc->sc_ctl_end = csqh;
    429    1.1  augustss 
    430    1.1  augustss 	/*
    431    1.1  augustss 	 * Make all (virtual) frame list pointers point to the interrupt
    432    1.1  augustss 	 * queue heads and the interrupt queue heads at the control
    433    1.1  augustss 	 * queue head and point the physical frame list to the virtual.
    434    1.1  augustss 	 */
    435    1.1  augustss 	for(i = 0; i < UHCI_VFRAMELIST_COUNT; i++) {
    436    1.1  augustss 		std = uhci_alloc_std(sc);
    437    1.1  augustss 		sqh = uhci_alloc_sqh(sc);
    438   1.67  augustss 		if (std == NULL || sqh == NULL)
    439   1.13  augustss 			return (USBD_NOMEM);
    440   1.42  augustss 		std->link.sqh = sqh;
    441   1.88   tsutsui 		std->td.td_link = htole32(sqh->physaddr | UHCI_PTR_Q);
    442   1.88   tsutsui 		std->td.td_status = htole32(UHCI_TD_IOS); /* iso, inactive */
    443   1.88   tsutsui 		std->td.td_token = htole32(0);
    444   1.88   tsutsui 		std->td.td_buffer = htole32(0);
    445   1.42  augustss 		sqh->hlink = csqh;
    446   1.88   tsutsui 		sqh->qh.qh_hlink = htole32(csqh->physaddr | UHCI_PTR_Q);
    447   1.42  augustss 		sqh->elink = 0;
    448   1.88   tsutsui 		sqh->qh.qh_elink = htole32(UHCI_PTR_T);
    449    1.1  augustss 		sc->sc_vframes[i].htd = std;
    450    1.1  augustss 		sc->sc_vframes[i].etd = std;
    451    1.1  augustss 		sc->sc_vframes[i].hqh = sqh;
    452    1.1  augustss 		sc->sc_vframes[i].eqh = sqh;
    453    1.1  augustss 		for (j = i;
    454    1.1  augustss 		     j < UHCI_FRAMELIST_COUNT;
    455    1.1  augustss 		     j += UHCI_VFRAMELIST_COUNT)
    456   1.88   tsutsui 			sc->sc_pframes[j] = htole32(std->physaddr);
    457    1.1  augustss 	}
    458    1.1  augustss 
    459    1.1  augustss 	LIST_INIT(&sc->sc_intrhead);
    460    1.1  augustss 
    461   1.76  augustss 	SIMPLEQ_INIT(&sc->sc_free_xfers);
    462   1.76  augustss 
    463   1.96  augustss 	usb_callout_init(sc->sc_poll_handle);
    464   1.96  augustss 
    465    1.1  augustss 	/* Set up the bus struct. */
    466   1.48  augustss 	sc->sc_bus.methods = &uhci_bus_methods;
    467    1.1  augustss 	sc->sc_bus.pipe_size = sizeof(struct uhci_pipe);
    468    1.1  augustss 
    469   1.92  augustss #if defined(__NetBSD__) || defined(__OpenBSD__)
    470   1.30  augustss 	sc->sc_suspend = PWR_RESUME;
    471   1.53  augustss 	sc->sc_powerhook = powerhook_establish(uhci_power, sc);
    472   1.72  augustss 	sc->sc_shutdownhook = shutdownhook_establish(uhci_shutdown, sc);
    473   1.92  augustss #endif
    474   1.72  augustss 
    475    1.1  augustss 	DPRINTFN(1,("uhci_init: enabling\n"));
    476    1.1  augustss 	UWRITE2(sc, UHCI_INTR, UHCI_INTR_TOCRCIE | UHCI_INTR_RIE |
    477    1.1  augustss 		UHCI_INTR_IOCE | UHCI_INTR_SPIE);	/* enable interrupts */
    478    1.1  augustss 
    479   1.71  augustss 	UHCICMD(sc, UHCI_CMD_MAXP); /* Assume 64 byte packets at frame end */
    480   1.71  augustss 
    481   1.16  augustss 	return (uhci_run(sc, 1));		/* and here we go... */
    482   1.53  augustss }
    483   1.53  augustss 
    484   1.67  augustss #if defined(__NetBSD__) || defined(__OpenBSD__)
    485   1.53  augustss int
    486   1.53  augustss uhci_activate(self, act)
    487   1.53  augustss 	device_ptr_t self;
    488   1.53  augustss 	enum devact act;
    489   1.53  augustss {
    490   1.56  augustss 	struct uhci_softc *sc = (struct uhci_softc *)self;
    491   1.53  augustss 	int rv = 0;
    492   1.53  augustss 
    493   1.53  augustss 	switch (act) {
    494   1.53  augustss 	case DVACT_ACTIVATE:
    495   1.53  augustss 		return (EOPNOTSUPP);
    496   1.53  augustss 		break;
    497   1.53  augustss 
    498   1.53  augustss 	case DVACT_DEACTIVATE:
    499   1.56  augustss 		if (sc->sc_child != NULL)
    500   1.56  augustss 			rv = config_deactivate(sc->sc_child);
    501   1.53  augustss 		break;
    502   1.53  augustss 	}
    503   1.53  augustss 	return (rv);
    504   1.53  augustss }
    505   1.53  augustss 
    506   1.53  augustss int
    507   1.57  augustss uhci_detach(sc, flags)
    508   1.57  augustss 	struct uhci_softc *sc;
    509   1.53  augustss 	int flags;
    510   1.53  augustss {
    511   1.76  augustss 	usbd_xfer_handle xfer;
    512   1.53  augustss 	int rv = 0;
    513   1.53  augustss 
    514   1.53  augustss 	if (sc->sc_child != NULL)
    515   1.53  augustss 		rv = config_detach(sc->sc_child, flags);
    516   1.53  augustss 
    517   1.53  augustss 	if (rv != 0)
    518   1.53  augustss 		return (rv);
    519   1.53  augustss 
    520   1.92  augustss #if defined(__NetBSD__) || defined(__OpenBSD__)
    521   1.53  augustss 	powerhook_disestablish(sc->sc_powerhook);
    522   1.72  augustss 	shutdownhook_disestablish(sc->sc_shutdownhook);
    523   1.92  augustss #endif
    524   1.72  augustss 
    525   1.76  augustss 	/* Free all xfers associated with this HC. */
    526   1.76  augustss 	for (;;) {
    527   1.76  augustss 		xfer = SIMPLEQ_FIRST(&sc->sc_free_xfers);
    528   1.76  augustss 		if (xfer == NULL)
    529   1.76  augustss 			break;
    530   1.76  augustss 		SIMPLEQ_REMOVE_HEAD(&sc->sc_free_xfers, xfer, next);
    531   1.76  augustss 		free(xfer, M_USB);
    532   1.76  augustss 	}
    533   1.76  augustss 
    534   1.76  augustss 	/* XXX free other data structures XXX */
    535   1.53  augustss 
    536   1.53  augustss 	return (rv);
    537    1.1  augustss }
    538   1.67  augustss #endif
    539    1.1  augustss 
    540   1.48  augustss usbd_status
    541   1.48  augustss uhci_allocm(bus, dma, size)
    542   1.48  augustss 	struct usbd_bus *bus;
    543   1.48  augustss 	usb_dma_t *dma;
    544   1.48  augustss 	u_int32_t size;
    545   1.48  augustss {
    546  1.102  augustss 	struct uhci_softc *sc = (struct uhci_softc *)bus;
    547  1.102  augustss 	u_int32_t n;
    548  1.102  augustss 
    549  1.102  augustss 	/*
    550  1.102  augustss 	 * XXX
    551  1.102  augustss 	 * Since we are allocating a buffer we can assume that we will
    552  1.102  augustss 	 * need TDs for it.  Since we don't want to alolocate those from
    553  1.102  augustss 	 * an interrupt context, we allocate them here and free them again.
    554  1.102  augustss 	 * This is no guarantee that we'll get the TDs next time...
    555  1.102  augustss 	 */
    556  1.102  augustss 	n = size / 8;
    557  1.102  augustss 	if (n > 16) {
    558  1.102  augustss 		u_int32_t i;
    559  1.102  augustss 		uhci_soft_td_t **stds;
    560  1.102  augustss 		DPRINTF(("uhci_allocm: get %d TDs\n", n));
    561  1.102  augustss 		stds = malloc(sizeof(uhci_soft_td_t *) * n, M_TEMP, M_NOWAIT);
    562  1.102  augustss 		memset(stds, 0, sizeof(uhci_soft_td_t *) * n);
    563  1.102  augustss 		for(i=0; i < n; i++)
    564  1.102  augustss 			stds[i] = uhci_alloc_std(sc);
    565  1.102  augustss 		for(i=0; i < n; i++)
    566  1.102  augustss 			if (stds[i] != NULL)
    567  1.102  augustss 				uhci_free_std(sc, stds[i]);
    568  1.102  augustss 		free(stds, M_TEMP);
    569  1.102  augustss 	}
    570  1.102  augustss 
    571  1.102  augustss 	return (usb_allocmem(&sc->sc_bus, size, 0, dma));
    572   1.48  augustss }
    573   1.48  augustss 
    574   1.48  augustss void
    575   1.48  augustss uhci_freem(bus, dma)
    576   1.48  augustss 	struct usbd_bus *bus;
    577   1.48  augustss 	usb_dma_t *dma;
    578   1.48  augustss {
    579   1.63  augustss 	usb_freemem(&((struct uhci_softc *)bus)->sc_bus, dma);
    580   1.76  augustss }
    581   1.76  augustss 
    582   1.76  augustss usbd_xfer_handle
    583   1.76  augustss uhci_allocx(bus)
    584   1.76  augustss 	struct usbd_bus *bus;
    585   1.76  augustss {
    586   1.76  augustss 	struct uhci_softc *sc = (struct uhci_softc *)bus;
    587   1.76  augustss 	usbd_xfer_handle xfer;
    588   1.76  augustss 
    589   1.76  augustss 	xfer = SIMPLEQ_FIRST(&sc->sc_free_xfers);
    590   1.94  augustss 	if (xfer != NULL) {
    591   1.76  augustss 		SIMPLEQ_REMOVE_HEAD(&sc->sc_free_xfers, xfer, next);
    592   1.98  augustss #ifdef DIAGNOSTIC
    593   1.94  augustss 		if (xfer->busy_free != XFER_FREE) {
    594  1.105  augustss 			printf("uhci_allocx: xfer=%p not free, 0x%08x\n", xfer,
    595   1.94  augustss 			       xfer->busy_free);
    596   1.94  augustss 		}
    597   1.98  augustss #endif
    598   1.94  augustss 	} else {
    599   1.92  augustss 		xfer = malloc(sizeof(struct uhci_xfer), M_USB, M_NOWAIT);
    600   1.94  augustss 	}
    601   1.92  augustss 	if (xfer != NULL) {
    602   1.92  augustss 		memset(xfer, 0, sizeof (struct uhci_xfer));
    603   1.92  augustss 		UXFER(xfer)->iinfo.sc = sc;
    604   1.92  augustss #ifdef DIAGNOSTIC
    605   1.92  augustss 		UXFER(xfer)->iinfo.isdone = 1;
    606   1.92  augustss #endif
    607   1.92  augustss 	}
    608   1.93  augustss #ifdef DIAGNOSTIC
    609   1.94  augustss 	xfer->busy_free = XFER_BUSY;
    610   1.93  augustss #endif
    611   1.76  augustss 	return (xfer);
    612   1.76  augustss }
    613   1.76  augustss 
    614   1.76  augustss void
    615   1.76  augustss uhci_freex(bus, xfer)
    616   1.76  augustss 	struct usbd_bus *bus;
    617   1.76  augustss 	usbd_xfer_handle xfer;
    618   1.76  augustss {
    619   1.76  augustss 	struct uhci_softc *sc = (struct uhci_softc *)bus;
    620   1.76  augustss 
    621   1.93  augustss #ifdef DIAGNOSTIC
    622   1.94  augustss 	if (xfer->busy_free != XFER_BUSY) {
    623   1.94  augustss 		printf("uhci_freex: xfer=%p not busy, 0x%08x\n", xfer,
    624   1.94  augustss 		       xfer->busy_free);
    625   1.93  augustss 		return;
    626   1.93  augustss 	}
    627   1.94  augustss 	xfer->busy_free = XFER_FREE;
    628  1.105  augustss 	if (!UXFER(xfer)->iinfo.isdone) {
    629   1.96  augustss 		printf("uhci_freex: !isdone\n");
    630  1.105  augustss 		return;
    631  1.105  augustss 	}
    632   1.93  augustss #endif
    633   1.76  augustss 	SIMPLEQ_INSERT_HEAD(&sc->sc_free_xfers, xfer, next);
    634   1.48  augustss }
    635   1.48  augustss 
    636   1.72  augustss /*
    637   1.72  augustss  * Shut down the controller when the system is going down.
    638   1.72  augustss  */
    639   1.72  augustss void
    640   1.72  augustss uhci_shutdown(v)
    641   1.72  augustss 	void *v;
    642   1.72  augustss {
    643   1.72  augustss 	uhci_softc_t *sc = v;
    644   1.72  augustss 
    645   1.72  augustss 	DPRINTF(("uhci_shutdown: stopping the HC\n"));
    646   1.72  augustss 	uhci_run(sc, 0); /* stop the controller */
    647   1.72  augustss }
    648   1.72  augustss 
    649   1.30  augustss /*
    650   1.30  augustss  * Handle suspend/resume.
    651   1.30  augustss  *
    652   1.40  augustss  * We need to switch to polling mode here, because this routine is
    653  1.109  augustss  * called from an interrupt context.  This is all right since we
    654   1.40  augustss  * are almost suspended anyway.
    655   1.30  augustss  */
    656   1.30  augustss void
    657   1.30  augustss uhci_power(why, v)
    658   1.30  augustss 	int why;
    659   1.30  augustss 	void *v;
    660   1.30  augustss {
    661   1.30  augustss 	uhci_softc_t *sc = v;
    662   1.30  augustss 	int cmd;
    663   1.30  augustss 	int s;
    664   1.30  augustss 
    665   1.30  augustss 	s = splusb();
    666   1.30  augustss 	cmd = UREAD2(sc, UHCI_CMD);
    667   1.30  augustss 
    668   1.30  augustss 	DPRINTF(("uhci_power: sc=%p, why=%d (was %d), cmd=0x%x\n",
    669   1.30  augustss 		 sc, why, sc->sc_suspend, cmd));
    670   1.30  augustss 
    671   1.30  augustss 	if (why != PWR_RESUME) {
    672   1.67  augustss #ifdef UHCI_DEBUG
    673   1.30  augustss 		if (uhcidebug > 2)
    674   1.30  augustss 			uhci_dumpregs(sc);
    675   1.30  augustss #endif
    676   1.96  augustss 		if (sc->sc_intr_xfer != NULL)
    677   1.96  augustss 			usb_uncallout(sc->sc_poll_handle, uhci_poll_hub,
    678   1.96  augustss 			    sc->sc_intr_xfer);
    679   1.54  augustss 		sc->sc_bus.use_polling++;
    680   1.30  augustss 		uhci_run(sc, 0); /* stop the controller */
    681   1.86  augustss 
    682   1.86  augustss 		/* save some state if BIOS doesn't */
    683   1.86  augustss 		sc->sc_saved_frnum = UREAD2(sc, UHCI_FRNUM);
    684   1.86  augustss 		sc->sc_saved_sof = UREAD1(sc, UHCI_SOF);
    685   1.88   tsutsui 
    686   1.30  augustss 		UHCICMD(sc, cmd | UHCI_CMD_EGSM); /* enter global suspend */
    687   1.40  augustss 		usb_delay_ms(&sc->sc_bus, USB_RESUME_WAIT);
    688   1.30  augustss 		sc->sc_suspend = why;
    689   1.61  augustss 		sc->sc_bus.use_polling--;
    690   1.30  augustss 		DPRINTF(("uhci_power: cmd=0x%x\n", UREAD2(sc, UHCI_CMD)));
    691   1.30  augustss 	} else {
    692   1.60  augustss #ifdef DIAGNOSTIC
    693   1.61  augustss 		if (sc->sc_suspend == PWR_RESUME)
    694   1.61  augustss 			printf("uhci_power: weird, resume without suspend.\n");
    695   1.60  augustss #endif
    696   1.61  augustss 		sc->sc_bus.use_polling++;
    697   1.30  augustss 		sc->sc_suspend = why;
    698   1.30  augustss 		if (cmd & UHCI_CMD_RS)
    699   1.30  augustss 			uhci_run(sc, 0); /* in case BIOS has started it */
    700   1.86  augustss 
    701   1.86  augustss 		/* restore saved state */
    702   1.86  augustss 		UWRITE4(sc, UHCI_FLBASEADDR, DMAADDR(&sc->sc_dma));
    703   1.86  augustss 		UWRITE2(sc, UHCI_FRNUM, sc->sc_saved_frnum);
    704   1.86  augustss 		UWRITE1(sc, UHCI_SOF, sc->sc_saved_sof);
    705   1.86  augustss 
    706   1.30  augustss 		UHCICMD(sc, cmd | UHCI_CMD_FGR); /* force global resume */
    707   1.40  augustss 		usb_delay_ms(&sc->sc_bus, USB_RESUME_DELAY);
    708   1.30  augustss 		UHCICMD(sc, cmd & ~UHCI_CMD_EGSM); /* back to normal */
    709   1.30  augustss 		UWRITE2(sc, UHCI_INTR, UHCI_INTR_TOCRCIE | UHCI_INTR_RIE |
    710   1.30  augustss 			UHCI_INTR_IOCE | UHCI_INTR_SPIE); /* re-enable intrs */
    711   1.30  augustss 		uhci_run(sc, 1); /* and start traffic again */
    712   1.40  augustss 		usb_delay_ms(&sc->sc_bus, USB_RESUME_RECOVERY);
    713   1.54  augustss 		sc->sc_bus.use_polling--;
    714   1.96  augustss 		if (sc->sc_intr_xfer != NULL)
    715   1.96  augustss 			usb_callout(sc->sc_poll_handle, sc->sc_ival,
    716   1.96  augustss 				    uhci_poll_hub, sc->sc_intr_xfer);
    717   1.67  augustss #ifdef UHCI_DEBUG
    718   1.30  augustss 		if (uhcidebug > 2)
    719   1.30  augustss 			uhci_dumpregs(sc);
    720   1.30  augustss #endif
    721   1.30  augustss 	}
    722   1.30  augustss 	splx(s);
    723   1.30  augustss }
    724   1.30  augustss 
    725   1.59  augustss #ifdef UHCI_DEBUG
    726  1.101  augustss Static void
    727    1.1  augustss uhci_dumpregs(sc)
    728    1.1  augustss 	uhci_softc_t *sc;
    729    1.1  augustss {
    730   1.48  augustss 	DPRINTFN(-1,("%s regs: cmd=%04x, sts=%04x, intr=%04x, frnum=%04x, "
    731   1.48  augustss 		     "flbase=%08x, sof=%04x, portsc1=%04x, portsc2=%04x\n",
    732   1.48  augustss 		     USBDEVNAME(sc->sc_bus.bdev),
    733   1.48  augustss 		     UREAD2(sc, UHCI_CMD),
    734   1.48  augustss 		     UREAD2(sc, UHCI_STS),
    735   1.48  augustss 		     UREAD2(sc, UHCI_INTR),
    736   1.48  augustss 		     UREAD2(sc, UHCI_FRNUM),
    737   1.48  augustss 		     UREAD4(sc, UHCI_FLBASEADDR),
    738   1.48  augustss 		     UREAD1(sc, UHCI_SOF),
    739   1.48  augustss 		     UREAD2(sc, UHCI_PORTSC1),
    740   1.48  augustss 		     UREAD2(sc, UHCI_PORTSC2)));
    741    1.1  augustss }
    742    1.1  augustss 
    743    1.1  augustss void
    744    1.1  augustss uhci_dump_td(p)
    745    1.1  augustss 	uhci_soft_td_t *p;
    746    1.1  augustss {
    747   1.48  augustss 	DPRINTFN(-1,("TD(%p) at %08lx = link=0x%08lx status=0x%08lx "
    748   1.48  augustss 		     "token=0x%08lx buffer=0x%08lx\n",
    749   1.48  augustss 		     p, (long)p->physaddr,
    750   1.88   tsutsui 		     (long)le32toh(p->td.td_link),
    751   1.88   tsutsui 		     (long)le32toh(p->td.td_status),
    752   1.88   tsutsui 		     (long)le32toh(p->td.td_token),
    753   1.88   tsutsui 		     (long)le32toh(p->td.td_buffer)));
    754   1.48  augustss 	DPRINTFN(-1,("  %b %b,errcnt=%d,actlen=%d pid=%02x,addr=%d,endpt=%d,"
    755   1.48  augustss 		     "D=%d,maxlen=%d\n",
    756   1.88   tsutsui 		     (int)le32toh(p->td.td_link),
    757   1.48  augustss 		     "\20\1T\2Q\3VF",
    758   1.88   tsutsui 		     (int)le32toh(p->td.td_status),
    759   1.48  augustss 		     "\20\22BITSTUFF\23CRCTO\24NAK\25BABBLE\26DBUFFER\27"
    760   1.48  augustss 		     "STALLED\30ACTIVE\31IOC\32ISO\33LS\36SPD",
    761   1.88   tsutsui 		     UHCI_TD_GET_ERRCNT(le32toh(p->td.td_status)),
    762   1.88   tsutsui 		     UHCI_TD_GET_ACTLEN(le32toh(p->td.td_status)),
    763   1.88   tsutsui 		     UHCI_TD_GET_PID(le32toh(p->td.td_token)),
    764   1.88   tsutsui 		     UHCI_TD_GET_DEVADDR(le32toh(p->td.td_token)),
    765   1.88   tsutsui 		     UHCI_TD_GET_ENDPT(le32toh(p->td.td_token)),
    766   1.88   tsutsui 		     UHCI_TD_GET_DT(le32toh(p->td.td_token)),
    767   1.88   tsutsui 		     UHCI_TD_GET_MAXLEN(le32toh(p->td.td_token))));
    768    1.1  augustss }
    769    1.1  augustss 
    770    1.1  augustss void
    771   1.67  augustss uhci_dump_qh(sqh)
    772   1.67  augustss 	uhci_soft_qh_t *sqh;
    773    1.1  augustss {
    774   1.67  augustss 	DPRINTFN(-1,("QH(%p) at %08x: hlink=%08x elink=%08x\n", sqh,
    775   1.88   tsutsui 	    (int)sqh->physaddr, le32toh(sqh->qh.qh_hlink),
    776   1.88   tsutsui 	    le32toh(sqh->qh.qh_elink)));
    777    1.1  augustss }
    778    1.1  augustss 
    779   1.13  augustss 
    780  1.110  augustss #if 1
    781    1.1  augustss void
    782    1.1  augustss uhci_dump()
    783    1.1  augustss {
    784  1.110  augustss 	uhci_dump_all(thesc);
    785  1.110  augustss }
    786  1.110  augustss #endif
    787    1.1  augustss 
    788  1.110  augustss void
    789  1.110  augustss uhci_dump_all(sc)
    790  1.110  augustss 	uhci_softc_t *sc;
    791  1.110  augustss {
    792    1.1  augustss 	uhci_dumpregs(sc);
    793   1.50  augustss 	printf("intrs=%d\n", sc->sc_bus.no_intrs);
    794  1.110  augustss 	/*printf("framelist[i].link = %08x\n", sc->sc_framelist[0].link);*/
    795  1.110  augustss 	uhci_dump_qh(sc->sc_ctl_start);
    796    1.1  augustss }
    797    1.1  augustss 
    798   1.67  augustss 
    799   1.67  augustss void
    800   1.67  augustss uhci_dump_qhs(sqh)
    801   1.67  augustss 	uhci_soft_qh_t *sqh;
    802   1.67  augustss {
    803   1.67  augustss 	uhci_dump_qh(sqh);
    804   1.67  augustss 
    805   1.67  augustss 	/* uhci_dump_qhs displays all the QHs and TDs from the given QH onwards
    806   1.67  augustss 	 * Traverses sideways first, then down.
    807   1.67  augustss 	 *
    808   1.67  augustss 	 * QH1
    809   1.67  augustss 	 * QH2
    810   1.67  augustss 	 * No QH
    811   1.67  augustss 	 * TD2.1
    812   1.67  augustss 	 * TD2.2
    813   1.67  augustss 	 * TD1.1
    814   1.67  augustss 	 * etc.
    815   1.67  augustss 	 *
    816   1.67  augustss 	 * TD2.x being the TDs queued at QH2 and QH1 being referenced from QH1.
    817   1.67  augustss 	 */
    818   1.67  augustss 
    819   1.67  augustss 
    820   1.88   tsutsui 	if (sqh->hlink != NULL && !(le32toh(sqh->qh.qh_hlink) & UHCI_PTR_T))
    821   1.67  augustss 		uhci_dump_qhs(sqh->hlink);
    822   1.67  augustss 	else
    823   1.67  augustss 		DPRINTF(("No QH\n"));
    824   1.67  augustss 
    825   1.88   tsutsui 	if (sqh->elink != NULL && !(le32toh(sqh->qh.qh_elink) & UHCI_PTR_T))
    826   1.67  augustss 		uhci_dump_tds(sqh->elink);
    827   1.67  augustss 	else
    828   1.67  augustss 		DPRINTF(("No TD\n"));
    829   1.67  augustss }
    830   1.67  augustss 
    831    1.1  augustss void
    832    1.1  augustss uhci_dump_tds(std)
    833    1.1  augustss 	uhci_soft_td_t *std;
    834    1.1  augustss {
    835   1.67  augustss 	uhci_soft_td_t *td;
    836   1.67  augustss 
    837   1.67  augustss 	for(td = std; td != NULL; td = td->link.std) {
    838   1.67  augustss 		uhci_dump_td(td);
    839    1.1  augustss 
    840   1.67  augustss 		/* Check whether the link pointer in this TD marks
    841   1.67  augustss 		 * the link pointer as end of queue. This avoids
    842   1.67  augustss 		 * printing the free list in case the queue/TD has
    843   1.67  augustss 		 * already been moved there (seatbelt).
    844   1.67  augustss 		 */
    845   1.88   tsutsui 		if (le32toh(td->td.td_link) & UHCI_PTR_T ||
    846   1.88   tsutsui 		    le32toh(td->td.td_link) == 0)
    847   1.67  augustss 			break;
    848   1.67  augustss 	}
    849    1.1  augustss }
    850   1.92  augustss 
    851  1.101  augustss Static void
    852   1.92  augustss uhci_dump_ii(ii)
    853   1.92  augustss 	uhci_intr_info_t *ii;
    854   1.92  augustss {
    855   1.95  augustss 	usbd_pipe_handle pipe;
    856   1.95  augustss 	usb_endpoint_descriptor_t *ed;
    857   1.95  augustss 	usbd_device_handle dev;
    858   1.92  augustss 
    859   1.98  augustss #ifdef DIAGNOSTIC
    860   1.98  augustss #define DONE ii->isdone
    861   1.98  augustss #else
    862   1.98  augustss #define DONE 0
    863   1.98  augustss #endif
    864   1.95  augustss         if (ii == NULL) {
    865   1.95  augustss                 printf("ii NULL\n");
    866   1.95  augustss                 return;
    867   1.95  augustss         }
    868   1.95  augustss         if (ii->xfer == NULL) {
    869   1.95  augustss 		printf("ii %p: done=%d xfer=NULL\n",
    870   1.98  augustss 		       ii, DONE);
    871   1.95  augustss                 return;
    872   1.95  augustss         }
    873   1.95  augustss         pipe = ii->xfer->pipe;
    874   1.95  augustss         if (pipe == NULL) {
    875   1.95  augustss 		printf("ii %p: done=%d xfer=%p pipe=NULL\n",
    876   1.98  augustss 		       ii, DONE, ii->xfer);
    877   1.95  augustss                 return;
    878   1.95  augustss 	}
    879   1.95  augustss         ed = pipe->endpoint->edesc;
    880   1.95  augustss         dev = pipe->device;
    881   1.92  augustss 	printf("ii %p: done=%d xfer=%p dev=%p vid=0x%04x pid=0x%04x addr=%d pipe=%p ep=0x%02x attr=0x%02x\n",
    882   1.98  augustss 	       ii, DONE, ii->xfer, dev,
    883   1.95  augustss 	       UGETW(dev->ddesc.idVendor),
    884   1.92  augustss 	       UGETW(dev->ddesc.idProduct),
    885   1.92  augustss 	       dev->address, pipe,
    886   1.92  augustss 	       ed->bEndpointAddress, ed->bmAttributes);
    887   1.98  augustss #undef DONE
    888   1.92  augustss }
    889   1.92  augustss 
    890   1.92  augustss void uhci_dump_iis(struct uhci_softc *);
    891   1.92  augustss void
    892   1.92  augustss uhci_dump_iis(sc)
    893   1.92  augustss 	struct uhci_softc *sc;
    894   1.92  augustss {
    895   1.92  augustss 	uhci_intr_info_t *ii;
    896   1.92  augustss 
    897   1.92  augustss 	printf("intr_info list:\n");
    898   1.92  augustss 	for (ii = LIST_FIRST(&sc->sc_intrhead); ii; ii = LIST_NEXT(ii, list))
    899   1.92  augustss 		uhci_dump_ii(ii);
    900   1.92  augustss }
    901   1.92  augustss 
    902   1.92  augustss void iidump(void);
    903   1.92  augustss void iidump() { uhci_dump_iis(thesc); }
    904   1.92  augustss 
    905    1.1  augustss #endif
    906    1.1  augustss 
    907    1.1  augustss /*
    908    1.1  augustss  * This routine is executed periodically and simulates interrupts
    909    1.1  augustss  * from the root controller interrupt pipe for port status change.
    910    1.1  augustss  */
    911    1.1  augustss void
    912   1.96  augustss uhci_poll_hub(addr)
    913    1.1  augustss 	void *addr;
    914    1.1  augustss {
    915   1.63  augustss 	usbd_xfer_handle xfer = addr;
    916   1.63  augustss 	usbd_pipe_handle pipe = xfer->pipe;
    917    1.1  augustss 	uhci_softc_t *sc = (uhci_softc_t *)pipe->device->bus;
    918    1.1  augustss 	int s;
    919    1.1  augustss 	u_char *p;
    920    1.1  augustss 
    921   1.96  augustss 	DPRINTFN(20, ("uhci_poll_hub\n"));
    922    1.1  augustss 
    923   1.96  augustss 	usb_callout(sc->sc_poll_handle, sc->sc_ival, uhci_poll_hub, xfer);
    924   1.41  augustss 
    925   1.63  augustss 	p = KERNADDR(&xfer->dmabuf);
    926    1.1  augustss 	p[0] = 0;
    927    1.1  augustss 	if (UREAD2(sc, UHCI_PORTSC1) & (UHCI_PORTSC_CSC|UHCI_PORTSC_OCIC))
    928    1.1  augustss 		p[0] |= 1<<1;
    929    1.1  augustss 	if (UREAD2(sc, UHCI_PORTSC2) & (UHCI_PORTSC_CSC|UHCI_PORTSC_OCIC))
    930    1.1  augustss 		p[0] |= 1<<2;
    931   1.41  augustss 	if (p[0] == 0)
    932   1.41  augustss 		/* No change, try again in a while */
    933   1.41  augustss 		return;
    934   1.41  augustss 
    935   1.63  augustss 	xfer->actlen = 1;
    936   1.63  augustss 	xfer->status = USBD_NORMAL_COMPLETION;
    937   1.16  augustss 	s = splusb();
    938   1.63  augustss 	xfer->device->bus->intr_context++;
    939   1.63  augustss 	usb_transfer_complete(xfer);
    940   1.63  augustss 	xfer->device->bus->intr_context--;
    941   1.41  augustss 	splx(s);
    942   1.41  augustss }
    943   1.41  augustss 
    944   1.41  augustss void
    945   1.63  augustss uhci_root_intr_done(xfer)
    946   1.84  augustss 	usbd_xfer_handle xfer;
    947   1.84  augustss {
    948   1.84  augustss }
    949   1.84  augustss 
    950   1.84  augustss void
    951   1.84  augustss uhci_root_ctrl_done(xfer)
    952   1.63  augustss 	usbd_xfer_handle xfer;
    953   1.41  augustss {
    954    1.1  augustss }
    955    1.1  augustss 
    956    1.1  augustss /* Add control QH, called at splusb(). */
    957    1.1  augustss void
    958    1.1  augustss uhci_add_ctrl(sc, sqh)
    959    1.1  augustss 	uhci_softc_t *sc;
    960    1.1  augustss 	uhci_soft_qh_t *sqh;
    961    1.1  augustss {
    962   1.42  augustss 	uhci_soft_qh_t *eqh;
    963    1.1  augustss 
    964   1.52  augustss 	SPLUSBCHECK;
    965   1.52  augustss 
    966    1.1  augustss 	DPRINTFN(10, ("uhci_add_ctrl: sqh=%p\n", sqh));
    967   1.42  augustss 	eqh = sc->sc_ctl_end;
    968   1.42  augustss 	sqh->hlink       = eqh->hlink;
    969   1.42  augustss 	sqh->qh.qh_hlink = eqh->qh.qh_hlink;
    970   1.42  augustss 	eqh->hlink       = sqh;
    971   1.88   tsutsui 	eqh->qh.qh_hlink = htole32(sqh->physaddr | UHCI_PTR_Q);
    972    1.1  augustss 	sc->sc_ctl_end = sqh;
    973    1.1  augustss }
    974    1.1  augustss 
    975    1.1  augustss /* Remove control QH, called at splusb(). */
    976    1.1  augustss void
    977    1.1  augustss uhci_remove_ctrl(sc, sqh)
    978    1.1  augustss 	uhci_softc_t *sc;
    979    1.1  augustss 	uhci_soft_qh_t *sqh;
    980    1.1  augustss {
    981    1.1  augustss 	uhci_soft_qh_t *pqh;
    982    1.1  augustss 
    983   1.52  augustss 	SPLUSBCHECK;
    984   1.52  augustss 
    985    1.1  augustss 	DPRINTFN(10, ("uhci_remove_ctrl: sqh=%p\n", sqh));
    986   1.92  augustss 	pqh = uhci_find_prev_qh(sc->sc_ctl_start, sqh);
    987   1.42  augustss 	pqh->hlink       = sqh->hlink;
    988   1.42  augustss 	pqh->qh.qh_hlink = sqh->qh.qh_hlink;
    989    1.1  augustss 	if (sc->sc_ctl_end == sqh)
    990    1.1  augustss 		sc->sc_ctl_end = pqh;
    991    1.1  augustss }
    992    1.1  augustss 
    993    1.1  augustss /* Add bulk QH, called at splusb(). */
    994    1.1  augustss void
    995    1.1  augustss uhci_add_bulk(sc, sqh)
    996    1.1  augustss 	uhci_softc_t *sc;
    997    1.1  augustss 	uhci_soft_qh_t *sqh;
    998    1.1  augustss {
    999   1.42  augustss 	uhci_soft_qh_t *eqh;
   1000    1.1  augustss 
   1001   1.52  augustss 	SPLUSBCHECK;
   1002   1.52  augustss 
   1003    1.1  augustss 	DPRINTFN(10, ("uhci_add_bulk: sqh=%p\n", sqh));
   1004   1.42  augustss 	eqh = sc->sc_bulk_end;
   1005   1.42  augustss 	sqh->hlink       = eqh->hlink;
   1006   1.42  augustss 	sqh->qh.qh_hlink = eqh->qh.qh_hlink;
   1007   1.42  augustss 	eqh->hlink       = sqh;
   1008   1.88   tsutsui 	eqh->qh.qh_hlink = htole32(sqh->physaddr | UHCI_PTR_Q);
   1009    1.1  augustss 	sc->sc_bulk_end = sqh;
   1010    1.1  augustss }
   1011    1.1  augustss 
   1012    1.1  augustss /* Remove bulk QH, called at splusb(). */
   1013    1.1  augustss void
   1014    1.1  augustss uhci_remove_bulk(sc, sqh)
   1015    1.1  augustss 	uhci_softc_t *sc;
   1016    1.1  augustss 	uhci_soft_qh_t *sqh;
   1017    1.1  augustss {
   1018    1.1  augustss 	uhci_soft_qh_t *pqh;
   1019    1.1  augustss 
   1020   1.52  augustss 	SPLUSBCHECK;
   1021   1.52  augustss 
   1022    1.1  augustss 	DPRINTFN(10, ("uhci_remove_bulk: sqh=%p\n", sqh));
   1023   1.92  augustss 	pqh = uhci_find_prev_qh(sc->sc_bulk_start, sqh);
   1024   1.42  augustss 	pqh->hlink       = sqh->hlink;
   1025   1.42  augustss 	pqh->qh.qh_hlink = sqh->qh.qh_hlink;
   1026    1.1  augustss 	if (sc->sc_bulk_end == sqh)
   1027    1.1  augustss 		sc->sc_bulk_end = pqh;
   1028    1.1  augustss }
   1029    1.1  augustss 
   1030    1.1  augustss int
   1031   1.44  augustss uhci_intr(arg)
   1032   1.44  augustss 	void *arg;
   1033    1.1  augustss {
   1034   1.44  augustss 	uhci_softc_t *sc = arg;
   1035   1.44  augustss 	int status;
   1036   1.44  augustss 	int ack;
   1037    1.1  augustss 
   1038   1.67  augustss #ifdef UHCI_DEBUG
   1039   1.44  augustss 	if (uhcidebug > 15) {
   1040   1.44  augustss 		DPRINTF(("%s: uhci_intr\n", USBDEVNAME(sc->sc_bus.bdev)));
   1041    1.1  augustss 		uhci_dumpregs(sc);
   1042    1.1  augustss 	}
   1043    1.1  augustss #endif
   1044  1.117  augustss 
   1045  1.117  augustss 	if (sc->sc_suspend != PWR_RESUME) {
   1046  1.117  augustss 		printf("%s: interrupt while not operating ignored\n",
   1047  1.117  augustss 		       USBDEVNAME(sc->sc_bus.bdev));
   1048  1.117  augustss 		return (0);
   1049  1.117  augustss 	}
   1050   1.44  augustss 
   1051   1.62  augustss 	status = UREAD2(sc, UHCI_STS);
   1052   1.62  augustss 	if (status == 0)	/* The interrupt was not for us. */
   1053   1.62  augustss 		return (0);
   1054   1.62  augustss 
   1055   1.44  augustss #if defined(DIAGNOSTIC) && defined(__NetBSD__)
   1056   1.30  augustss 	if (sc->sc_suspend != PWR_RESUME)
   1057   1.30  augustss 		printf("uhci_intr: suspended sts=0x%x\n", status);
   1058   1.30  augustss #endif
   1059   1.44  augustss 
   1060   1.44  augustss 	ack = 0;
   1061   1.44  augustss 	if (status & UHCI_STS_USBINT)
   1062   1.44  augustss 		ack |= UHCI_STS_USBINT;
   1063   1.44  augustss 	if (status & UHCI_STS_USBEI)
   1064   1.44  augustss 		ack |= UHCI_STS_USBEI;
   1065    1.1  augustss 	if (status & UHCI_STS_RD) {
   1066   1.44  augustss 		ack |= UHCI_STS_RD;
   1067   1.46  augustss 		printf("%s: resume detect\n", USBDEVNAME(sc->sc_bus.bdev));
   1068    1.1  augustss 	}
   1069    1.1  augustss 	if (status & UHCI_STS_HSE) {
   1070   1.44  augustss 		ack |= UHCI_STS_HSE;
   1071   1.81  augustss 		printf("%s: host system error\n", USBDEVNAME(sc->sc_bus.bdev));
   1072    1.1  augustss 	}
   1073    1.1  augustss 	if (status & UHCI_STS_HCPE) {
   1074   1.44  augustss 		ack |= UHCI_STS_HCPE;
   1075   1.81  augustss 		printf("%s: host controller process error\n",
   1076   1.81  augustss 		       USBDEVNAME(sc->sc_bus.bdev));
   1077   1.44  augustss 	}
   1078   1.44  augustss 	if (status & UHCI_STS_HCH) {
   1079   1.44  augustss 		/* no acknowledge needed */
   1080   1.46  augustss 		printf("%s: host controller halted\n",
   1081   1.46  augustss 		       USBDEVNAME(sc->sc_bus.bdev));
   1082   1.82  augustss 		sc->sc_dying = 1;
   1083  1.110  augustss #ifdef UHCI_DEBUG
   1084  1.110  augustss 		uhci_dump_all(sc);
   1085  1.110  augustss #endif
   1086  1.110  augustss 
   1087    1.1  augustss 	}
   1088   1.44  augustss 
   1089   1.44  augustss 	if (ack)	/* acknowledge the ints */
   1090   1.44  augustss 		UWRITE2(sc, UHCI_STS, ack);
   1091   1.44  augustss 	else	/* nothing to acknowledge */
   1092   1.44  augustss 		return (0);
   1093    1.1  augustss 
   1094   1.85  augustss 	sc->sc_bus.no_intrs++;
   1095   1.85  augustss 	usb_schedsoftintr(&sc->sc_bus);
   1096   1.85  augustss 
   1097   1.85  augustss 	DPRINTFN(10, ("%s: uhci_intr: exit\n", USBDEVNAME(sc->sc_bus.bdev)));
   1098   1.85  augustss 
   1099   1.85  augustss 	return (1);
   1100   1.85  augustss }
   1101   1.85  augustss 
   1102   1.85  augustss void
   1103   1.85  augustss uhci_softintr(bus)
   1104   1.85  augustss 	struct usbd_bus *bus;
   1105   1.85  augustss {
   1106   1.85  augustss 	uhci_softc_t *sc = (uhci_softc_t *)bus;
   1107   1.85  augustss 	uhci_intr_info_t *ii;
   1108   1.85  augustss 
   1109   1.85  augustss 	DPRINTFN(10,("%s: uhci_softintr\n", USBDEVNAME(sc->sc_bus.bdev)));
   1110   1.85  augustss 
   1111   1.51  augustss 	sc->sc_bus.intr_context++;
   1112   1.50  augustss 
   1113    1.1  augustss 	/*
   1114    1.1  augustss 	 * Interrupts on UHCI really suck.  When the host controller
   1115    1.1  augustss 	 * interrupts because a transfer is completed there is no
   1116    1.1  augustss 	 * way of knowing which transfer it was.  You can scan down
   1117    1.1  augustss 	 * the TDs and QHs of the previous frame to limit the search,
   1118    1.1  augustss 	 * but that assumes that the interrupt was not delayed by more
   1119    1.1  augustss 	 * than 1 ms, which may not always be true (e.g. after debug
   1120    1.1  augustss 	 * output on a slow console).
   1121    1.1  augustss 	 * We scan all interrupt descriptors to see if any have
   1122    1.1  augustss 	 * completed.
   1123    1.1  augustss 	 */
   1124    1.1  augustss 	for (ii = LIST_FIRST(&sc->sc_intrhead); ii; ii = LIST_NEXT(ii, list))
   1125    1.1  augustss 		uhci_check_intr(sc, ii);
   1126    1.1  augustss 
   1127   1.51  augustss 	sc->sc_bus.intr_context--;
   1128    1.1  augustss }
   1129    1.1  augustss 
   1130    1.1  augustss /* Check for an interrupt. */
   1131    1.1  augustss void
   1132    1.1  augustss uhci_check_intr(sc, ii)
   1133    1.1  augustss 	uhci_softc_t *sc;
   1134    1.1  augustss 	uhci_intr_info_t *ii;
   1135    1.1  augustss {
   1136    1.1  augustss 	uhci_soft_td_t *std, *lstd;
   1137   1.18  augustss 	u_int32_t status;
   1138    1.1  augustss 
   1139    1.1  augustss 	DPRINTFN(15, ("uhci_check_intr: ii=%p\n", ii));
   1140    1.1  augustss #ifdef DIAGNOSTIC
   1141   1.63  augustss 	if (ii == NULL) {
   1142    1.1  augustss 		printf("uhci_check_intr: no ii? %p\n", ii);
   1143    1.1  augustss 		return;
   1144    1.1  augustss 	}
   1145    1.1  augustss #endif
   1146   1.63  augustss 	if (ii->stdstart == NULL)
   1147    1.1  augustss 		return;
   1148    1.1  augustss 	lstd = ii->stdend;
   1149    1.1  augustss #ifdef DIAGNOSTIC
   1150   1.63  augustss 	if (lstd == NULL) {
   1151    1.1  augustss 		printf("uhci_check_intr: std==0\n");
   1152    1.1  augustss 		return;
   1153    1.1  augustss 	}
   1154    1.1  augustss #endif
   1155   1.26  augustss 	/*
   1156   1.26  augustss 	 * If the last TD is still active we need to check whether there
   1157   1.26  augustss 	 * is a an error somewhere in the middle, or whether there was a
   1158   1.26  augustss 	 * short packet (SPD and not ACTIVE).
   1159   1.26  augustss 	 */
   1160   1.88   tsutsui 	if (le32toh(lstd->td.td_status) & UHCI_TD_ACTIVE) {
   1161   1.92  augustss 		DPRINTFN(12, ("uhci_check_intr: active ii=%p\n", ii));
   1162   1.48  augustss 		for (std = ii->stdstart; std != lstd; std = std->link.std) {
   1163   1.88   tsutsui 			status = le32toh(std->td.td_status);
   1164   1.83  augustss 			/* If there's an active TD the xfer isn't done. */
   1165   1.83  augustss 			if (status & UHCI_TD_ACTIVE)
   1166   1.83  augustss 				break;
   1167   1.83  augustss 			/* Any kind of error makes the xfer done. */
   1168   1.83  augustss 			if (status & UHCI_TD_STALLED)
   1169   1.83  augustss 				goto done;
   1170   1.83  augustss 			/* We want short packets, and it is short: it's done */
   1171   1.83  augustss 			if ((status & UHCI_TD_SPD) &&
   1172   1.83  augustss 			      UHCI_TD_GET_ACTLEN(status) <
   1173   1.88   tsutsui 			      UHCI_TD_GET_MAXLEN(le32toh(std->td.td_token)))
   1174    1.1  augustss 				goto done;
   1175   1.18  augustss 		}
   1176   1.92  augustss 		DPRINTFN(12, ("uhci_check_intr: ii=%p std=%p still active\n",
   1177   1.18  augustss 			      ii, ii->stdstart));
   1178    1.1  augustss 		return;
   1179    1.1  augustss 	}
   1180    1.1  augustss  done:
   1181   1.92  augustss 	DPRINTFN(12, ("uhci_check_intr: ii=%p done\n", ii));
   1182   1.96  augustss 	usb_uncallout(ii->xfer->timeout_handle, uhci_timeout, ii);
   1183   1.36  augustss 	uhci_idone(ii);
   1184    1.1  augustss }
   1185    1.1  augustss 
   1186   1.52  augustss /* Called at splusb() */
   1187    1.1  augustss void
   1188   1.36  augustss uhci_idone(ii)
   1189    1.1  augustss 	uhci_intr_info_t *ii;
   1190    1.1  augustss {
   1191   1.63  augustss 	usbd_xfer_handle xfer = ii->xfer;
   1192   1.63  augustss 	struct uhci_pipe *upipe = (struct uhci_pipe *)xfer->pipe;
   1193    1.1  augustss 	uhci_soft_td_t *std;
   1194   1.67  augustss 	u_int32_t status = 0, nstatus;
   1195   1.26  augustss 	int actlen;
   1196    1.1  augustss 
   1197    1.7  augustss #ifdef DIAGNOSTIC
   1198    1.7  augustss 	{
   1199    1.7  augustss 		int s = splhigh();
   1200    1.7  augustss 		if (ii->isdone) {
   1201   1.26  augustss 			splx(s);
   1202   1.92  augustss #ifdef UHCI_DEBUG
   1203   1.92  augustss 			printf("uhci_idone: ii is done!\n   ");
   1204   1.92  augustss 			uhci_dump_ii(ii);
   1205   1.92  augustss #else
   1206   1.36  augustss 			printf("uhci_idone: ii=%p is done!\n", ii);
   1207   1.92  augustss #endif
   1208    1.7  augustss 			return;
   1209    1.7  augustss 		}
   1210    1.7  augustss 		ii->isdone = 1;
   1211    1.7  augustss 		splx(s);
   1212    1.7  augustss 	}
   1213    1.7  augustss #endif
   1214    1.1  augustss 
   1215   1.63  augustss 	if (xfer->status == USBD_CANCELLED ||
   1216   1.63  augustss 	    xfer->status == USBD_TIMEOUT) {
   1217   1.63  augustss 		DPRINTF(("uhci_idone: aborted xfer=%p\n", xfer));
   1218   1.48  augustss 		return;
   1219   1.48  augustss 	}
   1220   1.48  augustss 
   1221   1.63  augustss 	if (xfer->nframes != 0) {
   1222   1.48  augustss 		/* Isoc transfer, do things differently. */
   1223   1.48  augustss 		uhci_soft_td_t **stds = upipe->u.iso.stds;
   1224   1.48  augustss 		int i, n, nframes;
   1225   1.48  augustss 
   1226   1.48  augustss 		DPRINTFN(5,("uhci_idone: ii=%p isoc ready\n", ii));
   1227   1.48  augustss 
   1228   1.63  augustss 		nframes = xfer->nframes;
   1229   1.48  augustss 		actlen = 0;
   1230   1.92  augustss 		n = UXFER(xfer)->curframe;
   1231   1.48  augustss 		for (i = 0; i < nframes; i++) {
   1232   1.48  augustss 			std = stds[n];
   1233   1.59  augustss #ifdef UHCI_DEBUG
   1234   1.48  augustss 			if (uhcidebug > 5) {
   1235   1.48  augustss 				DPRINTFN(-1,("uhci_idone: isoc TD %d\n", i));
   1236   1.48  augustss 				uhci_dump_td(std);
   1237   1.48  augustss 			}
   1238   1.48  augustss #endif
   1239   1.48  augustss 			if (++n >= UHCI_VFRAMELIST_COUNT)
   1240   1.48  augustss 				n = 0;
   1241   1.88   tsutsui 			status = le32toh(std->td.td_status);
   1242   1.48  augustss 			actlen += UHCI_TD_GET_ACTLEN(status);
   1243   1.48  augustss 		}
   1244   1.48  augustss 		upipe->u.iso.inuse -= nframes;
   1245   1.63  augustss 		xfer->actlen = actlen;
   1246   1.63  augustss 		xfer->status = USBD_NORMAL_COMPLETION;
   1247   1.63  augustss 		usb_transfer_complete(xfer);
   1248   1.48  augustss 		return;
   1249   1.48  augustss 	}
   1250   1.48  augustss 
   1251   1.59  augustss #ifdef UHCI_DEBUG
   1252   1.65  augustss 	DPRINTFN(10, ("uhci_idone: ii=%p, xfer=%p, pipe=%p ready\n",
   1253   1.65  augustss 		      ii, xfer, upipe));
   1254   1.48  augustss 	if (uhcidebug > 10)
   1255   1.48  augustss 		uhci_dump_tds(ii->stdstart);
   1256   1.48  augustss #endif
   1257   1.48  augustss 
   1258   1.26  augustss 	/* The transfer is done, compute actual length and status. */
   1259   1.26  augustss 	actlen = 0;
   1260   1.63  augustss 	for (std = ii->stdstart; std != NULL; std = std->link.std) {
   1261   1.88   tsutsui 		nstatus = le32toh(std->td.td_status);
   1262   1.64  augustss 		if (nstatus & UHCI_TD_ACTIVE)
   1263   1.26  augustss 			break;
   1264   1.67  augustss 
   1265   1.64  augustss 		status = nstatus;
   1266   1.88   tsutsui 		if (UHCI_TD_GET_PID(le32toh(std->td.td_token)) !=
   1267   1.88   tsutsui 			UHCI_TD_PID_SETUP)
   1268   1.26  augustss 			actlen += UHCI_TD_GET_ACTLEN(status);
   1269    1.1  augustss 	}
   1270   1.38  augustss 	/* If there are left over TDs we need to update the toggle. */
   1271   1.63  augustss 	if (std != NULL)
   1272   1.88   tsutsui 		upipe->nexttoggle = UHCI_TD_GET_DT(le32toh(std->td.td_token));
   1273   1.38  augustss 
   1274    1.1  augustss 	status &= UHCI_TD_ERROR;
   1275   1.26  augustss 	DPRINTFN(10, ("uhci_check_intr: actlen=%d, status=0x%x\n",
   1276   1.26  augustss 		      actlen, status));
   1277   1.63  augustss 	xfer->actlen = actlen;
   1278    1.1  augustss 	if (status != 0) {
   1279   1.75  augustss 		DPRINTFN((status == UHCI_TD_STALLED)*10,
   1280   1.36  augustss 			 ("uhci_idone: error, addr=%d, endpt=0x%02x, "
   1281   1.17  augustss 			  "status 0x%b\n",
   1282   1.63  augustss 			  xfer->pipe->device->address,
   1283   1.63  augustss 			  xfer->pipe->endpoint->edesc->bEndpointAddress,
   1284   1.21  augustss 			  (int)status,
   1285   1.12  augustss 			  "\20\22BITSTUFF\23CRCTO\24NAK\25BABBLE\26DBUFFER\27"
   1286   1.12  augustss 			  "STALLED\30ACTIVE"));
   1287    1.1  augustss 		if (status == UHCI_TD_STALLED)
   1288   1.63  augustss 			xfer->status = USBD_STALLED;
   1289    1.1  augustss 		else
   1290   1.63  augustss 			xfer->status = USBD_IOERROR; /* more info XXX */
   1291    1.1  augustss 	} else {
   1292   1.63  augustss 		xfer->status = USBD_NORMAL_COMPLETION;
   1293    1.1  augustss 	}
   1294   1.63  augustss 	usb_transfer_complete(xfer);
   1295    1.1  augustss }
   1296    1.1  augustss 
   1297   1.13  augustss /*
   1298   1.13  augustss  * Called when a request does not complete.
   1299   1.13  augustss  */
   1300    1.1  augustss void
   1301    1.1  augustss uhci_timeout(addr)
   1302    1.1  augustss 	void *addr;
   1303    1.1  augustss {
   1304    1.1  augustss 	uhci_intr_info_t *ii = addr;
   1305    1.1  augustss 
   1306    1.1  augustss 	DPRINTF(("uhci_timeout: ii=%p\n", ii));
   1307   1.51  augustss 
   1308   1.67  augustss #ifdef UHCI_DEBUG
   1309   1.67  augustss 	if (uhcidebug > 10)
   1310   1.67  augustss 		uhci_dump_tds(ii->stdstart);
   1311   1.67  augustss #endif
   1312   1.67  augustss 
   1313   1.63  augustss 	ii->xfer->device->bus->intr_context++;
   1314   1.66  augustss 	uhci_abort_xfer(ii->xfer, USBD_TIMEOUT);
   1315   1.63  augustss 	ii->xfer->device->bus->intr_context--;
   1316    1.1  augustss }
   1317    1.1  augustss 
   1318    1.1  augustss /*
   1319    1.1  augustss  * Wait here until controller claims to have an interrupt.
   1320    1.1  augustss  * Then call uhci_intr and return.  Use timeout to avoid waiting
   1321    1.1  augustss  * too long.
   1322   1.13  augustss  * Only used during boot when interrupts are not enabled yet.
   1323    1.1  augustss  */
   1324    1.1  augustss void
   1325   1.63  augustss uhci_waitintr(sc, xfer)
   1326    1.1  augustss 	uhci_softc_t *sc;
   1327   1.63  augustss 	usbd_xfer_handle xfer;
   1328    1.1  augustss {
   1329   1.63  augustss 	int timo = xfer->timeout;
   1330   1.13  augustss 	uhci_intr_info_t *ii;
   1331   1.13  augustss 
   1332   1.26  augustss 	DPRINTFN(10,("uhci_waitintr: timeout = %dms\n", timo));
   1333    1.1  augustss 
   1334   1.63  augustss 	xfer->status = USBD_IN_PROGRESS;
   1335   1.26  augustss 	for (; timo >= 0; timo--) {
   1336   1.20  augustss 		usb_delay_ms(&sc->sc_bus, 1);
   1337   1.26  augustss 		DPRINTFN(20,("uhci_waitintr: 0x%04x\n", UREAD2(sc, UHCI_STS)));
   1338    1.1  augustss 		if (UREAD2(sc, UHCI_STS) & UHCI_STS_USBINT) {
   1339    1.1  augustss 			uhci_intr(sc);
   1340   1.63  augustss 			if (xfer->status != USBD_IN_PROGRESS)
   1341    1.1  augustss 				return;
   1342    1.1  augustss 		}
   1343    1.1  augustss 	}
   1344   1.13  augustss 
   1345   1.13  augustss 	/* Timeout */
   1346   1.13  augustss 	DPRINTF(("uhci_waitintr: timeout\n"));
   1347   1.13  augustss 	for (ii = LIST_FIRST(&sc->sc_intrhead);
   1348   1.63  augustss 	     ii != NULL && ii->xfer != xfer;
   1349   1.13  augustss 	     ii = LIST_NEXT(ii, list))
   1350   1.13  augustss 		;
   1351   1.41  augustss #ifdef DIAGNOSTIC
   1352   1.63  augustss 	if (ii == NULL)
   1353   1.13  augustss 		panic("uhci_waitintr: lost intr_info\n");
   1354   1.41  augustss #endif
   1355   1.41  augustss 	uhci_idone(ii);
   1356    1.1  augustss }
   1357    1.1  augustss 
   1358    1.8  augustss void
   1359    1.8  augustss uhci_poll(bus)
   1360    1.8  augustss 	struct usbd_bus *bus;
   1361    1.8  augustss {
   1362    1.8  augustss 	uhci_softc_t *sc = (uhci_softc_t *)bus;
   1363    1.8  augustss 
   1364    1.8  augustss 	if (UREAD2(sc, UHCI_STS) & UHCI_STS_USBINT)
   1365    1.8  augustss 		uhci_intr(sc);
   1366    1.8  augustss }
   1367    1.8  augustss 
   1368    1.1  augustss #if 0
   1369    1.1  augustss void
   1370   1.92  augustss uhci_reset(sc)
   1371   1.92  augustss 	uhci_softc_t *sc;
   1372    1.1  augustss {
   1373    1.1  augustss 	int n;
   1374    1.1  augustss 
   1375    1.1  augustss 	UHCICMD(sc, UHCI_CMD_HCRESET);
   1376    1.1  augustss 	/* The reset bit goes low when the controller is done. */
   1377    1.1  augustss 	for (n = 0; n < UHCI_RESET_TIMEOUT &&
   1378    1.1  augustss 		    (UREAD2(sc, UHCI_CMD) & UHCI_CMD_HCRESET); n++)
   1379   1.92  augustss 		usb_delay_ms(&sc->sc_bus, 1);
   1380    1.1  augustss 	if (n >= UHCI_RESET_TIMEOUT)
   1381   1.13  augustss 		printf("%s: controller did not reset\n",
   1382   1.13  augustss 		       USBDEVNAME(sc->sc_bus.bdev));
   1383    1.1  augustss }
   1384    1.1  augustss #endif
   1385    1.1  augustss 
   1386   1.16  augustss usbd_status
   1387    1.1  augustss uhci_run(sc, run)
   1388    1.1  augustss 	uhci_softc_t *sc;
   1389    1.1  augustss 	int run;
   1390    1.1  augustss {
   1391    1.1  augustss 	int s, n, running;
   1392   1.71  augustss 	u_int16_t cmd;
   1393    1.1  augustss 
   1394    1.1  augustss 	run = run != 0;
   1395   1.16  augustss 	s = splusb();
   1396   1.30  augustss 	DPRINTF(("uhci_run: setting run=%d\n", run));
   1397   1.71  augustss 	cmd = UREAD2(sc, UHCI_CMD);
   1398   1.71  augustss 	if (run)
   1399   1.71  augustss 		cmd |= UHCI_CMD_RS;
   1400   1.71  augustss 	else
   1401   1.71  augustss 		cmd &= ~UHCI_CMD_RS;
   1402   1.71  augustss 	UHCICMD(sc, cmd);
   1403   1.13  augustss 	for(n = 0; n < 10; n++) {
   1404    1.1  augustss 		running = !(UREAD2(sc, UHCI_STS) & UHCI_STS_HCH);
   1405    1.1  augustss 		/* return when we've entered the state we want */
   1406    1.1  augustss 		if (run == running) {
   1407    1.1  augustss 			splx(s);
   1408   1.30  augustss 			DPRINTF(("uhci_run: done cmd=0x%x sts=0x%x\n",
   1409   1.30  augustss 				 UREAD2(sc, UHCI_CMD), UREAD2(sc, UHCI_STS)));
   1410   1.16  augustss 			return (USBD_NORMAL_COMPLETION);
   1411    1.1  augustss 		}
   1412   1.20  augustss 		usb_delay_ms(&sc->sc_bus, 1);
   1413    1.1  augustss 	}
   1414    1.1  augustss 	splx(s);
   1415   1.13  augustss 	printf("%s: cannot %s\n", USBDEVNAME(sc->sc_bus.bdev),
   1416   1.14  augustss 	       run ? "start" : "stop");
   1417   1.16  augustss 	return (USBD_IOERROR);
   1418    1.1  augustss }
   1419    1.1  augustss 
   1420    1.1  augustss /*
   1421    1.1  augustss  * Memory management routines.
   1422    1.1  augustss  *  uhci_alloc_std allocates TDs
   1423    1.1  augustss  *  uhci_alloc_sqh allocates QHs
   1424    1.7  augustss  * These two routines do their own free list management,
   1425    1.1  augustss  * partly for speed, partly because allocating DMAable memory
   1426    1.1  augustss  * has page size granularaity so much memory would be wasted if
   1427   1.16  augustss  * only one TD/QH (32 bytes) was placed in each allocated chunk.
   1428    1.1  augustss  */
   1429    1.1  augustss 
   1430    1.1  augustss uhci_soft_td_t *
   1431    1.1  augustss uhci_alloc_std(sc)
   1432    1.1  augustss 	uhci_softc_t *sc;
   1433    1.1  augustss {
   1434    1.1  augustss 	uhci_soft_td_t *std;
   1435   1.63  augustss 	usbd_status err;
   1436   1.42  augustss 	int i, offs;
   1437    1.7  augustss 	usb_dma_t dma;
   1438    1.1  augustss 
   1439   1.63  augustss 	if (sc->sc_freetds == NULL) {
   1440    1.1  augustss 		DPRINTFN(2,("uhci_alloc_std: allocating chunk\n"));
   1441   1.63  augustss 		err = usb_allocmem(&sc->sc_bus, UHCI_STD_SIZE * UHCI_STD_CHUNK,
   1442   1.63  augustss 			  UHCI_TD_ALIGN, &dma);
   1443   1.63  augustss 		if (err)
   1444   1.16  augustss 			return (0);
   1445   1.43  augustss 		for(i = 0; i < UHCI_STD_CHUNK; i++) {
   1446   1.42  augustss 			offs = i * UHCI_STD_SIZE;
   1447   1.42  augustss 			std = (uhci_soft_td_t *)((char *)KERNADDR(&dma) +offs);
   1448   1.42  augustss 			std->physaddr = DMAADDR(&dma) + offs;
   1449   1.42  augustss 			std->link.std = sc->sc_freetds;
   1450    1.1  augustss 			sc->sc_freetds = std;
   1451    1.1  augustss 		}
   1452    1.1  augustss 	}
   1453    1.1  augustss 	std = sc->sc_freetds;
   1454   1.42  augustss 	sc->sc_freetds = std->link.std;
   1455   1.42  augustss 	memset(&std->td, 0, sizeof(uhci_td_t));
   1456    1.1  augustss 	return std;
   1457    1.1  augustss }
   1458    1.1  augustss 
   1459    1.1  augustss void
   1460    1.1  augustss uhci_free_std(sc, std)
   1461    1.1  augustss 	uhci_softc_t *sc;
   1462    1.1  augustss 	uhci_soft_td_t *std;
   1463    1.1  augustss {
   1464    1.7  augustss #ifdef DIAGNOSTIC
   1465    1.7  augustss #define TD_IS_FREE 0x12345678
   1466   1.88   tsutsui 	if (le32toh(std->td.td_token) == TD_IS_FREE) {
   1467    1.7  augustss 		printf("uhci_free_std: freeing free TD %p\n", std);
   1468    1.7  augustss 		return;
   1469    1.7  augustss 	}
   1470   1.88   tsutsui 	std->td.td_token = htole32(TD_IS_FREE);
   1471    1.7  augustss #endif
   1472   1.42  augustss 	std->link.std = sc->sc_freetds;
   1473    1.1  augustss 	sc->sc_freetds = std;
   1474    1.1  augustss }
   1475    1.1  augustss 
   1476    1.1  augustss uhci_soft_qh_t *
   1477    1.1  augustss uhci_alloc_sqh(sc)
   1478    1.1  augustss 	uhci_softc_t *sc;
   1479    1.1  augustss {
   1480    1.1  augustss 	uhci_soft_qh_t *sqh;
   1481   1.63  augustss 	usbd_status err;
   1482    1.1  augustss 	int i, offs;
   1483    1.7  augustss 	usb_dma_t dma;
   1484    1.1  augustss 
   1485   1.63  augustss 	if (sc->sc_freeqhs == NULL) {
   1486    1.1  augustss 		DPRINTFN(2, ("uhci_alloc_sqh: allocating chunk\n"));
   1487   1.63  augustss 		err = usb_allocmem(&sc->sc_bus, UHCI_SQH_SIZE * UHCI_SQH_CHUNK,
   1488   1.63  augustss 			  UHCI_QH_ALIGN, &dma);
   1489   1.63  augustss 		if (err)
   1490   1.63  augustss 			return (0);
   1491   1.43  augustss 		for(i = 0; i < UHCI_SQH_CHUNK; i++) {
   1492   1.42  augustss 			offs = i * UHCI_SQH_SIZE;
   1493   1.42  augustss 			sqh = (uhci_soft_qh_t *)((char *)KERNADDR(&dma) +offs);
   1494    1.1  augustss 			sqh->physaddr = DMAADDR(&dma) + offs;
   1495   1.42  augustss 			sqh->hlink = sc->sc_freeqhs;
   1496    1.1  augustss 			sc->sc_freeqhs = sqh;
   1497    1.1  augustss 		}
   1498    1.1  augustss 	}
   1499    1.1  augustss 	sqh = sc->sc_freeqhs;
   1500   1.42  augustss 	sc->sc_freeqhs = sqh->hlink;
   1501   1.42  augustss 	memset(&sqh->qh, 0, sizeof(uhci_qh_t));
   1502   1.16  augustss 	return (sqh);
   1503    1.1  augustss }
   1504    1.1  augustss 
   1505    1.1  augustss void
   1506    1.1  augustss uhci_free_sqh(sc, sqh)
   1507    1.1  augustss 	uhci_softc_t *sc;
   1508    1.1  augustss 	uhci_soft_qh_t *sqh;
   1509    1.1  augustss {
   1510   1.42  augustss 	sqh->hlink = sc->sc_freeqhs;
   1511    1.1  augustss 	sc->sc_freeqhs = sqh;
   1512    1.1  augustss }
   1513    1.1  augustss 
   1514    1.1  augustss void
   1515    1.1  augustss uhci_free_std_chain(sc, std, stdend)
   1516    1.1  augustss 	uhci_softc_t *sc;
   1517    1.1  augustss 	uhci_soft_td_t *std;
   1518    1.1  augustss 	uhci_soft_td_t *stdend;
   1519    1.1  augustss {
   1520    1.1  augustss 	uhci_soft_td_t *p;
   1521    1.1  augustss 
   1522    1.1  augustss 	for (; std != stdend; std = p) {
   1523   1.42  augustss 		p = std->link.std;
   1524    1.1  augustss 		uhci_free_std(sc, std);
   1525    1.1  augustss 	}
   1526    1.1  augustss }
   1527    1.1  augustss 
   1528    1.1  augustss usbd_status
   1529   1.73  augustss uhci_alloc_std_chain(upipe, sc, len, rd, flags, dma, sp, ep)
   1530    1.1  augustss 	struct uhci_pipe *upipe;
   1531    1.1  augustss 	uhci_softc_t *sc;
   1532   1.73  augustss 	int len, rd;
   1533   1.73  augustss 	u_int16_t flags;
   1534    1.7  augustss 	usb_dma_t *dma;
   1535    1.1  augustss 	uhci_soft_td_t **sp, **ep;
   1536    1.1  augustss {
   1537    1.1  augustss 	uhci_soft_td_t *p, *lastp;
   1538    1.1  augustss 	uhci_physaddr_t lastlink;
   1539    1.1  augustss 	int i, ntd, l, tog, maxp;
   1540   1.18  augustss 	u_int32_t status;
   1541    1.1  augustss 	int addr = upipe->pipe.device->address;
   1542    1.1  augustss 	int endpt = upipe->pipe.endpoint->edesc->bEndpointAddress;
   1543    1.1  augustss 
   1544   1.33  augustss 	DPRINTFN(8, ("uhci_alloc_std_chain: addr=%d endpt=%d len=%d ls=%d "
   1545   1.73  augustss 		      "flags=0x%x\n", addr, UE_GET_ADDR(endpt), len,
   1546   1.73  augustss 		      upipe->pipe.device->lowspeed, flags));
   1547    1.4  augustss 	maxp = UGETW(upipe->pipe.endpoint->edesc->wMaxPacketSize);
   1548    1.1  augustss 	if (maxp == 0) {
   1549    1.1  augustss 		printf("uhci_alloc_std_chain: maxp=0\n");
   1550    1.1  augustss 		return (USBD_INVAL);
   1551    1.1  augustss 	}
   1552    1.1  augustss 	ntd = (len + maxp - 1) / maxp;
   1553   1.73  augustss 	if ((flags & USBD_FORCE_SHORT_XFER) && len % maxp == 0)
   1554   1.73  augustss 		ntd++;
   1555   1.39  augustss 	DPRINTFN(10, ("uhci_alloc_std_chain: maxp=%d ntd=%d\n", maxp, ntd));
   1556   1.73  augustss 	if (ntd == 0) {
   1557   1.73  augustss 		*sp = *ep = 0;
   1558   1.73  augustss 		DPRINTFN(-1,("uhci_alloc_std_chain: ntd=0\n"));
   1559   1.73  augustss 		return (USBD_NORMAL_COMPLETION);
   1560   1.73  augustss 	}
   1561   1.38  augustss 	tog = upipe->nexttoggle;
   1562    1.1  augustss 	if (ntd % 2 == 0)
   1563    1.1  augustss 		tog ^= 1;
   1564   1.32  augustss 	upipe->nexttoggle = tog ^ 1;
   1565    1.1  augustss 	lastp = 0;
   1566    1.1  augustss 	lastlink = UHCI_PTR_T;
   1567    1.1  augustss 	ntd--;
   1568   1.33  augustss 	status = UHCI_TD_ZERO_ACTLEN(UHCI_TD_SET_ERRCNT(3) | UHCI_TD_ACTIVE);
   1569   1.18  augustss 	if (upipe->pipe.device->lowspeed)
   1570   1.18  augustss 		status |= UHCI_TD_LS;
   1571   1.73  augustss 	if (flags & USBD_SHORT_XFER_OK)
   1572   1.18  augustss 		status |= UHCI_TD_SPD;
   1573    1.1  augustss 	for (i = ntd; i >= 0; i--) {
   1574    1.1  augustss 		p = uhci_alloc_std(sc);
   1575   1.63  augustss 		if (p == NULL) {
   1576    1.1  augustss 			uhci_free_std_chain(sc, lastp, 0);
   1577    1.1  augustss 			return (USBD_NOMEM);
   1578    1.1  augustss 		}
   1579   1.42  augustss 		p->link.std = lastp;
   1580   1.69  augustss 		if (lastlink == UHCI_PTR_T)
   1581   1.88   tsutsui 			p->td.td_link = htole32(lastlink);
   1582   1.69  augustss 		else
   1583   1.88   tsutsui 			p->td.td_link = htole32(lastlink|UHCI_PTR_VF);
   1584    1.1  augustss 		lastp = p;
   1585    1.1  augustss 		lastlink = p->physaddr;
   1586   1.88   tsutsui 		p->td.td_status = htole32(status);
   1587    1.1  augustss 		if (i == ntd) {
   1588    1.1  augustss 			/* last TD */
   1589    1.1  augustss 			l = len % maxp;
   1590   1.73  augustss 			if (l == 0 && !(flags & USBD_FORCE_SHORT_XFER))
   1591   1.73  augustss 				l = maxp;
   1592    1.1  augustss 			*ep = p;
   1593    1.1  augustss 		} else
   1594    1.1  augustss 			l = maxp;
   1595   1.42  augustss 		p->td.td_token =
   1596   1.88   tsutsui 		    htole32(rd ? UHCI_TD_IN (l, endpt, addr, tog) :
   1597   1.88   tsutsui 				 UHCI_TD_OUT(l, endpt, addr, tog));
   1598   1.88   tsutsui 		p->td.td_buffer = htole32(DMAADDR(dma) + i * maxp);
   1599    1.1  augustss 		tog ^= 1;
   1600    1.1  augustss 	}
   1601    1.1  augustss 	*sp = lastp;
   1602   1.38  augustss 	DPRINTFN(10, ("uhci_alloc_std_chain: nexttog=%d\n",
   1603   1.38  augustss 		      upipe->nexttoggle));
   1604    1.1  augustss 	return (USBD_NORMAL_COMPLETION);
   1605    1.1  augustss }
   1606    1.1  augustss 
   1607   1.38  augustss void
   1608   1.38  augustss uhci_device_clear_toggle(pipe)
   1609   1.38  augustss 	usbd_pipe_handle pipe;
   1610   1.38  augustss {
   1611   1.38  augustss 	struct uhci_pipe *upipe = (struct uhci_pipe *)pipe;
   1612   1.38  augustss 	upipe->nexttoggle = 0;
   1613   1.38  augustss }
   1614   1.38  augustss 
   1615   1.38  augustss void
   1616   1.38  augustss uhci_noop(pipe)
   1617   1.38  augustss 	usbd_pipe_handle pipe;
   1618   1.38  augustss {
   1619   1.38  augustss }
   1620   1.38  augustss 
   1621    1.1  augustss usbd_status
   1622   1.63  augustss uhci_device_bulk_transfer(xfer)
   1623   1.63  augustss 	usbd_xfer_handle xfer;
   1624    1.1  augustss {
   1625   1.63  augustss 	usbd_status err;
   1626   1.16  augustss 
   1627   1.52  augustss 	/* Insert last in queue. */
   1628   1.63  augustss 	err = usb_insert_transfer(xfer);
   1629   1.63  augustss 	if (err)
   1630   1.63  augustss 		return (err);
   1631   1.52  augustss 
   1632   1.92  augustss 	/*
   1633   1.92  augustss 	 * Pipe isn't running (otherwise err would be USBD_INPROG),
   1634   1.92  augustss 	 * so start it first.
   1635   1.67  augustss 	 */
   1636   1.63  augustss 	return (uhci_device_bulk_start(SIMPLEQ_FIRST(&xfer->pipe->queue)));
   1637   1.16  augustss }
   1638   1.16  augustss 
   1639   1.16  augustss usbd_status
   1640   1.63  augustss uhci_device_bulk_start(xfer)
   1641   1.63  augustss 	usbd_xfer_handle xfer;
   1642   1.16  augustss {
   1643   1.63  augustss 	struct uhci_pipe *upipe = (struct uhci_pipe *)xfer->pipe;
   1644    1.1  augustss 	usbd_device_handle dev = upipe->pipe.device;
   1645    1.1  augustss 	uhci_softc_t *sc = (uhci_softc_t *)dev->bus;
   1646   1.92  augustss 	uhci_intr_info_t *ii = &UXFER(xfer)->iinfo;
   1647   1.55  augustss 	uhci_soft_td_t *data, *dataend;
   1648    1.1  augustss 	uhci_soft_qh_t *sqh;
   1649   1.63  augustss 	usbd_status err;
   1650   1.45  augustss 	int len, isread, endpt;
   1651    1.1  augustss 	int s;
   1652    1.1  augustss 
   1653   1.63  augustss 	DPRINTFN(3, ("uhci_device_bulk_transfer: xfer=%p len=%d flags=%d\n",
   1654   1.63  augustss 		     xfer, xfer->length, xfer->flags));
   1655    1.1  augustss 
   1656   1.82  augustss 	if (sc->sc_dying)
   1657   1.82  augustss 		return (USBD_IOERROR);
   1658   1.82  augustss 
   1659   1.48  augustss #ifdef DIAGNOSTIC
   1660   1.63  augustss 	if (xfer->rqflags & URQ_REQUEST)
   1661    1.1  augustss 		panic("uhci_device_bulk_transfer: a request\n");
   1662   1.48  augustss #endif
   1663    1.1  augustss 
   1664   1.63  augustss 	len = xfer->length;
   1665  1.102  augustss 	endpt = upipe->pipe.endpoint->edesc->bEndpointAddress;
   1666   1.45  augustss 	isread = UE_GET_DIR(endpt) == UE_DIR_IN;
   1667    1.1  augustss 	sqh = upipe->u.bulk.sqh;
   1668    1.1  augustss 
   1669    1.1  augustss 	upipe->u.bulk.isread = isread;
   1670    1.1  augustss 	upipe->u.bulk.length = len;
   1671    1.1  augustss 
   1672   1.73  augustss 	err = uhci_alloc_std_chain(upipe, sc, len, isread, xfer->flags,
   1673   1.73  augustss 				   &xfer->dmabuf, &data, &dataend);
   1674   1.63  augustss 	if (err)
   1675   1.63  augustss 		return (err);
   1676   1.88   tsutsui 	dataend->td.td_status |= htole32(UHCI_TD_IOC);
   1677    1.1  augustss 
   1678   1.59  augustss #ifdef UHCI_DEBUG
   1679   1.33  augustss 	if (uhcidebug > 8) {
   1680   1.55  augustss 		DPRINTF(("uhci_device_bulk_transfer: data(1)\n"));
   1681   1.55  augustss 		uhci_dump_tds(data);
   1682    1.1  augustss 	}
   1683    1.1  augustss #endif
   1684    1.1  augustss 
   1685    1.1  augustss 	/* Set up interrupt info. */
   1686   1.63  augustss 	ii->xfer = xfer;
   1687   1.55  augustss 	ii->stdstart = data;
   1688   1.55  augustss 	ii->stdend = dataend;
   1689    1.7  augustss #ifdef DIAGNOSTIC
   1690   1.70  augustss 	if (!ii->isdone) {
   1691   1.70  augustss 		printf("uhci_device_bulk_transfer: not done, ii=%p\n", ii);
   1692   1.70  augustss 	}
   1693    1.7  augustss 	ii->isdone = 0;
   1694    1.7  augustss #endif
   1695    1.1  augustss 
   1696   1.55  augustss 	sqh->elink = data;
   1697   1.88   tsutsui 	sqh->qh.qh_elink = htole32(data->physaddr);
   1698    1.1  augustss 
   1699    1.1  augustss 	s = splusb();
   1700    1.1  augustss 	uhci_add_bulk(sc, sqh);
   1701   1.92  augustss 	uhci_add_intr_info(sc, ii);
   1702    1.1  augustss 
   1703   1.63  augustss 	if (xfer->timeout && !sc->sc_bus.use_polling) {
   1704   1.96  augustss 		usb_callout(xfer->timeout_handle, MS_TO_TICKS(xfer->timeout),
   1705   1.91  augustss 			    uhci_timeout, ii);
   1706   1.13  augustss 	}
   1707   1.92  augustss 	xfer->status = USBD_IN_PROGRESS;
   1708    1.1  augustss 	splx(s);
   1709    1.1  augustss 
   1710   1.59  augustss #ifdef UHCI_DEBUG
   1711    1.1  augustss 	if (uhcidebug > 10) {
   1712   1.55  augustss 		DPRINTF(("uhci_device_bulk_transfer: data(2)\n"));
   1713   1.55  augustss 		uhci_dump_tds(data);
   1714    1.1  augustss 	}
   1715    1.1  augustss #endif
   1716    1.1  augustss 
   1717   1.26  augustss 	if (sc->sc_bus.use_polling)
   1718   1.63  augustss 		uhci_waitintr(sc, xfer);
   1719   1.26  augustss 
   1720    1.1  augustss 	return (USBD_IN_PROGRESS);
   1721    1.1  augustss }
   1722    1.1  augustss 
   1723    1.1  augustss /* Abort a device bulk request. */
   1724    1.1  augustss void
   1725   1.63  augustss uhci_device_bulk_abort(xfer)
   1726   1.63  augustss 	usbd_xfer_handle xfer;
   1727    1.1  augustss {
   1728   1.33  augustss 	DPRINTF(("uhci_device_bulk_abort:\n"));
   1729   1.66  augustss 	uhci_abort_xfer(xfer, USBD_CANCELLED);
   1730   1.33  augustss }
   1731   1.33  augustss 
   1732   1.92  augustss /*
   1733  1.106  augustss  * XXX This way of aborting is neither safe, nor good.
   1734  1.106  augustss  * But it will have to do until I figure out what to do.
   1735  1.106  augustss  * I apologize for the delay().
   1736   1.92  augustss  */
   1737   1.33  augustss void
   1738   1.66  augustss uhci_abort_xfer(xfer, status)
   1739   1.63  augustss 	usbd_xfer_handle xfer;
   1740   1.33  augustss 	usbd_status status;
   1741   1.33  augustss {
   1742   1.92  augustss 	uhci_intr_info_t *ii = &UXFER(xfer)->iinfo;
   1743   1.33  augustss 	uhci_soft_td_t *std;
   1744   1.92  augustss 	int s;
   1745   1.65  augustss 
   1746  1.106  augustss 	DPRINTFN(1,("uhci_abort_xfer: xfer=%p, status=%d\n", xfer, status));
   1747   1.33  augustss 
   1748   1.92  augustss 	s = splusb();
   1749   1.92  augustss 
   1750   1.92  augustss 	/* Transfer is already done. */
   1751   1.92  augustss 	if (xfer->status != USBD_NOT_STARTED &&
   1752   1.92  augustss 	    xfer->status != USBD_IN_PROGRESS) {
   1753   1.92  augustss 		splx(s);
   1754   1.92  augustss 		return;
   1755   1.92  augustss 	}
   1756   1.92  augustss 
   1757  1.106  augustss 	/* Make interrupt routine ignore it, */
   1758   1.63  augustss 	xfer->status = status;
   1759   1.41  augustss 
   1760  1.106  augustss 	/* don't timeout, */
   1761  1.106  augustss 	usb_uncallout(xfer->timeout_handle, uhci_timeout, ii);
   1762   1.92  augustss 
   1763  1.106  augustss 	/* make hardware ignore it, */
   1764  1.106  augustss 	for (std = ii->stdstart; std != NULL; std = std->link.std)
   1765   1.92  augustss 		std->td.td_status &= htole32(~(UHCI_TD_ACTIVE | UHCI_TD_IOC));
   1766   1.92  augustss 
   1767  1.106  augustss 	xfer->hcpriv = ii;
   1768   1.96  augustss 
   1769   1.92  augustss 	splx(s);
   1770   1.92  augustss 
   1771  1.106  augustss 	delay(1000);
   1772   1.92  augustss 
   1773   1.92  augustss 	s = splusb();
   1774  1.100  augustss #ifdef DIAGNOSTIC
   1775  1.106  augustss 	ii->isdone = 1;
   1776  1.100  augustss #endif
   1777  1.106  augustss 	usb_transfer_complete(xfer);
   1778   1.33  augustss 	splx(s);
   1779    1.1  augustss }
   1780    1.1  augustss 
   1781    1.1  augustss /* Close a device bulk pipe. */
   1782    1.1  augustss void
   1783    1.1  augustss uhci_device_bulk_close(pipe)
   1784    1.1  augustss 	usbd_pipe_handle pipe;
   1785    1.1  augustss {
   1786    1.1  augustss 	struct uhci_pipe *upipe = (struct uhci_pipe *)pipe;
   1787    1.1  augustss 	usbd_device_handle dev = upipe->pipe.device;
   1788    1.1  augustss 	uhci_softc_t *sc = (uhci_softc_t *)dev->bus;
   1789    1.1  augustss 
   1790    1.1  augustss 	uhci_free_sqh(sc, upipe->u.bulk.sqh);
   1791    1.1  augustss }
   1792    1.1  augustss 
   1793    1.1  augustss usbd_status
   1794   1.63  augustss uhci_device_ctrl_transfer(xfer)
   1795   1.63  augustss 	usbd_xfer_handle xfer;
   1796    1.1  augustss {
   1797   1.63  augustss 	usbd_status err;
   1798   1.16  augustss 
   1799   1.52  augustss 	/* Insert last in queue. */
   1800   1.63  augustss 	err = usb_insert_transfer(xfer);
   1801   1.63  augustss 	if (err)
   1802   1.63  augustss 		return (err);
   1803   1.52  augustss 
   1804   1.92  augustss 	/*
   1805   1.92  augustss 	 * Pipe isn't running (otherwise err would be USBD_INPROG),
   1806   1.92  augustss 	 * so start it first.
   1807   1.67  augustss 	 */
   1808   1.63  augustss 	return (uhci_device_ctrl_start(SIMPLEQ_FIRST(&xfer->pipe->queue)));
   1809   1.16  augustss }
   1810   1.16  augustss 
   1811   1.16  augustss usbd_status
   1812   1.63  augustss uhci_device_ctrl_start(xfer)
   1813   1.63  augustss 	usbd_xfer_handle xfer;
   1814   1.16  augustss {
   1815   1.63  augustss 	uhci_softc_t *sc = (uhci_softc_t *)xfer->pipe->device->bus;
   1816   1.63  augustss 	usbd_status err;
   1817    1.1  augustss 
   1818   1.82  augustss 	if (sc->sc_dying)
   1819   1.82  augustss 		return (USBD_IOERROR);
   1820   1.82  augustss 
   1821   1.48  augustss #ifdef DIAGNOSTIC
   1822   1.63  augustss 	if (!(xfer->rqflags & URQ_REQUEST))
   1823    1.1  augustss 		panic("uhci_device_ctrl_transfer: not a request\n");
   1824   1.48  augustss #endif
   1825    1.1  augustss 
   1826   1.63  augustss 	err = uhci_device_request(xfer);
   1827   1.63  augustss 	if (err)
   1828   1.63  augustss 		return (err);
   1829    1.1  augustss 
   1830    1.9  augustss 	if (sc->sc_bus.use_polling)
   1831   1.63  augustss 		uhci_waitintr(sc, xfer);
   1832    1.1  augustss 	return (USBD_IN_PROGRESS);
   1833    1.1  augustss }
   1834    1.1  augustss 
   1835    1.1  augustss usbd_status
   1836   1.63  augustss uhci_device_intr_transfer(xfer)
   1837   1.63  augustss 	usbd_xfer_handle xfer;
   1838    1.1  augustss {
   1839   1.63  augustss 	usbd_status err;
   1840   1.16  augustss 
   1841   1.52  augustss 	/* Insert last in queue. */
   1842   1.63  augustss 	err = usb_insert_transfer(xfer);
   1843   1.63  augustss 	if (err)
   1844   1.63  augustss 		return (err);
   1845   1.52  augustss 
   1846   1.92  augustss 	/*
   1847   1.92  augustss 	 * Pipe isn't running (otherwise err would be USBD_INPROG),
   1848   1.92  augustss 	 * so start it first.
   1849   1.67  augustss 	 */
   1850   1.63  augustss 	return (uhci_device_intr_start(SIMPLEQ_FIRST(&xfer->pipe->queue)));
   1851   1.16  augustss }
   1852   1.16  augustss 
   1853   1.16  augustss usbd_status
   1854   1.63  augustss uhci_device_intr_start(xfer)
   1855   1.63  augustss 	usbd_xfer_handle xfer;
   1856   1.16  augustss {
   1857   1.63  augustss 	struct uhci_pipe *upipe = (struct uhci_pipe *)xfer->pipe;
   1858    1.1  augustss 	usbd_device_handle dev = upipe->pipe.device;
   1859    1.1  augustss 	uhci_softc_t *sc = (uhci_softc_t *)dev->bus;
   1860   1.92  augustss 	uhci_intr_info_t *ii = &UXFER(xfer)->iinfo;
   1861   1.55  augustss 	uhci_soft_td_t *data, *dataend;
   1862    1.1  augustss 	uhci_soft_qh_t *sqh;
   1863   1.63  augustss 	usbd_status err;
   1864   1.49  augustss 	int i, s;
   1865    1.1  augustss 
   1866   1.82  augustss 	if (sc->sc_dying)
   1867   1.82  augustss 		return (USBD_IOERROR);
   1868   1.82  augustss 
   1869   1.63  augustss 	DPRINTFN(3,("uhci_device_intr_transfer: xfer=%p len=%d flags=%d\n",
   1870   1.63  augustss 		    xfer, xfer->length, xfer->flags));
   1871    1.1  augustss 
   1872   1.48  augustss #ifdef DIAGNOSTIC
   1873   1.63  augustss 	if (xfer->rqflags & URQ_REQUEST)
   1874    1.1  augustss 		panic("uhci_device_intr_transfer: a request\n");
   1875   1.48  augustss #endif
   1876    1.1  augustss 
   1877   1.73  augustss 	err = uhci_alloc_std_chain(upipe, sc, xfer->length, 1, xfer->flags,
   1878   1.73  augustss 				   &xfer->dmabuf, &data, &dataend);
   1879   1.63  augustss 	if (err)
   1880   1.63  augustss 		return (err);
   1881   1.88   tsutsui 	dataend->td.td_status |= htole32(UHCI_TD_IOC);
   1882    1.1  augustss 
   1883   1.59  augustss #ifdef UHCI_DEBUG
   1884    1.1  augustss 	if (uhcidebug > 10) {
   1885   1.55  augustss 		DPRINTF(("uhci_device_intr_transfer: data(1)\n"));
   1886   1.55  augustss 		uhci_dump_tds(data);
   1887    1.1  augustss 		uhci_dump_qh(upipe->u.intr.qhs[0]);
   1888    1.1  augustss 	}
   1889    1.1  augustss #endif
   1890    1.1  augustss 
   1891    1.1  augustss 	s = splusb();
   1892    1.1  augustss 	/* Set up interrupt info. */
   1893   1.63  augustss 	ii->xfer = xfer;
   1894   1.55  augustss 	ii->stdstart = data;
   1895   1.55  augustss 	ii->stdend = dataend;
   1896    1.7  augustss #ifdef DIAGNOSTIC
   1897   1.70  augustss 	if (!ii->isdone) {
   1898   1.70  augustss 		printf("uhci_device_intr_transfer: not done, ii=%p\n", ii);
   1899   1.70  augustss 	}
   1900    1.7  augustss 	ii->isdone = 0;
   1901    1.7  augustss #endif
   1902    1.1  augustss 
   1903   1.12  augustss 	DPRINTFN(10,("uhci_device_intr_transfer: qhs[0]=%p\n",
   1904   1.12  augustss 		     upipe->u.intr.qhs[0]));
   1905    1.1  augustss 	for (i = 0; i < upipe->u.intr.npoll; i++) {
   1906    1.1  augustss 		sqh = upipe->u.intr.qhs[i];
   1907   1.55  augustss 		sqh->elink = data;
   1908   1.88   tsutsui 		sqh->qh.qh_elink = htole32(data->physaddr);
   1909    1.1  augustss 	}
   1910   1.92  augustss 	uhci_add_intr_info(sc, ii);
   1911   1.92  augustss 	xfer->status = USBD_IN_PROGRESS;
   1912    1.1  augustss 	splx(s);
   1913    1.1  augustss 
   1914   1.59  augustss #ifdef UHCI_DEBUG
   1915    1.1  augustss 	if (uhcidebug > 10) {
   1916   1.55  augustss 		DPRINTF(("uhci_device_intr_transfer: data(2)\n"));
   1917   1.55  augustss 		uhci_dump_tds(data);
   1918    1.1  augustss 		uhci_dump_qh(upipe->u.intr.qhs[0]);
   1919    1.1  augustss 	}
   1920    1.1  augustss #endif
   1921    1.1  augustss 
   1922    1.1  augustss 	return (USBD_IN_PROGRESS);
   1923    1.1  augustss }
   1924    1.1  augustss 
   1925    1.1  augustss /* Abort a device control request. */
   1926    1.1  augustss void
   1927   1.63  augustss uhci_device_ctrl_abort(xfer)
   1928   1.63  augustss 	usbd_xfer_handle xfer;
   1929    1.1  augustss {
   1930   1.33  augustss 	DPRINTF(("uhci_device_ctrl_abort:\n"));
   1931   1.66  augustss 	uhci_abort_xfer(xfer, USBD_CANCELLED);
   1932    1.1  augustss }
   1933    1.1  augustss 
   1934    1.1  augustss /* Close a device control pipe. */
   1935    1.1  augustss void
   1936    1.1  augustss uhci_device_ctrl_close(pipe)
   1937    1.1  augustss 	usbd_pipe_handle pipe;
   1938    1.1  augustss {
   1939    1.1  augustss }
   1940    1.1  augustss 
   1941    1.1  augustss /* Abort a device interrupt request. */
   1942    1.1  augustss void
   1943   1.63  augustss uhci_device_intr_abort(xfer)
   1944   1.63  augustss 	usbd_xfer_handle xfer;
   1945    1.1  augustss {
   1946   1.63  augustss 	DPRINTFN(1,("uhci_device_intr_abort: xfer=%p\n", xfer));
   1947   1.63  augustss 	if (xfer->pipe->intrxfer == xfer) {
   1948   1.36  augustss 		DPRINTFN(1,("uhci_device_intr_abort: remove\n"));
   1949   1.63  augustss 		xfer->pipe->intrxfer = 0;
   1950    1.1  augustss 	}
   1951   1.66  augustss 	uhci_abort_xfer(xfer, USBD_CANCELLED);
   1952    1.1  augustss }
   1953    1.1  augustss 
   1954    1.1  augustss /* Close a device interrupt pipe. */
   1955    1.1  augustss void
   1956    1.1  augustss uhci_device_intr_close(pipe)
   1957    1.1  augustss 	usbd_pipe_handle pipe;
   1958    1.1  augustss {
   1959    1.1  augustss 	struct uhci_pipe *upipe = (struct uhci_pipe *)pipe;
   1960    1.1  augustss 	uhci_softc_t *sc = (uhci_softc_t *)pipe->device->bus;
   1961   1.92  augustss 	int i, npoll;
   1962   1.92  augustss 	int s;
   1963    1.1  augustss 
   1964    1.1  augustss 	/* Unlink descriptors from controller data structures. */
   1965    1.1  augustss 	npoll = upipe->u.intr.npoll;
   1966   1.92  augustss 	s = splusb();
   1967    1.1  augustss 	for (i = 0; i < npoll; i++)
   1968   1.92  augustss 		uhci_remove_intr(sc, upipe->u.intr.qhs[i]);
   1969   1.92  augustss 	splx(s);
   1970    1.1  augustss 
   1971    1.1  augustss 	/*
   1972    1.1  augustss 	 * We now have to wait for any activity on the physical
   1973    1.1  augustss 	 * descriptors to stop.
   1974    1.1  augustss 	 */
   1975   1.20  augustss 	usb_delay_ms(&sc->sc_bus, 2);
   1976    1.1  augustss 
   1977    1.1  augustss 	for(i = 0; i < npoll; i++)
   1978    1.1  augustss 		uhci_free_sqh(sc, upipe->u.intr.qhs[i]);
   1979   1.31  augustss 	free(upipe->u.intr.qhs, M_USBHC);
   1980    1.1  augustss 
   1981    1.1  augustss 	/* XXX free other resources */
   1982    1.1  augustss }
   1983    1.1  augustss 
   1984    1.1  augustss usbd_status
   1985   1.63  augustss uhci_device_request(xfer)
   1986   1.63  augustss 	usbd_xfer_handle xfer;
   1987    1.1  augustss {
   1988   1.63  augustss 	struct uhci_pipe *upipe = (struct uhci_pipe *)xfer->pipe;
   1989   1.63  augustss 	usb_device_request_t *req = &xfer->request;
   1990    1.1  augustss 	usbd_device_handle dev = upipe->pipe.device;
   1991    1.1  augustss 	uhci_softc_t *sc = (uhci_softc_t *)dev->bus;
   1992    1.1  augustss 	int addr = dev->address;
   1993    1.1  augustss 	int endpt = upipe->pipe.endpoint->edesc->bEndpointAddress;
   1994   1.92  augustss 	uhci_intr_info_t *ii = &UXFER(xfer)->iinfo;
   1995   1.55  augustss 	uhci_soft_td_t *setup, *data, *stat, *next, *dataend;
   1996    1.1  augustss 	uhci_soft_qh_t *sqh;
   1997    1.1  augustss 	int len;
   1998    1.1  augustss 	u_int32_t ls;
   1999   1.63  augustss 	usbd_status err;
   2000    1.1  augustss 	int isread;
   2001    1.1  augustss 	int s;
   2002    1.1  augustss 
   2003   1.13  augustss 	DPRINTFN(3,("uhci_device_control type=0x%02x, request=0x%02x, "
   2004   1.12  augustss 		    "wValue=0x%04x, wIndex=0x%04x len=%d, addr=%d, endpt=%d\n",
   2005    1.1  augustss 		    req->bmRequestType, req->bRequest, UGETW(req->wValue),
   2006    1.1  augustss 		    UGETW(req->wIndex), UGETW(req->wLength),
   2007    1.1  augustss 		    addr, endpt));
   2008    1.1  augustss 
   2009    1.1  augustss 	ls = dev->lowspeed ? UHCI_TD_LS : 0;
   2010    1.1  augustss 	isread = req->bmRequestType & UT_READ;
   2011    1.1  augustss 	len = UGETW(req->wLength);
   2012    1.1  augustss 
   2013    1.1  augustss 	setup = upipe->u.ctl.setup;
   2014    1.1  augustss 	stat = upipe->u.ctl.stat;
   2015    1.1  augustss 	sqh = upipe->u.ctl.sqh;
   2016    1.1  augustss 
   2017    1.1  augustss 	/* Set up data transaction */
   2018    1.1  augustss 	if (len != 0) {
   2019   1.38  augustss 		upipe->nexttoggle = 1;
   2020   1.73  augustss 		err = uhci_alloc_std_chain(upipe, sc, len, isread, xfer->flags,
   2021   1.73  augustss 					   &xfer->dmabuf, &data, &dataend);
   2022   1.63  augustss 		if (err)
   2023   1.63  augustss 			return (err);
   2024   1.55  augustss 		next = data;
   2025   1.55  augustss 		dataend->link.std = stat;
   2026   1.88   tsutsui 		dataend->td.td_link = htole32(stat->physaddr | UHCI_PTR_VF);
   2027    1.1  augustss 	} else {
   2028    1.1  augustss 		next = stat;
   2029    1.1  augustss 	}
   2030    1.1  augustss 	upipe->u.ctl.length = len;
   2031    1.1  augustss 
   2032    1.1  augustss 	memcpy(KERNADDR(&upipe->u.ctl.reqdma), req, sizeof *req);
   2033    1.1  augustss 
   2034   1.42  augustss 	setup->link.std = next;
   2035   1.88   tsutsui 	setup->td.td_link = htole32(next->physaddr | UHCI_PTR_VF);
   2036   1.88   tsutsui 	setup->td.td_status = htole32(UHCI_TD_SET_ERRCNT(3) | ls |
   2037   1.88   tsutsui 		UHCI_TD_ACTIVE);
   2038   1.88   tsutsui 	setup->td.td_token = htole32(UHCI_TD_SETUP(sizeof *req, endpt, addr));
   2039   1.88   tsutsui 	setup->td.td_buffer = htole32(DMAADDR(&upipe->u.ctl.reqdma));
   2040   1.42  augustss 
   2041   1.92  augustss 	stat->link.std = NULL;
   2042   1.88   tsutsui 	stat->td.td_link = htole32(UHCI_PTR_T);
   2043   1.88   tsutsui 	stat->td.td_status = htole32(UHCI_TD_SET_ERRCNT(3) | ls |
   2044   1.39  augustss 		UHCI_TD_ACTIVE | UHCI_TD_IOC);
   2045   1.42  augustss 	stat->td.td_token =
   2046   1.88   tsutsui 		htole32(isread ? UHCI_TD_OUT(0, endpt, addr, 1) :
   2047   1.88   tsutsui 		                 UHCI_TD_IN (0, endpt, addr, 1));
   2048   1.88   tsutsui 	stat->td.td_buffer = htole32(0);
   2049    1.1  augustss 
   2050   1.59  augustss #ifdef UHCI_DEBUG
   2051   1.67  augustss 	if (uhcidebug > 10) {
   2052   1.47  augustss 		DPRINTF(("uhci_device_request: before transfer\n"));
   2053   1.41  augustss 		uhci_dump_tds(setup);
   2054    1.1  augustss 	}
   2055    1.1  augustss #endif
   2056    1.1  augustss 
   2057    1.1  augustss 	/* Set up interrupt info. */
   2058   1.63  augustss 	ii->xfer = xfer;
   2059    1.1  augustss 	ii->stdstart = setup;
   2060    1.1  augustss 	ii->stdend = stat;
   2061    1.7  augustss #ifdef DIAGNOSTIC
   2062   1.70  augustss 	if (!ii->isdone) {
   2063   1.70  augustss 		printf("uhci_device_request: not done, ii=%p\n", ii);
   2064   1.70  augustss 	}
   2065    1.7  augustss 	ii->isdone = 0;
   2066    1.7  augustss #endif
   2067    1.1  augustss 
   2068   1.42  augustss 	sqh->elink = setup;
   2069   1.88   tsutsui 	sqh->qh.qh_elink = htole32(setup->physaddr);
   2070    1.1  augustss 
   2071    1.1  augustss 	s = splusb();
   2072    1.1  augustss 	uhci_add_ctrl(sc, sqh);
   2073   1.92  augustss 	uhci_add_intr_info(sc, ii);
   2074   1.59  augustss #ifdef UHCI_DEBUG
   2075    1.1  augustss 	if (uhcidebug > 12) {
   2076    1.1  augustss 		uhci_soft_td_t *std;
   2077    1.1  augustss 		uhci_soft_qh_t *xqh;
   2078   1.13  augustss 		uhci_soft_qh_t *sxqh;
   2079   1.13  augustss 		int maxqh = 0;
   2080    1.1  augustss 		uhci_physaddr_t link;
   2081   1.47  augustss 		DPRINTF(("uhci_enter_ctl_q: follow from [0]\n"));
   2082    1.1  augustss 		for (std = sc->sc_vframes[0].htd, link = 0;
   2083    1.1  augustss 		     (link & UHCI_PTR_Q) == 0;
   2084   1.42  augustss 		     std = std->link.std) {
   2085   1.88   tsutsui 			link = le32toh(std->td.td_link);
   2086    1.1  augustss 			uhci_dump_td(std);
   2087    1.1  augustss 		}
   2088   1.67  augustss 		sxqh = (uhci_soft_qh_t *)std;
   2089   1.67  augustss 		uhci_dump_qh(sxqh);
   2090   1.67  augustss 		for (xqh = sxqh;
   2091   1.63  augustss 		     xqh != NULL;
   2092   1.42  augustss 		     xqh = (maxqh++ == 5 || xqh->hlink==sxqh ||
   2093   1.42  augustss                             xqh->hlink==xqh ? NULL : xqh->hlink)) {
   2094    1.1  augustss 			uhci_dump_qh(xqh);
   2095   1.13  augustss 		}
   2096   1.47  augustss 		DPRINTF(("Enqueued QH:\n"));
   2097    1.1  augustss 		uhci_dump_qh(sqh);
   2098   1.42  augustss 		uhci_dump_tds(sqh->elink);
   2099    1.1  augustss 	}
   2100    1.1  augustss #endif
   2101   1.63  augustss 	if (xfer->timeout && !sc->sc_bus.use_polling) {
   2102   1.96  augustss 		usb_callout(xfer->timeout_handle, MS_TO_TICKS(xfer->timeout),
   2103   1.91  augustss 			    uhci_timeout, ii);
   2104   1.13  augustss 	}
   2105   1.92  augustss 	xfer->status = USBD_IN_PROGRESS;
   2106    1.1  augustss 	splx(s);
   2107    1.1  augustss 
   2108    1.1  augustss 	return (USBD_NORMAL_COMPLETION);
   2109    1.1  augustss }
   2110    1.1  augustss 
   2111   1.16  augustss usbd_status
   2112   1.63  augustss uhci_device_isoc_transfer(xfer)
   2113   1.63  augustss 	usbd_xfer_handle xfer;
   2114   1.16  augustss {
   2115   1.63  augustss 	usbd_status err;
   2116   1.48  augustss 
   2117   1.63  augustss 	DPRINTFN(5,("uhci_device_isoc_transfer: xfer=%p\n", xfer));
   2118   1.48  augustss 
   2119   1.48  augustss 	/* Put it on our queue, */
   2120   1.63  augustss 	err = usb_insert_transfer(xfer);
   2121   1.48  augustss 
   2122   1.48  augustss 	/* bail out on error, */
   2123   1.63  augustss 	if (err && err != USBD_IN_PROGRESS)
   2124   1.63  augustss 		return (err);
   2125   1.48  augustss 
   2126   1.48  augustss 	/* XXX should check inuse here */
   2127   1.48  augustss 
   2128   1.48  augustss 	/* insert into schedule, */
   2129   1.63  augustss 	uhci_device_isoc_enter(xfer);
   2130   1.48  augustss 
   2131  1.102  augustss 	/* and start if the pipe wasn't running */
   2132   1.67  augustss 	if (!err)
   2133   1.63  augustss 		uhci_device_isoc_start(SIMPLEQ_FIRST(&xfer->pipe->queue));
   2134   1.48  augustss 
   2135   1.63  augustss 	return (err);
   2136   1.48  augustss }
   2137   1.48  augustss 
   2138   1.48  augustss void
   2139   1.63  augustss uhci_device_isoc_enter(xfer)
   2140   1.63  augustss 	usbd_xfer_handle xfer;
   2141   1.48  augustss {
   2142   1.63  augustss 	struct uhci_pipe *upipe = (struct uhci_pipe *)xfer->pipe;
   2143   1.16  augustss 	usbd_device_handle dev = upipe->pipe.device;
   2144   1.16  augustss 	uhci_softc_t *sc = (uhci_softc_t *)dev->bus;
   2145   1.48  augustss 	struct iso *iso = &upipe->u.iso;
   2146   1.48  augustss 	uhci_soft_td_t *std;
   2147   1.48  augustss 	u_int32_t buf, len, status;
   2148   1.48  augustss 	int s, i, next, nframes;
   2149   1.48  augustss 
   2150   1.63  augustss 	DPRINTFN(5,("uhci_device_isoc_enter: used=%d next=%d xfer=%p "
   2151   1.48  augustss 		    "nframes=%d\n",
   2152   1.63  augustss 		    iso->inuse, iso->next, xfer, xfer->nframes));
   2153   1.48  augustss 
   2154   1.82  augustss 	if (sc->sc_dying)
   2155   1.82  augustss 		return;
   2156   1.82  augustss 
   2157   1.63  augustss 	if (xfer->status == USBD_IN_PROGRESS) {
   2158   1.48  augustss 		/* This request has already been entered into the frame list */
   2159   1.96  augustss 		printf("uhci_device_isoc_enter: xfer=%p in frame list\n", xfer);
   2160   1.68  augustss 		/* XXX */
   2161   1.48  augustss 	}
   2162   1.48  augustss 
   2163   1.48  augustss #ifdef DIAGNOSTIC
   2164   1.48  augustss 	if (iso->inuse >= UHCI_VFRAMELIST_COUNT)
   2165   1.48  augustss 		printf("uhci_device_isoc_enter: overflow!\n");
   2166   1.19  augustss #endif
   2167   1.16  augustss 
   2168   1.48  augustss 	next = iso->next;
   2169   1.48  augustss 	if (next == -1) {
   2170   1.48  augustss 		/* Not in use yet, schedule it a few frames ahead. */
   2171   1.48  augustss 		next = (UREAD2(sc, UHCI_FRNUM) + 3) % UHCI_VFRAMELIST_COUNT;
   2172   1.48  augustss 		DPRINTFN(2,("uhci_device_isoc_enter: start next=%d\n", next));
   2173   1.48  augustss 	}
   2174   1.48  augustss 
   2175   1.63  augustss 	xfer->status = USBD_IN_PROGRESS;
   2176   1.92  augustss 	UXFER(xfer)->curframe = next;
   2177   1.48  augustss 
   2178   1.63  augustss 	buf = DMAADDR(&xfer->dmabuf);
   2179   1.88   tsutsui 	status = UHCI_TD_ZERO_ACTLEN(UHCI_TD_SET_ERRCNT(0) |
   2180   1.88   tsutsui 				     UHCI_TD_ACTIVE |
   2181   1.88   tsutsui 				     UHCI_TD_IOS);
   2182   1.63  augustss 	nframes = xfer->nframes;
   2183   1.48  augustss 	s = splusb();
   2184   1.48  augustss 	for (i = 0; i < nframes; i++) {
   2185   1.48  augustss 		std = iso->stds[next];
   2186   1.48  augustss 		if (++next >= UHCI_VFRAMELIST_COUNT)
   2187   1.48  augustss 			next = 0;
   2188   1.63  augustss 		len = xfer->frlengths[i];
   2189   1.88   tsutsui 		std->td.td_buffer = htole32(buf);
   2190   1.48  augustss 		if (i == nframes - 1)
   2191   1.88   tsutsui 			status |= UHCI_TD_IOC;
   2192   1.88   tsutsui 		std->td.td_status = htole32(status);
   2193   1.88   tsutsui 		std->td.td_token &= htole32(~UHCI_TD_MAXLEN_MASK);
   2194   1.88   tsutsui 		std->td.td_token |= htole32(UHCI_TD_SET_MAXLEN(len));
   2195   1.59  augustss #ifdef UHCI_DEBUG
   2196   1.48  augustss 		if (uhcidebug > 5) {
   2197   1.48  augustss 			DPRINTFN(5,("uhci_device_isoc_enter: TD %d\n", i));
   2198   1.48  augustss 			uhci_dump_td(std);
   2199   1.48  augustss 		}
   2200   1.48  augustss #endif
   2201   1.48  augustss 		buf += len;
   2202   1.48  augustss 	}
   2203   1.48  augustss 	iso->next = next;
   2204   1.63  augustss 	iso->inuse += xfer->nframes;
   2205   1.16  augustss 
   2206   1.48  augustss 	splx(s);
   2207   1.16  augustss }
   2208   1.16  augustss 
   2209   1.16  augustss usbd_status
   2210   1.63  augustss uhci_device_isoc_start(xfer)
   2211   1.63  augustss 	usbd_xfer_handle xfer;
   2212   1.16  augustss {
   2213   1.63  augustss 	struct uhci_pipe *upipe = (struct uhci_pipe *)xfer->pipe;
   2214   1.48  augustss 	uhci_softc_t *sc = (uhci_softc_t *)upipe->pipe.device->bus;
   2215   1.92  augustss 	uhci_intr_info_t *ii = &UXFER(xfer)->iinfo;
   2216   1.48  augustss 	uhci_soft_td_t *end;
   2217   1.48  augustss 	int s, i;
   2218   1.48  augustss 
   2219   1.96  augustss 	DPRINTFN(5,("uhci_device_isoc_start: xfer=%p\n", xfer));
   2220   1.96  augustss 
   2221   1.82  augustss 	if (sc->sc_dying)
   2222   1.82  augustss 		return (USBD_IOERROR);
   2223   1.82  augustss 
   2224   1.48  augustss #ifdef DIAGNOSTIC
   2225   1.63  augustss 	if (xfer->status != USBD_IN_PROGRESS)
   2226   1.63  augustss 		printf("uhci_device_isoc_start: not in progress %p\n", xfer);
   2227   1.48  augustss #endif
   2228   1.48  augustss 
   2229   1.48  augustss 	/* Find the last TD */
   2230   1.92  augustss 	i = UXFER(xfer)->curframe + xfer->nframes;
   2231   1.48  augustss 	if (i >= UHCI_VFRAMELIST_COUNT)
   2232   1.48  augustss 		i -= UHCI_VFRAMELIST_COUNT;
   2233   1.48  augustss 	end = upipe->u.iso.stds[i];
   2234   1.48  augustss 
   2235   1.96  augustss #ifdef DIAGNOSTIC
   2236   1.96  augustss 	if (end == NULL) {
   2237   1.96  augustss 		printf("uhci_device_isoc_start: end == NULL\n");
   2238   1.96  augustss 		return (USBD_INVAL);
   2239   1.96  augustss 	}
   2240   1.96  augustss #endif
   2241   1.96  augustss 
   2242   1.48  augustss 	s = splusb();
   2243   1.48  augustss 
   2244   1.48  augustss 	/* Set up interrupt info. */
   2245   1.63  augustss 	ii->xfer = xfer;
   2246   1.48  augustss 	ii->stdstart = end;
   2247   1.48  augustss 	ii->stdend = end;
   2248   1.48  augustss #ifdef DIAGNOSTIC
   2249  1.102  augustss 	if (!ii->isdone)
   2250   1.70  augustss 		printf("uhci_device_isoc_start: not done, ii=%p\n", ii);
   2251   1.48  augustss 	ii->isdone = 0;
   2252   1.48  augustss #endif
   2253   1.92  augustss 	uhci_add_intr_info(sc, ii);
   2254   1.48  augustss 
   2255   1.48  augustss 	splx(s);
   2256   1.48  augustss 
   2257   1.48  augustss 	return (USBD_IN_PROGRESS);
   2258   1.16  augustss }
   2259   1.16  augustss 
   2260   1.16  augustss void
   2261   1.63  augustss uhci_device_isoc_abort(xfer)
   2262   1.63  augustss 	usbd_xfer_handle xfer;
   2263   1.16  augustss {
   2264   1.63  augustss 	struct uhci_pipe *upipe = (struct uhci_pipe *)xfer->pipe;
   2265   1.48  augustss 	uhci_soft_td_t **stds = upipe->u.iso.stds;
   2266   1.48  augustss 	uhci_soft_td_t *std;
   2267   1.92  augustss 	int i, n, s, nframes, maxlen, len;
   2268   1.92  augustss 
   2269   1.92  augustss 	s = splusb();
   2270   1.92  augustss 
   2271   1.92  augustss 	/* Transfer is already done. */
   2272   1.92  augustss 	if (xfer->status != USBD_NOT_STARTED &&
   2273   1.92  augustss 	    xfer->status != USBD_IN_PROGRESS) {
   2274   1.92  augustss 		splx(s);
   2275   1.92  augustss 		return;
   2276   1.92  augustss 	}
   2277   1.48  augustss 
   2278   1.92  augustss 	/* Give xfer the requested abort code. */
   2279   1.63  augustss 	xfer->status = USBD_CANCELLED;
   2280   1.48  augustss 
   2281   1.48  augustss 	/* make hardware ignore it, */
   2282   1.63  augustss 	nframes = xfer->nframes;
   2283   1.92  augustss 	n = UXFER(xfer)->curframe;
   2284   1.92  augustss 	maxlen = 0;
   2285   1.48  augustss 	for (i = 0; i < nframes; i++) {
   2286   1.48  augustss 		std = stds[n];
   2287   1.88   tsutsui 		std->td.td_status &= htole32(~(UHCI_TD_ACTIVE | UHCI_TD_IOC));
   2288   1.92  augustss 		len = UHCI_TD_GET_MAXLEN(std->td.td_token);
   2289   1.92  augustss 		if (len > maxlen)
   2290   1.92  augustss 			maxlen = len;
   2291   1.48  augustss 		if (++n >= UHCI_VFRAMELIST_COUNT)
   2292   1.48  augustss 			n = 0;
   2293   1.48  augustss 	}
   2294   1.48  augustss 
   2295   1.92  augustss 	/* and wait until we are sure the hardware has finished. */
   2296   1.92  augustss 	delay(maxlen);
   2297   1.92  augustss 
   2298   1.96  augustss #ifdef DIAGNOSTIC
   2299   1.96  augustss 	UXFER(xfer)->iinfo.isdone = 1;
   2300   1.96  augustss #endif
   2301   1.92  augustss 	/* Run callback and remove from interrupt list. */
   2302   1.92  augustss 	usb_transfer_complete(xfer);
   2303   1.48  augustss 
   2304   1.92  augustss 	splx(s);
   2305   1.16  augustss }
   2306   1.16  augustss 
   2307   1.16  augustss void
   2308   1.16  augustss uhci_device_isoc_close(pipe)
   2309   1.16  augustss 	usbd_pipe_handle pipe;
   2310   1.16  augustss {
   2311   1.16  augustss 	struct uhci_pipe *upipe = (struct uhci_pipe *)pipe;
   2312   1.16  augustss 	usbd_device_handle dev = upipe->pipe.device;
   2313   1.16  augustss 	uhci_softc_t *sc = (uhci_softc_t *)dev->bus;
   2314   1.48  augustss 	uhci_soft_td_t *std, *vstd;
   2315   1.16  augustss 	struct iso *iso;
   2316   1.92  augustss 	int i, s;
   2317   1.16  augustss 
   2318   1.16  augustss 	/*
   2319   1.16  augustss 	 * Make sure all TDs are marked as inactive.
   2320   1.16  augustss 	 * Wait for completion.
   2321   1.16  augustss 	 * Unschedule.
   2322   1.16  augustss 	 * Deallocate.
   2323   1.16  augustss 	 */
   2324   1.16  augustss 	iso = &upipe->u.iso;
   2325   1.16  augustss 
   2326   1.16  augustss 	for (i = 0; i < UHCI_VFRAMELIST_COUNT; i++)
   2327   1.88   tsutsui 		iso->stds[i]->td.td_status &= htole32(~UHCI_TD_ACTIVE);
   2328   1.20  augustss 	usb_delay_ms(&sc->sc_bus, 2); /* wait for completion */
   2329   1.16  augustss 
   2330   1.92  augustss 	s = splusb();
   2331   1.16  augustss 	for (i = 0; i < UHCI_VFRAMELIST_COUNT; i++) {
   2332   1.16  augustss 		std = iso->stds[i];
   2333   1.48  augustss 		for (vstd = sc->sc_vframes[i].htd;
   2334   1.67  augustss 		     vstd != NULL && vstd->link.std != std;
   2335   1.42  augustss 		     vstd = vstd->link.std)
   2336   1.16  augustss 			;
   2337   1.67  augustss 		if (vstd == NULL) {
   2338   1.16  augustss 			/*panic*/
   2339   1.16  augustss 			printf("uhci_device_isoc_close: %p not found\n", std);
   2340   1.92  augustss 			splx(s);
   2341   1.16  augustss 			return;
   2342   1.16  augustss 		}
   2343   1.42  augustss 		vstd->link = std->link;
   2344   1.42  augustss 		vstd->td.td_link = std->td.td_link;
   2345   1.16  augustss 		uhci_free_std(sc, std);
   2346   1.16  augustss 	}
   2347   1.92  augustss 	splx(s);
   2348   1.16  augustss 
   2349   1.31  augustss 	free(iso->stds, M_USBHC);
   2350   1.16  augustss }
   2351   1.16  augustss 
   2352   1.16  augustss usbd_status
   2353   1.48  augustss uhci_setup_isoc(pipe)
   2354   1.16  augustss 	usbd_pipe_handle pipe;
   2355   1.16  augustss {
   2356   1.16  augustss 	struct uhci_pipe *upipe = (struct uhci_pipe *)pipe;
   2357   1.16  augustss 	usbd_device_handle dev = upipe->pipe.device;
   2358   1.16  augustss 	uhci_softc_t *sc = (uhci_softc_t *)dev->bus;
   2359   1.16  augustss 	int addr = upipe->pipe.device->address;
   2360   1.16  augustss 	int endpt = upipe->pipe.endpoint->edesc->bEndpointAddress;
   2361   1.45  augustss 	int rd = UE_GET_DIR(endpt) == UE_DIR_IN;
   2362   1.48  augustss 	uhci_soft_td_t *std, *vstd;
   2363   1.48  augustss 	u_int32_t token;
   2364   1.16  augustss 	struct iso *iso;
   2365   1.92  augustss 	int i, s;
   2366   1.16  augustss 
   2367   1.16  augustss 	iso = &upipe->u.iso;
   2368   1.16  augustss 	iso->stds = malloc(UHCI_VFRAMELIST_COUNT * sizeof (uhci_soft_td_t *),
   2369   1.31  augustss 			   M_USBHC, M_WAITOK);
   2370   1.16  augustss 
   2371   1.88   tsutsui 	token = rd ? UHCI_TD_IN (0, endpt, addr, 0) :
   2372   1.88   tsutsui 		     UHCI_TD_OUT(0, endpt, addr, 0);
   2373   1.16  augustss 
   2374   1.48  augustss 	/* Allocate the TDs and mark as inactive; */
   2375   1.16  augustss 	for (i = 0; i < UHCI_VFRAMELIST_COUNT; i++) {
   2376   1.48  augustss 		std = uhci_alloc_std(sc);
   2377   1.48  augustss 		if (std == 0)
   2378   1.48  augustss 			goto bad;
   2379   1.88   tsutsui 		std->td.td_status = htole32(UHCI_TD_IOS); /* iso, inactive */
   2380   1.88   tsutsui 		std->td.td_token = htole32(token);
   2381   1.48  augustss 		iso->stds[i] = std;
   2382   1.16  augustss 	}
   2383   1.16  augustss 
   2384   1.48  augustss 	/* Insert TDs into schedule. */
   2385   1.92  augustss 	s = splusb();
   2386   1.16  augustss 	for (i = 0; i < UHCI_VFRAMELIST_COUNT; i++) {
   2387   1.16  augustss 		std = iso->stds[i];
   2388   1.48  augustss 		vstd = sc->sc_vframes[i].htd;
   2389   1.42  augustss 		std->link = vstd->link;
   2390   1.42  augustss 		std->td.td_link = vstd->td.td_link;
   2391   1.42  augustss 		vstd->link.std = std;
   2392   1.88   tsutsui 		vstd->td.td_link = htole32(std->physaddr);
   2393   1.16  augustss 	}
   2394   1.92  augustss 	splx(s);
   2395   1.16  augustss 
   2396   1.48  augustss 	iso->next = -1;
   2397   1.48  augustss 	iso->inuse = 0;
   2398   1.48  augustss 
   2399   1.16  augustss 	return (USBD_NORMAL_COMPLETION);
   2400   1.16  augustss 
   2401   1.48  augustss  bad:
   2402   1.16  augustss 	while (--i >= 0)
   2403   1.16  augustss 		uhci_free_std(sc, iso->stds[i]);
   2404   1.31  augustss 	free(iso->stds, M_USBHC);
   2405   1.16  augustss 	return (USBD_NOMEM);
   2406   1.16  augustss }
   2407   1.16  augustss 
   2408   1.16  augustss void
   2409   1.63  augustss uhci_device_isoc_done(xfer)
   2410   1.63  augustss 	usbd_xfer_handle xfer;
   2411   1.16  augustss {
   2412   1.92  augustss 	uhci_intr_info_t *ii = &UXFER(xfer)->iinfo;
   2413   1.48  augustss 
   2414   1.63  augustss 	DPRINTFN(4, ("uhci_isoc_done: length=%d\n", xfer->actlen));
   2415   1.93  augustss 
   2416   1.96  augustss 	if (ii->xfer != xfer)
   2417   1.96  augustss 		/* Not on interrupt list, ignore it. */
   2418   1.96  augustss 		return;
   2419   1.96  augustss 
   2420   1.93  augustss #ifdef DIAGNOSTIC
   2421   1.94  augustss 	if (xfer->busy_free != XFER_BUSY) {
   2422   1.94  augustss 		printf("uhci_device_isoc_done: xfer=%p not busy 0x%08x\n",
   2423   1.94  augustss 		       xfer, xfer->busy_free);
   2424   1.93  augustss 		return;
   2425   1.93  augustss 	}
   2426   1.93  augustss 
   2427   1.93  augustss         if (ii->stdend == NULL) {
   2428   1.93  augustss                 printf("uhci_device_isoc_done: xfer=%p stdend==NULL\n", xfer);
   2429   1.93  augustss #ifdef UHCI_DEBUG
   2430   1.93  augustss 		uhci_dump_ii(ii);
   2431   1.93  augustss #endif
   2432   1.93  augustss 		return;
   2433   1.93  augustss 	}
   2434   1.93  augustss #endif
   2435   1.48  augustss 
   2436   1.48  augustss 	/* Turn off the interrupt since it is active even if the TD is not. */
   2437   1.88   tsutsui 	ii->stdend->td.td_status &= htole32(~UHCI_TD_IOC);
   2438   1.48  augustss 
   2439   1.92  augustss 	uhci_del_intr_info(ii);	/* remove from active list */
   2440   1.16  augustss }
   2441   1.16  augustss 
   2442    1.1  augustss void
   2443   1.63  augustss uhci_device_intr_done(xfer)
   2444   1.63  augustss 	usbd_xfer_handle xfer;
   2445    1.1  augustss {
   2446   1.92  augustss 	uhci_intr_info_t *ii = &UXFER(xfer)->iinfo;
   2447    1.1  augustss 	uhci_softc_t *sc = ii->sc;
   2448   1.63  augustss 	struct uhci_pipe *upipe = (struct uhci_pipe *)xfer->pipe;
   2449    1.1  augustss 	uhci_soft_qh_t *sqh;
   2450    1.1  augustss 	int i, npoll;
   2451    1.1  augustss 
   2452   1.63  augustss 	DPRINTFN(5, ("uhci_intr_done: length=%d\n", xfer->actlen));
   2453    1.1  augustss 
   2454    1.1  augustss 	npoll = upipe->u.intr.npoll;
   2455    1.1  augustss 	for(i = 0; i < npoll; i++) {
   2456    1.1  augustss 		sqh = upipe->u.intr.qhs[i];
   2457   1.42  augustss 		sqh->elink = 0;
   2458   1.88   tsutsui 		sqh->qh.qh_elink = htole32(UHCI_PTR_T);
   2459    1.1  augustss 	}
   2460    1.1  augustss 	uhci_free_std_chain(sc, ii->stdstart, 0);
   2461    1.1  augustss 
   2462    1.1  augustss 	/* XXX Wasteful. */
   2463   1.63  augustss 	if (xfer->pipe->repeat) {
   2464   1.55  augustss 		uhci_soft_td_t *data, *dataend;
   2465    1.1  augustss 
   2466   1.92  augustss 		DPRINTFN(5,("uhci_device_intr_done: requeing\n"));
   2467   1.92  augustss 
   2468    1.1  augustss 		/* This alloc cannot fail since we freed the chain above. */
   2469   1.73  augustss 		uhci_alloc_std_chain(upipe, sc, xfer->length, 1, xfer->flags,
   2470   1.63  augustss 				     &xfer->dmabuf, &data, &dataend);
   2471   1.88   tsutsui 		dataend->td.td_status |= htole32(UHCI_TD_IOC);
   2472    1.1  augustss 
   2473   1.59  augustss #ifdef UHCI_DEBUG
   2474    1.1  augustss 		if (uhcidebug > 10) {
   2475   1.55  augustss 			DPRINTF(("uhci_device_intr_done: data(1)\n"));
   2476   1.55  augustss 			uhci_dump_tds(data);
   2477    1.1  augustss 			uhci_dump_qh(upipe->u.intr.qhs[0]);
   2478    1.1  augustss 		}
   2479    1.1  augustss #endif
   2480    1.1  augustss 
   2481   1.55  augustss 		ii->stdstart = data;
   2482   1.55  augustss 		ii->stdend = dataend;
   2483    1.7  augustss #ifdef DIAGNOSTIC
   2484   1.70  augustss 		if (!ii->isdone) {
   2485   1.70  augustss 			printf("uhci_device_intr_done: not done, ii=%p\n", ii);
   2486   1.70  augustss 		}
   2487    1.7  augustss 		ii->isdone = 0;
   2488    1.7  augustss #endif
   2489    1.1  augustss 		for (i = 0; i < npoll; i++) {
   2490    1.1  augustss 			sqh = upipe->u.intr.qhs[i];
   2491   1.55  augustss 			sqh->elink = data;
   2492   1.88   tsutsui 			sqh->qh.qh_elink = htole32(data->physaddr);
   2493    1.1  augustss 		}
   2494   1.92  augustss 		xfer->status = USBD_IN_PROGRESS;
   2495   1.92  augustss 		/* The ii is already on the examined list, just leave it. */
   2496    1.1  augustss 	} else {
   2497   1.92  augustss 		DPRINTFN(5,("uhci_device_intr_done: removing\n"));
   2498   1.92  augustss 		uhci_del_intr_info(ii);
   2499    1.1  augustss 	}
   2500    1.1  augustss }
   2501    1.1  augustss 
   2502    1.1  augustss /* Deallocate request data structures */
   2503    1.1  augustss void
   2504   1.63  augustss uhci_device_ctrl_done(xfer)
   2505   1.63  augustss 	usbd_xfer_handle xfer;
   2506    1.1  augustss {
   2507   1.92  augustss 	uhci_intr_info_t *ii = &UXFER(xfer)->iinfo;
   2508    1.1  augustss 	uhci_softc_t *sc = ii->sc;
   2509   1.63  augustss 	struct uhci_pipe *upipe = (struct uhci_pipe *)xfer->pipe;
   2510    1.1  augustss 
   2511    1.7  augustss #ifdef DIAGNOSTIC
   2512   1.63  augustss 	if (!(xfer->rqflags & URQ_REQUEST))
   2513    1.1  augustss 		panic("uhci_ctrl_done: not a request\n");
   2514    1.7  augustss #endif
   2515    1.1  augustss 
   2516   1.92  augustss 	uhci_del_intr_info(ii);	/* remove from active list */
   2517    1.1  augustss 
   2518    1.1  augustss 	uhci_remove_ctrl(sc, upipe->u.ctl.sqh);
   2519    1.1  augustss 
   2520   1.49  augustss 	if (upipe->u.ctl.length != 0)
   2521   1.42  augustss 		uhci_free_std_chain(sc, ii->stdstart->link.std, ii->stdend);
   2522   1.49  augustss 
   2523   1.63  augustss 	DPRINTFN(5, ("uhci_ctrl_done: length=%d\n", xfer->actlen));
   2524    1.1  augustss }
   2525    1.1  augustss 
   2526    1.1  augustss /* Deallocate request data structures */
   2527    1.1  augustss void
   2528   1.63  augustss uhci_device_bulk_done(xfer)
   2529   1.63  augustss 	usbd_xfer_handle xfer;
   2530    1.1  augustss {
   2531   1.92  augustss 	uhci_intr_info_t *ii = &UXFER(xfer)->iinfo;
   2532    1.1  augustss 	uhci_softc_t *sc = ii->sc;
   2533   1.63  augustss 	struct uhci_pipe *upipe = (struct uhci_pipe *)xfer->pipe;
   2534    1.1  augustss 
   2535   1.92  augustss 	uhci_del_intr_info(ii);	/* remove from active list */
   2536    1.1  augustss 
   2537    1.1  augustss 	uhci_remove_bulk(sc, upipe->u.bulk.sqh);
   2538   1.32  augustss 
   2539   1.32  augustss 	uhci_free_std_chain(sc, ii->stdstart, 0);
   2540   1.32  augustss 
   2541   1.63  augustss 	DPRINTFN(5, ("uhci_bulk_done: length=%d\n", xfer->actlen));
   2542    1.1  augustss }
   2543    1.1  augustss 
   2544    1.1  augustss /* Add interrupt QH, called with vflock. */
   2545    1.1  augustss void
   2546   1.92  augustss uhci_add_intr(sc, sqh)
   2547    1.1  augustss 	uhci_softc_t *sc;
   2548    1.1  augustss 	uhci_soft_qh_t *sqh;
   2549    1.1  augustss {
   2550   1.92  augustss 	struct uhci_vframe *vf = &sc->sc_vframes[sqh->pos];
   2551   1.42  augustss 	uhci_soft_qh_t *eqh;
   2552    1.1  augustss 
   2553   1.92  augustss 	DPRINTFN(4, ("uhci_add_intr: n=%d sqh=%p\n", sqh->pos, sqh));
   2554   1.92  augustss 
   2555   1.42  augustss 	eqh = vf->eqh;
   2556   1.42  augustss 	sqh->hlink       = eqh->hlink;
   2557   1.42  augustss 	sqh->qh.qh_hlink = eqh->qh.qh_hlink;
   2558   1.42  augustss 	eqh->hlink       = sqh;
   2559   1.88   tsutsui 	eqh->qh.qh_hlink = htole32(sqh->physaddr | UHCI_PTR_Q);
   2560    1.1  augustss 	vf->eqh = sqh;
   2561    1.1  augustss 	vf->bandwidth++;
   2562    1.1  augustss }
   2563    1.1  augustss 
   2564    1.1  augustss /* Remove interrupt QH, called with vflock. */
   2565    1.1  augustss void
   2566   1.92  augustss uhci_remove_intr(sc, sqh)
   2567    1.1  augustss 	uhci_softc_t *sc;
   2568    1.1  augustss 	uhci_soft_qh_t *sqh;
   2569    1.1  augustss {
   2570   1.92  augustss 	struct uhci_vframe *vf = &sc->sc_vframes[sqh->pos];
   2571    1.1  augustss 	uhci_soft_qh_t *pqh;
   2572    1.1  augustss 
   2573   1.92  augustss 	DPRINTFN(4, ("uhci_remove_intr: n=%d sqh=%p\n", sqh->pos, sqh));
   2574    1.1  augustss 
   2575   1.92  augustss 	pqh = uhci_find_prev_qh(vf->hqh, sqh);
   2576   1.42  augustss 	pqh->hlink       = sqh->hlink;
   2577   1.42  augustss 	pqh->qh.qh_hlink = sqh->qh.qh_hlink;
   2578    1.1  augustss 	if (vf->eqh == sqh)
   2579    1.1  augustss 		vf->eqh = pqh;
   2580    1.1  augustss 	vf->bandwidth--;
   2581    1.1  augustss }
   2582    1.1  augustss 
   2583    1.1  augustss usbd_status
   2584    1.1  augustss uhci_device_setintr(sc, upipe, ival)
   2585    1.1  augustss 	uhci_softc_t *sc;
   2586    1.1  augustss 	struct uhci_pipe *upipe;
   2587    1.1  augustss 	int ival;
   2588    1.1  augustss {
   2589    1.1  augustss 	uhci_soft_qh_t *sqh;
   2590    1.1  augustss 	int i, npoll, s;
   2591    1.1  augustss 	u_int bestbw, bw, bestoffs, offs;
   2592    1.1  augustss 
   2593    1.1  augustss 	DPRINTFN(2, ("uhci_setintr: pipe=%p\n", upipe));
   2594    1.1  augustss 	if (ival == 0) {
   2595    1.1  augustss 		printf("uhci_setintr: 0 interval\n");
   2596    1.1  augustss 		return (USBD_INVAL);
   2597    1.1  augustss 	}
   2598    1.1  augustss 
   2599    1.1  augustss 	if (ival > UHCI_VFRAMELIST_COUNT)
   2600    1.1  augustss 		ival = UHCI_VFRAMELIST_COUNT;
   2601    1.1  augustss 	npoll = (UHCI_VFRAMELIST_COUNT + ival - 1) / ival;
   2602    1.1  augustss 	DPRINTFN(2, ("uhci_setintr: ival=%d npoll=%d\n", ival, npoll));
   2603    1.1  augustss 
   2604    1.1  augustss 	upipe->u.intr.npoll = npoll;
   2605    1.1  augustss 	upipe->u.intr.qhs =
   2606   1.31  augustss 		malloc(npoll * sizeof(uhci_soft_qh_t *), M_USBHC, M_WAITOK);
   2607    1.1  augustss 
   2608    1.1  augustss 	/*
   2609    1.1  augustss 	 * Figure out which offset in the schedule that has most
   2610    1.1  augustss 	 * bandwidth left over.
   2611    1.1  augustss 	 */
   2612    1.1  augustss #define MOD(i) ((i) & (UHCI_VFRAMELIST_COUNT-1))
   2613    1.1  augustss 	for (bestoffs = offs = 0, bestbw = ~0; offs < ival; offs++) {
   2614    1.1  augustss 		for (bw = i = 0; i < npoll; i++)
   2615    1.1  augustss 			bw += sc->sc_vframes[MOD(i * ival + offs)].bandwidth;
   2616    1.1  augustss 		if (bw < bestbw) {
   2617    1.1  augustss 			bestbw = bw;
   2618    1.1  augustss 			bestoffs = offs;
   2619    1.1  augustss 		}
   2620    1.1  augustss 	}
   2621    1.1  augustss 	DPRINTFN(1, ("uhci_setintr: bw=%d offs=%d\n", bestbw, bestoffs));
   2622    1.1  augustss 
   2623    1.1  augustss 	for(i = 0; i < npoll; i++) {
   2624    1.1  augustss 		upipe->u.intr.qhs[i] = sqh = uhci_alloc_sqh(sc);
   2625   1.42  augustss 		sqh->elink = 0;
   2626   1.88   tsutsui 		sqh->qh.qh_elink = htole32(UHCI_PTR_T);
   2627    1.1  augustss 		sqh->pos = MOD(i * ival + bestoffs);
   2628    1.1  augustss 	}
   2629    1.1  augustss #undef MOD
   2630    1.1  augustss 
   2631    1.1  augustss 	s = splusb();
   2632    1.1  augustss 	/* Enter QHs into the controller data structures. */
   2633    1.1  augustss 	for(i = 0; i < npoll; i++)
   2634   1.92  augustss 		uhci_add_intr(sc, upipe->u.intr.qhs[i]);
   2635   1.92  augustss 	splx(s);
   2636    1.1  augustss 
   2637    1.1  augustss 	DPRINTFN(5, ("uhci_setintr: returns %p\n", upipe));
   2638    1.1  augustss 	return (USBD_NORMAL_COMPLETION);
   2639    1.1  augustss }
   2640    1.1  augustss 
   2641    1.1  augustss /* Open a new pipe. */
   2642    1.1  augustss usbd_status
   2643    1.1  augustss uhci_open(pipe)
   2644    1.1  augustss 	usbd_pipe_handle pipe;
   2645    1.1  augustss {
   2646    1.1  augustss 	uhci_softc_t *sc = (uhci_softc_t *)pipe->device->bus;
   2647    1.1  augustss 	struct uhci_pipe *upipe = (struct uhci_pipe *)pipe;
   2648    1.1  augustss 	usb_endpoint_descriptor_t *ed = pipe->endpoint->edesc;
   2649   1.63  augustss 	usbd_status err;
   2650   1.79  augustss 	int ival;
   2651    1.1  augustss 
   2652    1.1  augustss 	DPRINTFN(1, ("uhci_open: pipe=%p, addr=%d, endpt=%d (%d)\n",
   2653    1.1  augustss 		     pipe, pipe->device->address,
   2654    1.1  augustss 		     ed->bEndpointAddress, sc->sc_addr));
   2655   1.92  augustss 
   2656   1.92  augustss 	upipe->aborting = 0;
   2657   1.92  augustss 	upipe->nexttoggle = 0;
   2658   1.92  augustss 
   2659    1.1  augustss 	if (pipe->device->address == sc->sc_addr) {
   2660    1.1  augustss 		switch (ed->bEndpointAddress) {
   2661    1.1  augustss 		case USB_CONTROL_ENDPOINT:
   2662    1.1  augustss 			pipe->methods = &uhci_root_ctrl_methods;
   2663    1.1  augustss 			break;
   2664   1.45  augustss 		case UE_DIR_IN | UHCI_INTR_ENDPT:
   2665    1.1  augustss 			pipe->methods = &uhci_root_intr_methods;
   2666    1.1  augustss 			break;
   2667    1.1  augustss 		default:
   2668    1.1  augustss 			return (USBD_INVAL);
   2669    1.1  augustss 		}
   2670    1.1  augustss 	} else {
   2671    1.1  augustss 		switch (ed->bmAttributes & UE_XFERTYPE) {
   2672    1.1  augustss 		case UE_CONTROL:
   2673    1.1  augustss 			pipe->methods = &uhci_device_ctrl_methods;
   2674    1.1  augustss 			upipe->u.ctl.sqh = uhci_alloc_sqh(sc);
   2675   1.63  augustss 			if (upipe->u.ctl.sqh == NULL)
   2676    1.5  augustss 				goto bad;
   2677    1.1  augustss 			upipe->u.ctl.setup = uhci_alloc_std(sc);
   2678   1.63  augustss 			if (upipe->u.ctl.setup == NULL) {
   2679    1.5  augustss 				uhci_free_sqh(sc, upipe->u.ctl.sqh);
   2680    1.5  augustss 				goto bad;
   2681    1.5  augustss 			}
   2682    1.1  augustss 			upipe->u.ctl.stat = uhci_alloc_std(sc);
   2683   1.63  augustss 			if (upipe->u.ctl.stat == NULL) {
   2684    1.5  augustss 				uhci_free_sqh(sc, upipe->u.ctl.sqh);
   2685    1.5  augustss 				uhci_free_std(sc, upipe->u.ctl.setup);
   2686    1.5  augustss 				goto bad;
   2687    1.5  augustss 			}
   2688   1.63  augustss 			err = usb_allocmem(&sc->sc_bus,
   2689   1.63  augustss 				  sizeof(usb_device_request_t),
   2690   1.63  augustss 				  0, &upipe->u.ctl.reqdma);
   2691   1.63  augustss 			if (err) {
   2692    1.5  augustss 				uhci_free_sqh(sc, upipe->u.ctl.sqh);
   2693    1.5  augustss 				uhci_free_std(sc, upipe->u.ctl.setup);
   2694    1.5  augustss 				uhci_free_std(sc, upipe->u.ctl.stat);
   2695    1.5  augustss 				goto bad;
   2696    1.5  augustss 			}
   2697    1.1  augustss 			break;
   2698    1.1  augustss 		case UE_INTERRUPT:
   2699    1.1  augustss 			pipe->methods = &uhci_device_intr_methods;
   2700   1.79  augustss 			ival = pipe->interval;
   2701   1.79  augustss 			if (ival == USBD_DEFAULT_INTERVAL)
   2702   1.79  augustss 				ival = ed->bInterval;
   2703   1.80  augustss 			return (uhci_device_setintr(sc, upipe, ival));
   2704    1.1  augustss 		case UE_ISOCHRONOUS:
   2705   1.16  augustss 			pipe->methods = &uhci_device_isoc_methods;
   2706   1.48  augustss 			return (uhci_setup_isoc(pipe));
   2707    1.1  augustss 		case UE_BULK:
   2708    1.1  augustss 			pipe->methods = &uhci_device_bulk_methods;
   2709    1.1  augustss 			upipe->u.bulk.sqh = uhci_alloc_sqh(sc);
   2710   1.63  augustss 			if (upipe->u.bulk.sqh == NULL)
   2711    1.5  augustss 				goto bad;
   2712    1.1  augustss 			break;
   2713    1.1  augustss 		}
   2714    1.1  augustss 	}
   2715    1.1  augustss 	return (USBD_NORMAL_COMPLETION);
   2716    1.5  augustss 
   2717    1.5  augustss  bad:
   2718    1.5  augustss 	return (USBD_NOMEM);
   2719    1.1  augustss }
   2720    1.1  augustss 
   2721    1.1  augustss /*
   2722    1.1  augustss  * Data structures and routines to emulate the root hub.
   2723    1.1  augustss  */
   2724    1.1  augustss usb_device_descriptor_t uhci_devd = {
   2725    1.1  augustss 	USB_DEVICE_DESCRIPTOR_SIZE,
   2726    1.1  augustss 	UDESC_DEVICE,		/* type */
   2727    1.1  augustss 	{0x00, 0x01},		/* USB version */
   2728   1.87  augustss 	UDCLASS_HUB,		/* class */
   2729   1.87  augustss 	UDSUBCLASS_HUB,		/* subclass */
   2730    1.1  augustss 	0,			/* protocol */
   2731    1.1  augustss 	64,			/* max packet */
   2732    1.1  augustss 	{0},{0},{0x00,0x01},	/* device id */
   2733    1.1  augustss 	1,2,0,			/* string indicies */
   2734    1.1  augustss 	1			/* # of configurations */
   2735    1.1  augustss };
   2736    1.1  augustss 
   2737    1.1  augustss usb_config_descriptor_t uhci_confd = {
   2738    1.1  augustss 	USB_CONFIG_DESCRIPTOR_SIZE,
   2739    1.1  augustss 	UDESC_CONFIG,
   2740    1.1  augustss 	{USB_CONFIG_DESCRIPTOR_SIZE +
   2741    1.1  augustss 	 USB_INTERFACE_DESCRIPTOR_SIZE +
   2742    1.1  augustss 	 USB_ENDPOINT_DESCRIPTOR_SIZE},
   2743    1.1  augustss 	1,
   2744    1.1  augustss 	1,
   2745    1.1  augustss 	0,
   2746    1.1  augustss 	UC_SELF_POWERED,
   2747    1.1  augustss 	0			/* max power */
   2748    1.1  augustss };
   2749    1.1  augustss 
   2750    1.1  augustss usb_interface_descriptor_t uhci_ifcd = {
   2751    1.1  augustss 	USB_INTERFACE_DESCRIPTOR_SIZE,
   2752    1.1  augustss 	UDESC_INTERFACE,
   2753    1.1  augustss 	0,
   2754    1.1  augustss 	0,
   2755    1.1  augustss 	1,
   2756   1.87  augustss 	UICLASS_HUB,
   2757   1.87  augustss 	UISUBCLASS_HUB,
   2758    1.1  augustss 	0,
   2759    1.1  augustss 	0
   2760    1.1  augustss };
   2761    1.1  augustss 
   2762    1.1  augustss usb_endpoint_descriptor_t uhci_endpd = {
   2763    1.1  augustss 	USB_ENDPOINT_DESCRIPTOR_SIZE,
   2764    1.1  augustss 	UDESC_ENDPOINT,
   2765   1.45  augustss 	UE_DIR_IN | UHCI_INTR_ENDPT,
   2766    1.1  augustss 	UE_INTERRUPT,
   2767    1.1  augustss 	{8},
   2768    1.1  augustss 	255
   2769    1.1  augustss };
   2770    1.1  augustss 
   2771    1.1  augustss usb_hub_descriptor_t uhci_hubd_piix = {
   2772    1.1  augustss 	USB_HUB_DESCRIPTOR_SIZE,
   2773    1.1  augustss 	UDESC_HUB,
   2774    1.1  augustss 	2,
   2775    1.1  augustss 	{ UHD_PWR_NO_SWITCH | UHD_OC_INDIVIDUAL, 0 },
   2776    1.1  augustss 	50,			/* power on to power good */
   2777    1.1  augustss 	0,
   2778    1.1  augustss 	{ 0x00 },		/* both ports are removable */
   2779    1.1  augustss };
   2780    1.1  augustss 
   2781    1.1  augustss int
   2782    1.1  augustss uhci_str(p, l, s)
   2783    1.1  augustss 	usb_string_descriptor_t *p;
   2784    1.1  augustss 	int l;
   2785    1.1  augustss 	char *s;
   2786    1.1  augustss {
   2787    1.1  augustss 	int i;
   2788    1.1  augustss 
   2789    1.1  augustss 	if (l == 0)
   2790    1.1  augustss 		return (0);
   2791    1.1  augustss 	p->bLength = 2 * strlen(s) + 2;
   2792    1.1  augustss 	if (l == 1)
   2793    1.1  augustss 		return (1);
   2794    1.1  augustss 	p->bDescriptorType = UDESC_STRING;
   2795    1.1  augustss 	l -= 2;
   2796    1.1  augustss 	for (i = 0; s[i] && l > 1; i++, l -= 2)
   2797    1.1  augustss 		USETW2(p->bString[i], 0, s[i]);
   2798    1.1  augustss 	return (2*i+2);
   2799    1.1  augustss }
   2800    1.1  augustss 
   2801    1.1  augustss /*
   2802    1.1  augustss  * Simulate a hardware hub by handling all the necessary requests.
   2803    1.1  augustss  */
   2804    1.1  augustss usbd_status
   2805   1.63  augustss uhci_root_ctrl_transfer(xfer)
   2806   1.63  augustss 	usbd_xfer_handle xfer;
   2807    1.1  augustss {
   2808   1.63  augustss 	usbd_status err;
   2809   1.16  augustss 
   2810   1.52  augustss 	/* Insert last in queue. */
   2811   1.63  augustss 	err = usb_insert_transfer(xfer);
   2812   1.63  augustss 	if (err)
   2813   1.63  augustss 		return (err);
   2814   1.52  augustss 
   2815   1.94  augustss 	/*
   2816   1.94  augustss 	 * Pipe isn't running (otherwise err would be USBD_INPROG),
   2817   1.94  augustss 	 * so start it first.
   2818   1.67  augustss 	 */
   2819   1.63  augustss 	return (uhci_root_ctrl_start(SIMPLEQ_FIRST(&xfer->pipe->queue)));
   2820   1.16  augustss }
   2821   1.16  augustss 
   2822   1.16  augustss usbd_status
   2823   1.63  augustss uhci_root_ctrl_start(xfer)
   2824   1.63  augustss 	usbd_xfer_handle xfer;
   2825   1.16  augustss {
   2826   1.63  augustss 	uhci_softc_t *sc = (uhci_softc_t *)xfer->pipe->device->bus;
   2827    1.1  augustss 	usb_device_request_t *req;
   2828   1.59  augustss 	void *buf = NULL;
   2829    1.1  augustss 	int port, x;
   2830   1.52  augustss 	int s, len, value, index, status, change, l, totlen = 0;
   2831    1.1  augustss 	usb_port_status_t ps;
   2832   1.63  augustss 	usbd_status err;
   2833    1.1  augustss 
   2834   1.82  augustss 	if (sc->sc_dying)
   2835   1.82  augustss 		return (USBD_IOERROR);
   2836   1.82  augustss 
   2837   1.48  augustss #ifdef DIAGNOSTIC
   2838   1.63  augustss 	if (!(xfer->rqflags & URQ_REQUEST))
   2839    1.1  augustss 		panic("uhci_root_ctrl_transfer: not a request\n");
   2840   1.48  augustss #endif
   2841   1.63  augustss 	req = &xfer->request;
   2842    1.1  augustss 
   2843    1.1  augustss 	DPRINTFN(2,("uhci_root_ctrl_control type=0x%02x request=%02x\n",
   2844    1.1  augustss 		    req->bmRequestType, req->bRequest));
   2845    1.1  augustss 
   2846    1.1  augustss 	len = UGETW(req->wLength);
   2847    1.1  augustss 	value = UGETW(req->wValue);
   2848    1.1  augustss 	index = UGETW(req->wIndex);
   2849   1.49  augustss 
   2850   1.49  augustss 	if (len != 0)
   2851   1.63  augustss 		buf = KERNADDR(&xfer->dmabuf);
   2852   1.49  augustss 
   2853    1.1  augustss #define C(x,y) ((x) | ((y) << 8))
   2854    1.1  augustss 	switch(C(req->bRequest, req->bmRequestType)) {
   2855    1.1  augustss 	case C(UR_CLEAR_FEATURE, UT_WRITE_DEVICE):
   2856    1.1  augustss 	case C(UR_CLEAR_FEATURE, UT_WRITE_INTERFACE):
   2857    1.1  augustss 	case C(UR_CLEAR_FEATURE, UT_WRITE_ENDPOINT):
   2858    1.1  augustss 		/*
   2859   1.13  augustss 		 * DEVICE_REMOTE_WAKEUP and ENDPOINT_HALT are no-ops
   2860    1.1  augustss 		 * for the integrated root hub.
   2861    1.1  augustss 		 */
   2862    1.1  augustss 		break;
   2863    1.1  augustss 	case C(UR_GET_CONFIG, UT_READ_DEVICE):
   2864    1.1  augustss 		if (len > 0) {
   2865    1.1  augustss 			*(u_int8_t *)buf = sc->sc_conf;
   2866    1.1  augustss 			totlen = 1;
   2867    1.1  augustss 		}
   2868    1.1  augustss 		break;
   2869    1.1  augustss 	case C(UR_GET_DESCRIPTOR, UT_READ_DEVICE):
   2870    1.1  augustss 		DPRINTFN(2,("uhci_root_ctrl_control wValue=0x%04x\n", value));
   2871    1.1  augustss 		switch(value >> 8) {
   2872    1.1  augustss 		case UDESC_DEVICE:
   2873    1.1  augustss 			if ((value & 0xff) != 0) {
   2874   1.63  augustss 				err = USBD_IOERROR;
   2875    1.1  augustss 				goto ret;
   2876    1.1  augustss 			}
   2877    1.1  augustss 			totlen = l = min(len, USB_DEVICE_DESCRIPTOR_SIZE);
   2878   1.27  augustss 			USETW(uhci_devd.idVendor, sc->sc_id_vendor);
   2879    1.1  augustss 			memcpy(buf, &uhci_devd, l);
   2880    1.1  augustss 			break;
   2881    1.1  augustss 		case UDESC_CONFIG:
   2882    1.1  augustss 			if ((value & 0xff) != 0) {
   2883   1.63  augustss 				err = USBD_IOERROR;
   2884    1.1  augustss 				goto ret;
   2885    1.1  augustss 			}
   2886    1.1  augustss 			totlen = l = min(len, USB_CONFIG_DESCRIPTOR_SIZE);
   2887    1.1  augustss 			memcpy(buf, &uhci_confd, l);
   2888    1.1  augustss 			buf = (char *)buf + l;
   2889    1.1  augustss 			len -= l;
   2890    1.1  augustss 			l = min(len, USB_INTERFACE_DESCRIPTOR_SIZE);
   2891    1.1  augustss 			totlen += l;
   2892    1.1  augustss 			memcpy(buf, &uhci_ifcd, l);
   2893    1.1  augustss 			buf = (char *)buf + l;
   2894    1.1  augustss 			len -= l;
   2895    1.1  augustss 			l = min(len, USB_ENDPOINT_DESCRIPTOR_SIZE);
   2896    1.1  augustss 			totlen += l;
   2897    1.1  augustss 			memcpy(buf, &uhci_endpd, l);
   2898    1.1  augustss 			break;
   2899    1.1  augustss 		case UDESC_STRING:
   2900    1.1  augustss 			if (len == 0)
   2901    1.1  augustss 				break;
   2902    1.1  augustss 			*(u_int8_t *)buf = 0;
   2903    1.1  augustss 			totlen = 1;
   2904    1.1  augustss 			switch (value & 0xff) {
   2905    1.1  augustss 			case 1: /* Vendor */
   2906    1.8  augustss 				totlen = uhci_str(buf, len, sc->sc_vendor);
   2907    1.1  augustss 				break;
   2908    1.1  augustss 			case 2: /* Product */
   2909    1.8  augustss 				totlen = uhci_str(buf, len, "UHCI root hub");
   2910    1.1  augustss 				break;
   2911    1.1  augustss 			}
   2912    1.1  augustss 			break;
   2913    1.1  augustss 		default:
   2914   1.63  augustss 			err = USBD_IOERROR;
   2915    1.1  augustss 			goto ret;
   2916    1.1  augustss 		}
   2917    1.1  augustss 		break;
   2918    1.1  augustss 	case C(UR_GET_INTERFACE, UT_READ_INTERFACE):
   2919    1.1  augustss 		if (len > 0) {
   2920    1.1  augustss 			*(u_int8_t *)buf = 0;
   2921    1.1  augustss 			totlen = 1;
   2922    1.1  augustss 		}
   2923    1.1  augustss 		break;
   2924    1.1  augustss 	case C(UR_GET_STATUS, UT_READ_DEVICE):
   2925    1.1  augustss 		if (len > 1) {
   2926    1.1  augustss 			USETW(((usb_status_t *)buf)->wStatus,UDS_SELF_POWERED);
   2927    1.1  augustss 			totlen = 2;
   2928    1.1  augustss 		}
   2929    1.1  augustss 		break;
   2930    1.1  augustss 	case C(UR_GET_STATUS, UT_READ_INTERFACE):
   2931    1.1  augustss 	case C(UR_GET_STATUS, UT_READ_ENDPOINT):
   2932    1.1  augustss 		if (len > 1) {
   2933    1.1  augustss 			USETW(((usb_status_t *)buf)->wStatus, 0);
   2934    1.1  augustss 			totlen = 2;
   2935    1.1  augustss 		}
   2936    1.1  augustss 		break;
   2937    1.1  augustss 	case C(UR_SET_ADDRESS, UT_WRITE_DEVICE):
   2938    1.1  augustss 		if (value >= USB_MAX_DEVICES) {
   2939   1.63  augustss 			err = USBD_IOERROR;
   2940    1.1  augustss 			goto ret;
   2941    1.1  augustss 		}
   2942    1.1  augustss 		sc->sc_addr = value;
   2943    1.1  augustss 		break;
   2944    1.1  augustss 	case C(UR_SET_CONFIG, UT_WRITE_DEVICE):
   2945    1.1  augustss 		if (value != 0 && value != 1) {
   2946   1.63  augustss 			err = USBD_IOERROR;
   2947    1.1  augustss 			goto ret;
   2948    1.1  augustss 		}
   2949    1.1  augustss 		sc->sc_conf = value;
   2950    1.1  augustss 		break;
   2951    1.1  augustss 	case C(UR_SET_DESCRIPTOR, UT_WRITE_DEVICE):
   2952    1.1  augustss 		break;
   2953    1.1  augustss 	case C(UR_SET_FEATURE, UT_WRITE_DEVICE):
   2954    1.1  augustss 	case C(UR_SET_FEATURE, UT_WRITE_INTERFACE):
   2955    1.1  augustss 	case C(UR_SET_FEATURE, UT_WRITE_ENDPOINT):
   2956   1.63  augustss 		err = USBD_IOERROR;
   2957    1.1  augustss 		goto ret;
   2958    1.1  augustss 	case C(UR_SET_INTERFACE, UT_WRITE_INTERFACE):
   2959    1.1  augustss 		break;
   2960    1.1  augustss 	case C(UR_SYNCH_FRAME, UT_WRITE_ENDPOINT):
   2961    1.1  augustss 		break;
   2962    1.1  augustss 	/* Hub requests */
   2963    1.1  augustss 	case C(UR_CLEAR_FEATURE, UT_WRITE_CLASS_DEVICE):
   2964    1.1  augustss 		break;
   2965    1.1  augustss 	case C(UR_CLEAR_FEATURE, UT_WRITE_CLASS_OTHER):
   2966   1.12  augustss 		DPRINTFN(3, ("uhci_root_ctrl_control: UR_CLEAR_PORT_FEATURE "
   2967   1.12  augustss 			     "port=%d feature=%d\n",
   2968    1.1  augustss 			     index, value));
   2969    1.1  augustss 		if (index == 1)
   2970    1.1  augustss 			port = UHCI_PORTSC1;
   2971    1.1  augustss 		else if (index == 2)
   2972    1.1  augustss 			port = UHCI_PORTSC2;
   2973    1.1  augustss 		else {
   2974   1.63  augustss 			err = USBD_IOERROR;
   2975    1.1  augustss 			goto ret;
   2976    1.1  augustss 		}
   2977    1.1  augustss 		switch(value) {
   2978    1.1  augustss 		case UHF_PORT_ENABLE:
   2979    1.1  augustss 			x = UREAD2(sc, port);
   2980    1.1  augustss 			UWRITE2(sc, port, x & ~UHCI_PORTSC_PE);
   2981    1.1  augustss 			break;
   2982    1.1  augustss 		case UHF_PORT_SUSPEND:
   2983    1.1  augustss 			x = UREAD2(sc, port);
   2984    1.1  augustss 			UWRITE2(sc, port, x & ~UHCI_PORTSC_SUSP);
   2985    1.1  augustss 			break;
   2986    1.1  augustss 		case UHF_PORT_RESET:
   2987    1.1  augustss 			x = UREAD2(sc, port);
   2988    1.1  augustss 			UWRITE2(sc, port, x & ~UHCI_PORTSC_PR);
   2989    1.1  augustss 			break;
   2990    1.1  augustss 		case UHF_C_PORT_CONNECTION:
   2991    1.1  augustss 			x = UREAD2(sc, port);
   2992    1.1  augustss 			UWRITE2(sc, port, x | UHCI_PORTSC_CSC);
   2993    1.1  augustss 			break;
   2994    1.1  augustss 		case UHF_C_PORT_ENABLE:
   2995    1.1  augustss 			x = UREAD2(sc, port);
   2996    1.1  augustss 			UWRITE2(sc, port, x | UHCI_PORTSC_POEDC);
   2997    1.1  augustss 			break;
   2998    1.1  augustss 		case UHF_C_PORT_OVER_CURRENT:
   2999    1.1  augustss 			x = UREAD2(sc, port);
   3000    1.1  augustss 			UWRITE2(sc, port, x | UHCI_PORTSC_OCIC);
   3001    1.1  augustss 			break;
   3002    1.1  augustss 		case UHF_C_PORT_RESET:
   3003    1.1  augustss 			sc->sc_isreset = 0;
   3004   1.63  augustss 			err = USBD_NORMAL_COMPLETION;
   3005    1.1  augustss 			goto ret;
   3006    1.1  augustss 		case UHF_PORT_CONNECTION:
   3007    1.1  augustss 		case UHF_PORT_OVER_CURRENT:
   3008    1.1  augustss 		case UHF_PORT_POWER:
   3009    1.1  augustss 		case UHF_PORT_LOW_SPEED:
   3010    1.1  augustss 		case UHF_C_PORT_SUSPEND:
   3011    1.1  augustss 		default:
   3012   1.63  augustss 			err = USBD_IOERROR;
   3013    1.1  augustss 			goto ret;
   3014    1.1  augustss 		}
   3015    1.1  augustss 		break;
   3016    1.1  augustss 	case C(UR_GET_BUS_STATE, UT_READ_CLASS_OTHER):
   3017    1.1  augustss 		if (index == 1)
   3018    1.1  augustss 			port = UHCI_PORTSC1;
   3019    1.1  augustss 		else if (index == 2)
   3020    1.1  augustss 			port = UHCI_PORTSC2;
   3021    1.1  augustss 		else {
   3022   1.63  augustss 			err = USBD_IOERROR;
   3023    1.1  augustss 			goto ret;
   3024    1.1  augustss 		}
   3025    1.1  augustss 		if (len > 0) {
   3026    1.1  augustss 			*(u_int8_t *)buf =
   3027    1.1  augustss 				(UREAD2(sc, port) & UHCI_PORTSC_LS) >>
   3028    1.1  augustss 				UHCI_PORTSC_LS_SHIFT;
   3029    1.1  augustss 			totlen = 1;
   3030    1.1  augustss 		}
   3031    1.1  augustss 		break;
   3032    1.1  augustss 	case C(UR_GET_DESCRIPTOR, UT_READ_CLASS_DEVICE):
   3033    1.1  augustss 		if (value != 0) {
   3034   1.63  augustss 			err = USBD_IOERROR;
   3035    1.1  augustss 			goto ret;
   3036    1.1  augustss 		}
   3037    1.1  augustss 		l = min(len, USB_HUB_DESCRIPTOR_SIZE);
   3038    1.1  augustss 		totlen = l;
   3039    1.1  augustss 		memcpy(buf, &uhci_hubd_piix, l);
   3040    1.1  augustss 		break;
   3041    1.1  augustss 	case C(UR_GET_STATUS, UT_READ_CLASS_DEVICE):
   3042    1.1  augustss 		if (len != 4) {
   3043   1.63  augustss 			err = USBD_IOERROR;
   3044    1.1  augustss 			goto ret;
   3045    1.1  augustss 		}
   3046    1.1  augustss 		memset(buf, 0, len);
   3047    1.1  augustss 		totlen = len;
   3048    1.1  augustss 		break;
   3049    1.1  augustss 	case C(UR_GET_STATUS, UT_READ_CLASS_OTHER):
   3050    1.1  augustss 		if (index == 1)
   3051    1.1  augustss 			port = UHCI_PORTSC1;
   3052    1.1  augustss 		else if (index == 2)
   3053    1.1  augustss 			port = UHCI_PORTSC2;
   3054    1.1  augustss 		else {
   3055   1.63  augustss 			err = USBD_IOERROR;
   3056    1.1  augustss 			goto ret;
   3057    1.1  augustss 		}
   3058    1.1  augustss 		if (len != 4) {
   3059   1.63  augustss 			err = USBD_IOERROR;
   3060    1.1  augustss 			goto ret;
   3061    1.1  augustss 		}
   3062    1.1  augustss 		x = UREAD2(sc, port);
   3063    1.1  augustss 		status = change = 0;
   3064    1.1  augustss 		if (x & UHCI_PORTSC_CCS  )
   3065    1.1  augustss 			status |= UPS_CURRENT_CONNECT_STATUS;
   3066    1.1  augustss 		if (x & UHCI_PORTSC_CSC  )
   3067    1.1  augustss 			change |= UPS_C_CONNECT_STATUS;
   3068    1.1  augustss 		if (x & UHCI_PORTSC_PE   )
   3069    1.1  augustss 			status |= UPS_PORT_ENABLED;
   3070    1.1  augustss 		if (x & UHCI_PORTSC_POEDC)
   3071    1.1  augustss 			change |= UPS_C_PORT_ENABLED;
   3072    1.1  augustss 		if (x & UHCI_PORTSC_OCI  )
   3073    1.1  augustss 			status |= UPS_OVERCURRENT_INDICATOR;
   3074    1.1  augustss 		if (x & UHCI_PORTSC_OCIC )
   3075    1.1  augustss 			change |= UPS_C_OVERCURRENT_INDICATOR;
   3076    1.1  augustss 		if (x & UHCI_PORTSC_SUSP )
   3077    1.1  augustss 			status |= UPS_SUSPEND;
   3078    1.1  augustss 		if (x & UHCI_PORTSC_LSDA )
   3079    1.1  augustss 			status |= UPS_LOW_SPEED;
   3080    1.1  augustss 		status |= UPS_PORT_POWER;
   3081    1.1  augustss 		if (sc->sc_isreset)
   3082    1.1  augustss 			change |= UPS_C_PORT_RESET;
   3083    1.1  augustss 		USETW(ps.wPortStatus, status);
   3084    1.1  augustss 		USETW(ps.wPortChange, change);
   3085    1.1  augustss 		l = min(len, sizeof ps);
   3086    1.1  augustss 		memcpy(buf, &ps, l);
   3087    1.1  augustss 		totlen = l;
   3088    1.1  augustss 		break;
   3089    1.1  augustss 	case C(UR_SET_DESCRIPTOR, UT_WRITE_CLASS_DEVICE):
   3090   1.63  augustss 		err = USBD_IOERROR;
   3091    1.1  augustss 		goto ret;
   3092    1.1  augustss 	case C(UR_SET_FEATURE, UT_WRITE_CLASS_DEVICE):
   3093    1.1  augustss 		break;
   3094    1.1  augustss 	case C(UR_SET_FEATURE, UT_WRITE_CLASS_OTHER):
   3095    1.1  augustss 		if (index == 1)
   3096    1.1  augustss 			port = UHCI_PORTSC1;
   3097    1.1  augustss 		else if (index == 2)
   3098    1.1  augustss 			port = UHCI_PORTSC2;
   3099    1.1  augustss 		else {
   3100   1.63  augustss 			err = USBD_IOERROR;
   3101    1.1  augustss 			goto ret;
   3102    1.1  augustss 		}
   3103    1.1  augustss 		switch(value) {
   3104    1.1  augustss 		case UHF_PORT_ENABLE:
   3105    1.1  augustss 			x = UREAD2(sc, port);
   3106    1.1  augustss 			UWRITE2(sc, port, x | UHCI_PORTSC_PE);
   3107    1.1  augustss 			break;
   3108    1.1  augustss 		case UHF_PORT_SUSPEND:
   3109    1.1  augustss 			x = UREAD2(sc, port);
   3110    1.1  augustss 			UWRITE2(sc, port, x | UHCI_PORTSC_SUSP);
   3111    1.1  augustss 			break;
   3112    1.1  augustss 		case UHF_PORT_RESET:
   3113    1.1  augustss 			x = UREAD2(sc, port);
   3114    1.1  augustss 			UWRITE2(sc, port, x | UHCI_PORTSC_PR);
   3115   1.20  augustss 			usb_delay_ms(&sc->sc_bus, 10);
   3116    1.1  augustss 			UWRITE2(sc, port, x & ~UHCI_PORTSC_PR);
   3117    1.1  augustss 			delay(100);
   3118    1.1  augustss 			x = UREAD2(sc, port);
   3119    1.1  augustss 			UWRITE2(sc, port, x  | UHCI_PORTSC_PE);
   3120    1.1  augustss 			delay(100);
   3121    1.1  augustss 			DPRINTFN(3,("uhci port %d reset, status = 0x%04x\n",
   3122    1.1  augustss 				    index, UREAD2(sc, port)));
   3123    1.1  augustss 			sc->sc_isreset = 1;
   3124    1.1  augustss 			break;
   3125  1.111  augustss 		case UHF_PORT_POWER:
   3126  1.111  augustss 			/* Pretend we turned on power */
   3127  1.115   mycroft 			err = USBD_NORMAL_COMPLETION;
   3128  1.111  augustss 			goto ret;
   3129    1.1  augustss 		case UHF_C_PORT_CONNECTION:
   3130    1.1  augustss 		case UHF_C_PORT_ENABLE:
   3131    1.1  augustss 		case UHF_C_PORT_OVER_CURRENT:
   3132    1.1  augustss 		case UHF_PORT_CONNECTION:
   3133    1.1  augustss 		case UHF_PORT_OVER_CURRENT:
   3134    1.1  augustss 		case UHF_PORT_LOW_SPEED:
   3135    1.1  augustss 		case UHF_C_PORT_SUSPEND:
   3136    1.1  augustss 		case UHF_C_PORT_RESET:
   3137    1.1  augustss 		default:
   3138   1.63  augustss 			err = USBD_IOERROR;
   3139    1.1  augustss 			goto ret;
   3140    1.1  augustss 		}
   3141    1.1  augustss 		break;
   3142    1.1  augustss 	default:
   3143   1.63  augustss 		err = USBD_IOERROR;
   3144    1.1  augustss 		goto ret;
   3145    1.1  augustss 	}
   3146   1.63  augustss 	xfer->actlen = totlen;
   3147   1.63  augustss 	err = USBD_NORMAL_COMPLETION;
   3148    1.1  augustss  ret:
   3149   1.63  augustss 	xfer->status = err;
   3150   1.52  augustss 	s = splusb();
   3151   1.63  augustss 	usb_transfer_complete(xfer);
   3152   1.52  augustss 	splx(s);
   3153    1.1  augustss 	return (USBD_IN_PROGRESS);
   3154    1.1  augustss }
   3155    1.1  augustss 
   3156    1.1  augustss /* Abort a root control request. */
   3157    1.1  augustss void
   3158   1.63  augustss uhci_root_ctrl_abort(xfer)
   3159   1.63  augustss 	usbd_xfer_handle xfer;
   3160    1.1  augustss {
   3161   1.70  augustss 	/* Nothing to do, all transfers are synchronous. */
   3162    1.1  augustss }
   3163    1.1  augustss 
   3164    1.1  augustss /* Close the root pipe. */
   3165    1.1  augustss void
   3166    1.1  augustss uhci_root_ctrl_close(pipe)
   3167    1.1  augustss 	usbd_pipe_handle pipe;
   3168    1.1  augustss {
   3169    1.1  augustss 	DPRINTF(("uhci_root_ctrl_close\n"));
   3170    1.1  augustss }
   3171    1.1  augustss 
   3172    1.1  augustss /* Abort a root interrupt request. */
   3173    1.1  augustss void
   3174   1.63  augustss uhci_root_intr_abort(xfer)
   3175   1.63  augustss 	usbd_xfer_handle xfer;
   3176    1.1  augustss {
   3177   1.63  augustss 	uhci_softc_t *sc = (uhci_softc_t *)xfer->pipe->device->bus;
   3178   1.30  augustss 
   3179   1.96  augustss 	usb_uncallout(sc->sc_poll_handle, uhci_poll_hub, xfer);
   3180   1.96  augustss 	sc->sc_intr_xfer = NULL;
   3181   1.58  augustss 
   3182   1.63  augustss 	if (xfer->pipe->intrxfer == xfer) {
   3183   1.58  augustss 		DPRINTF(("uhci_root_intr_abort: remove\n"));
   3184   1.63  augustss 		xfer->pipe->intrxfer = 0;
   3185   1.58  augustss 	}
   3186   1.63  augustss 	xfer->status = USBD_CANCELLED;
   3187   1.96  augustss #ifdef DIAGNOSTIC
   3188   1.96  augustss 	UXFER(xfer)->iinfo.isdone = 1;
   3189   1.96  augustss #endif
   3190   1.63  augustss 	usb_transfer_complete(xfer);
   3191    1.1  augustss }
   3192    1.1  augustss 
   3193   1.16  augustss usbd_status
   3194   1.63  augustss uhci_root_intr_transfer(xfer)
   3195   1.63  augustss 	usbd_xfer_handle xfer;
   3196   1.16  augustss {
   3197   1.63  augustss 	usbd_status err;
   3198   1.16  augustss 
   3199   1.52  augustss 	/* Insert last in queue. */
   3200   1.63  augustss 	err = usb_insert_transfer(xfer);
   3201   1.63  augustss 	if (err)
   3202   1.63  augustss 		return (err);
   3203   1.52  augustss 
   3204   1.67  augustss 	/* Pipe isn't running (otherwise err would be USBD_INPROG),
   3205   1.67  augustss 	 * start first
   3206   1.67  augustss 	 */
   3207   1.63  augustss 	return (uhci_root_intr_start(SIMPLEQ_FIRST(&xfer->pipe->queue)));
   3208   1.16  augustss }
   3209   1.16  augustss 
   3210    1.1  augustss /* Start a transfer on the root interrupt pipe */
   3211    1.1  augustss usbd_status
   3212   1.63  augustss uhci_root_intr_start(xfer)
   3213   1.63  augustss 	usbd_xfer_handle xfer;
   3214    1.1  augustss {
   3215   1.63  augustss 	usbd_pipe_handle pipe = xfer->pipe;
   3216    1.1  augustss 	uhci_softc_t *sc = (uhci_softc_t *)pipe->device->bus;
   3217    1.1  augustss 
   3218   1.63  augustss 	DPRINTFN(3, ("uhci_root_intr_transfer: xfer=%p len=%d flags=%d\n",
   3219   1.63  augustss 		     xfer, xfer->length, xfer->flags));
   3220   1.82  augustss 
   3221   1.82  augustss 	if (sc->sc_dying)
   3222   1.82  augustss 		return (USBD_IOERROR);
   3223    1.1  augustss 
   3224   1.63  augustss 	sc->sc_ival = MS_TO_TICKS(xfer->pipe->endpoint->edesc->bInterval);
   3225   1.96  augustss 	usb_callout(sc->sc_poll_handle, sc->sc_ival, uhci_poll_hub, xfer);
   3226   1.96  augustss 	sc->sc_intr_xfer = xfer;
   3227    1.1  augustss 	return (USBD_IN_PROGRESS);
   3228    1.1  augustss }
   3229    1.1  augustss 
   3230    1.1  augustss /* Close the root interrupt pipe. */
   3231    1.1  augustss void
   3232    1.1  augustss uhci_root_intr_close(pipe)
   3233    1.1  augustss 	usbd_pipe_handle pipe;
   3234    1.1  augustss {
   3235   1.30  augustss 	uhci_softc_t *sc = (uhci_softc_t *)pipe->device->bus;
   3236   1.30  augustss 
   3237   1.96  augustss 	usb_uncallout(sc->sc_poll_handle, uhci_poll_hub, sc->sc_intr_xfer);
   3238   1.96  augustss 	sc->sc_intr_xfer = NULL;
   3239    1.1  augustss 	DPRINTF(("uhci_root_intr_close\n"));
   3240    1.1  augustss }
   3241