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