Home | History | Annotate | Line # | Download | only in usb
ohci.c revision 1.72
      1  1.72  augustss /*	$NetBSD: ohci.c,v 1.72 2000/02/22 11:30:54 augustss Exp $	*/
      2  1.55  augustss /*	$FreeBSD: src/sys/dev/usb/ohci.c,v 1.22 1999/11/17 22:33:40 n_hibma Exp $	*/
      3   1.1  augustss 
      4   1.1  augustss /*
      5   1.1  augustss  * Copyright (c) 1998 The NetBSD Foundation, Inc.
      6   1.1  augustss  * All rights reserved.
      7   1.1  augustss  *
      8  1.11  augustss  * This code is derived from software contributed to The NetBSD Foundation
      9  1.11  augustss  * by Lennart Augustsson (augustss (at) carlstedt.se) 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 Open Host Controller driver.
     43   1.1  augustss  *
     44  1.30  augustss  * OHCI spec: ftp://ftp.compaq.com/pub/supportinformation/papers/hcir1_0a.exe
     45  1.30  augustss  * USB spec: http://www.usb.org/developers/data/usb11.pdf
     46   1.1  augustss  */
     47   1.1  augustss 
     48   1.1  augustss #include <sys/param.h>
     49   1.1  augustss #include <sys/systm.h>
     50   1.1  augustss #include <sys/malloc.h>
     51  1.36  augustss #if defined(__NetBSD__) || defined(__OpenBSD__)
     52  1.55  augustss #include <sys/kernel.h>
     53   1.1  augustss #include <sys/device.h>
     54  1.55  augustss #include <sys/select.h>
     55  1.15  augustss #elif defined(__FreeBSD__)
     56  1.15  augustss #include <sys/module.h>
     57  1.15  augustss #include <sys/bus.h>
     58  1.52  augustss #include <machine/bus_pio.h>
     59  1.52  augustss #include <machine/bus_memio.h>
     60  1.55  augustss #if defined(DIAGNOSTIC) && defined(__i386__) && defined(__FreeBSD__)
     61  1.55  augustss #include <machine/cpu.h>
     62  1.55  augustss #endif
     63  1.15  augustss #endif
     64   1.1  augustss #include <sys/proc.h>
     65   1.1  augustss #include <sys/queue.h>
     66   1.1  augustss 
     67   1.4  augustss #include <machine/bus.h>
     68  1.16  augustss #include <machine/endian.h>
     69   1.4  augustss 
     70   1.1  augustss #include <dev/usb/usb.h>
     71   1.1  augustss #include <dev/usb/usbdi.h>
     72   1.1  augustss #include <dev/usb/usbdivar.h>
     73  1.38  augustss #include <dev/usb/usb_mem.h>
     74   1.1  augustss #include <dev/usb/usb_quirks.h>
     75   1.1  augustss 
     76   1.1  augustss #include <dev/usb/ohcireg.h>
     77   1.1  augustss #include <dev/usb/ohcivar.h>
     78   1.1  augustss 
     79  1.15  augustss #if defined(__FreeBSD__)
     80  1.15  augustss #include <machine/clock.h>
     81  1.55  augustss 
     82  1.15  augustss #define delay(d)                DELAY(d)
     83  1.15  augustss #endif
     84   1.1  augustss 
     85  1.36  augustss #if defined(__OpenBSD__)
     86  1.36  augustss struct cfdriver ohci_cd = {
     87  1.36  augustss 	NULL, "ohci", DV_DULL
     88  1.36  augustss };
     89  1.36  augustss #endif
     90  1.36  augustss 
     91  1.52  augustss #ifdef OHCI_DEBUG
     92  1.52  augustss #define DPRINTF(x)	if (ohcidebug) logprintf x
     93  1.52  augustss #define DPRINTFN(n,x)	if (ohcidebug>(n)) logprintf x
     94  1.52  augustss int ohcidebug = 0;
     95  1.52  augustss #else
     96  1.52  augustss #define DPRINTF(x)
     97  1.52  augustss #define DPRINTFN(n,x)
     98  1.52  augustss #endif
     99  1.52  augustss 
    100  1.16  augustss /*
    101  1.16  augustss  * The OHCI controller is little endian, so on big endian machines
    102  1.16  augustss  * the data strored in memory needs to be swapped.
    103  1.16  augustss  */
    104  1.16  augustss #if BYTE_ORDER == BIG_ENDIAN
    105  1.16  augustss #define LE(x) (bswap32(x))
    106  1.16  augustss #else
    107  1.16  augustss #define LE(x) (x)
    108  1.16  augustss #endif
    109  1.16  augustss 
    110   1.1  augustss struct ohci_pipe;
    111   1.1  augustss 
    112  1.53  augustss static ohci_soft_ed_t  *ohci_alloc_sed __P((ohci_softc_t *));
    113  1.53  augustss static void		ohci_free_sed __P((ohci_softc_t *, ohci_soft_ed_t *));
    114   1.1  augustss 
    115  1.53  augustss static ohci_soft_td_t  *ohci_alloc_std __P((ohci_softc_t *));
    116  1.53  augustss static void		ohci_free_std __P((ohci_softc_t *, ohci_soft_td_t *));
    117   1.1  augustss 
    118  1.60  augustss static ohci_soft_itd_t *ohci_alloc_sitd __P((ohci_softc_t *));
    119  1.60  augustss static void		ohci_free_sitd __P((ohci_softc_t *,ohci_soft_itd_t *));
    120  1.60  augustss 
    121  1.53  augustss #if 0
    122  1.53  augustss static void		ohci_free_std_chain __P((ohci_softc_t *,
    123  1.53  augustss 			    ohci_soft_td_t *, ohci_soft_td_t *));
    124  1.53  augustss #endif
    125  1.53  augustss static usbd_status	ohci_alloc_std_chain __P((struct ohci_pipe *,
    126  1.61  augustss 			    ohci_softc_t *, int, int, u_int16_t, usb_dma_t *,
    127  1.53  augustss 			    ohci_soft_td_t *, ohci_soft_td_t **));
    128  1.53  augustss 
    129  1.59  augustss static void		ohci_shutdown __P((void *v));
    130  1.53  augustss static void		ohci_power __P((int, void *));
    131  1.53  augustss static usbd_status	ohci_open __P((usbd_pipe_handle));
    132  1.53  augustss static void		ohci_poll __P((struct usbd_bus *));
    133  1.72  augustss static void		ohci_softintr __P((struct usbd_bus *));
    134  1.53  augustss static void		ohci_waitintr __P((ohci_softc_t *,
    135  1.53  augustss 			    usbd_xfer_handle));
    136  1.53  augustss static void		ohci_rhsc __P((ohci_softc_t *, usbd_xfer_handle));
    137  1.53  augustss 
    138  1.53  augustss static usbd_status	ohci_device_request __P((usbd_xfer_handle xfer));
    139  1.53  augustss static void		ohci_add_ed __P((ohci_soft_ed_t *, ohci_soft_ed_t *));
    140  1.53  augustss static void		ohci_rem_ed __P((ohci_soft_ed_t *, ohci_soft_ed_t *));
    141  1.53  augustss static void		ohci_hash_add_td __P((ohci_softc_t *,
    142  1.53  augustss 			    ohci_soft_td_t *));
    143  1.53  augustss static void		ohci_hash_rem_td __P((ohci_softc_t *,
    144  1.53  augustss 			    ohci_soft_td_t *));
    145  1.53  augustss static ohci_soft_td_t  *ohci_hash_find_td __P((ohci_softc_t *,
    146  1.53  augustss 			    ohci_physaddr_t));
    147  1.53  augustss 
    148  1.60  augustss static usbd_status	ohci_setup_isoc __P((usbd_pipe_handle pipe));
    149  1.60  augustss static void		ohci_device_isoc_enter __P((usbd_xfer_handle));
    150  1.60  augustss 
    151  1.53  augustss static usbd_status	ohci_allocm __P((struct usbd_bus *, usb_dma_t *,
    152  1.53  augustss 			    u_int32_t));
    153  1.53  augustss static void		ohci_freem __P((struct usbd_bus *, usb_dma_t *));
    154  1.53  augustss 
    155  1.62  augustss static usbd_xfer_handle	ohci_allocx __P((struct usbd_bus *));
    156  1.62  augustss static void		ohci_freex __P((struct usbd_bus *, usbd_xfer_handle));
    157  1.62  augustss 
    158  1.53  augustss static usbd_status	ohci_root_ctrl_transfer __P((usbd_xfer_handle));
    159  1.53  augustss static usbd_status	ohci_root_ctrl_start __P((usbd_xfer_handle));
    160  1.53  augustss static void		ohci_root_ctrl_abort __P((usbd_xfer_handle));
    161  1.53  augustss static void		ohci_root_ctrl_close __P((usbd_pipe_handle));
    162  1.65  augustss static void		ohci_root_ctrl_done  __P((usbd_xfer_handle));
    163  1.53  augustss 
    164  1.53  augustss static usbd_status	ohci_root_intr_transfer __P((usbd_xfer_handle));
    165  1.53  augustss static usbd_status	ohci_root_intr_start __P((usbd_xfer_handle));
    166  1.53  augustss static void		ohci_root_intr_abort __P((usbd_xfer_handle));
    167  1.53  augustss static void		ohci_root_intr_close __P((usbd_pipe_handle));
    168  1.53  augustss static void		ohci_root_intr_done  __P((usbd_xfer_handle));
    169  1.53  augustss 
    170  1.53  augustss static usbd_status	ohci_device_ctrl_transfer __P((usbd_xfer_handle));
    171  1.53  augustss static usbd_status	ohci_device_ctrl_start __P((usbd_xfer_handle));
    172  1.53  augustss static void		ohci_device_ctrl_abort __P((usbd_xfer_handle));
    173  1.53  augustss static void		ohci_device_ctrl_close __P((usbd_pipe_handle));
    174  1.53  augustss static void		ohci_device_ctrl_done  __P((usbd_xfer_handle));
    175  1.53  augustss 
    176  1.53  augustss static usbd_status	ohci_device_bulk_transfer __P((usbd_xfer_handle));
    177  1.53  augustss static usbd_status	ohci_device_bulk_start __P((usbd_xfer_handle));
    178  1.53  augustss static void		ohci_device_bulk_abort __P((usbd_xfer_handle));
    179  1.53  augustss static void		ohci_device_bulk_close __P((usbd_pipe_handle));
    180  1.53  augustss static void		ohci_device_bulk_done  __P((usbd_xfer_handle));
    181  1.53  augustss 
    182  1.53  augustss static usbd_status	ohci_device_intr_transfer __P((usbd_xfer_handle));
    183  1.53  augustss static usbd_status	ohci_device_intr_start __P((usbd_xfer_handle));
    184  1.53  augustss static void		ohci_device_intr_abort __P((usbd_xfer_handle));
    185  1.53  augustss static void		ohci_device_intr_close __P((usbd_pipe_handle));
    186  1.53  augustss static void		ohci_device_intr_done  __P((usbd_xfer_handle));
    187  1.53  augustss 
    188  1.53  augustss static usbd_status	ohci_device_isoc_transfer __P((usbd_xfer_handle));
    189  1.53  augustss static usbd_status	ohci_device_isoc_start __P((usbd_xfer_handle));
    190  1.53  augustss static void		ohci_device_isoc_abort __P((usbd_xfer_handle));
    191  1.53  augustss static void		ohci_device_isoc_close __P((usbd_pipe_handle));
    192  1.53  augustss static void		ohci_device_isoc_done  __P((usbd_xfer_handle));
    193  1.53  augustss 
    194  1.53  augustss static usbd_status	ohci_device_setintr __P((ohci_softc_t *sc,
    195  1.53  augustss 			    struct ohci_pipe *pipe, int ival));
    196  1.53  augustss 
    197  1.53  augustss static int		ohci_str __P((usb_string_descriptor_t *, int, char *));
    198  1.53  augustss 
    199  1.53  augustss static void		ohci_timeout __P((void *));
    200  1.53  augustss static void		ohci_rhsc_able __P((ohci_softc_t *, int));
    201  1.34  augustss 
    202  1.53  augustss static void		ohci_close_pipe __P((usbd_pipe_handle pipe,
    203  1.53  augustss 			    ohci_soft_ed_t *head));
    204  1.54  augustss static void		ohci_abort_xfer __P((usbd_xfer_handle xfer,
    205  1.53  augustss 			    usbd_status status));
    206  1.54  augustss static void		ohci_abort_xfer_end __P((void *));
    207  1.53  augustss 
    208  1.53  augustss static void		ohci_device_clear_toggle __P((usbd_pipe_handle pipe));
    209  1.53  augustss static void		ohci_noop __P((usbd_pipe_handle pipe));
    210  1.37  augustss 
    211  1.52  augustss #ifdef OHCI_DEBUG
    212  1.53  augustss static void		ohci_dumpregs __P((ohci_softc_t *));
    213  1.53  augustss static void		ohci_dump_tds __P((ohci_soft_td_t *));
    214  1.53  augustss static void		ohci_dump_td __P((ohci_soft_td_t *));
    215  1.53  augustss static void		ohci_dump_ed __P((ohci_soft_ed_t *));
    216   1.1  augustss #endif
    217   1.1  augustss 
    218   1.1  augustss #define OWRITE4(sc, r, x) bus_space_write_4((sc)->iot, (sc)->ioh, (r), (x))
    219   1.1  augustss #define OREAD4(sc, r) bus_space_read_4((sc)->iot, (sc)->ioh, (r))
    220   1.1  augustss #define OREAD2(sc, r) bus_space_read_2((sc)->iot, (sc)->ioh, (r))
    221   1.1  augustss 
    222   1.1  augustss /* Reverse the bits in a value 0 .. 31 */
    223   1.1  augustss static u_int8_t revbits[OHCI_NO_INTRS] =
    224   1.1  augustss   { 0x00, 0x10, 0x08, 0x18, 0x04, 0x14, 0x0c, 0x1c,
    225   1.1  augustss     0x02, 0x12, 0x0a, 0x1a, 0x06, 0x16, 0x0e, 0x1e,
    226   1.1  augustss     0x01, 0x11, 0x09, 0x19, 0x05, 0x15, 0x0d, 0x1d,
    227   1.1  augustss     0x03, 0x13, 0x0b, 0x1b, 0x07, 0x17, 0x0f, 0x1f };
    228   1.1  augustss 
    229   1.1  augustss struct ohci_pipe {
    230   1.1  augustss 	struct usbd_pipe pipe;
    231   1.1  augustss 	ohci_soft_ed_t *sed;
    232  1.60  augustss 	union {
    233  1.60  augustss 		ohci_soft_td_t *td;
    234  1.60  augustss 		ohci_soft_itd_t *itd;
    235  1.60  augustss 	} tail;
    236   1.1  augustss 	/* Info needed for different pipe kinds. */
    237   1.1  augustss 	union {
    238   1.1  augustss 		/* Control pipe */
    239   1.1  augustss 		struct {
    240   1.4  augustss 			usb_dma_t reqdma;
    241   1.1  augustss 			u_int length;
    242  1.48  augustss 			ohci_soft_td_t *setup, *data, *stat;
    243   1.1  augustss 		} ctl;
    244   1.1  augustss 		/* Interrupt pipe */
    245   1.1  augustss 		struct {
    246   1.1  augustss 			int nslots;
    247   1.1  augustss 			int pos;
    248   1.1  augustss 		} intr;
    249   1.3  augustss 		/* Bulk pipe */
    250   1.3  augustss 		struct {
    251   1.3  augustss 			u_int length;
    252  1.32  augustss 			int isread;
    253   1.3  augustss 		} bulk;
    254  1.43  augustss 		/* Iso pipe */
    255  1.43  augustss 		struct iso {
    256  1.60  augustss 			int next, inuse;
    257  1.43  augustss 		} iso;
    258   1.1  augustss 	} u;
    259   1.1  augustss };
    260   1.1  augustss 
    261   1.1  augustss #define OHCI_INTR_ENDPT 1
    262   1.1  augustss 
    263  1.53  augustss static struct usbd_bus_methods ohci_bus_methods = {
    264  1.42  augustss 	ohci_open,
    265  1.42  augustss 	ohci_poll,
    266  1.72  augustss 	ohci_softintr,
    267  1.42  augustss 	ohci_allocm,
    268  1.42  augustss 	ohci_freem,
    269  1.62  augustss 	ohci_allocx,
    270  1.62  augustss 	ohci_freex,
    271  1.42  augustss };
    272  1.42  augustss 
    273  1.53  augustss static struct usbd_pipe_methods ohci_root_ctrl_methods = {
    274   1.1  augustss 	ohci_root_ctrl_transfer,
    275  1.17  augustss 	ohci_root_ctrl_start,
    276   1.1  augustss 	ohci_root_ctrl_abort,
    277   1.1  augustss 	ohci_root_ctrl_close,
    278  1.37  augustss 	ohci_noop,
    279  1.65  augustss 	ohci_root_ctrl_done,
    280   1.1  augustss };
    281   1.1  augustss 
    282  1.53  augustss static struct usbd_pipe_methods ohci_root_intr_methods = {
    283   1.1  augustss 	ohci_root_intr_transfer,
    284  1.17  augustss 	ohci_root_intr_start,
    285   1.1  augustss 	ohci_root_intr_abort,
    286   1.1  augustss 	ohci_root_intr_close,
    287  1.37  augustss 	ohci_noop,
    288  1.38  augustss 	ohci_root_intr_done,
    289   1.1  augustss };
    290   1.1  augustss 
    291  1.53  augustss static struct usbd_pipe_methods ohci_device_ctrl_methods = {
    292   1.1  augustss 	ohci_device_ctrl_transfer,
    293  1.17  augustss 	ohci_device_ctrl_start,
    294   1.1  augustss 	ohci_device_ctrl_abort,
    295   1.1  augustss 	ohci_device_ctrl_close,
    296  1.37  augustss 	ohci_noop,
    297  1.38  augustss 	ohci_device_ctrl_done,
    298   1.1  augustss };
    299   1.1  augustss 
    300  1.53  augustss static struct usbd_pipe_methods ohci_device_intr_methods = {
    301   1.1  augustss 	ohci_device_intr_transfer,
    302  1.17  augustss 	ohci_device_intr_start,
    303   1.1  augustss 	ohci_device_intr_abort,
    304   1.1  augustss 	ohci_device_intr_close,
    305  1.37  augustss 	ohci_device_clear_toggle,
    306  1.38  augustss 	ohci_device_intr_done,
    307   1.1  augustss };
    308   1.1  augustss 
    309  1.53  augustss static struct usbd_pipe_methods ohci_device_bulk_methods = {
    310   1.3  augustss 	ohci_device_bulk_transfer,
    311  1.17  augustss 	ohci_device_bulk_start,
    312   1.3  augustss 	ohci_device_bulk_abort,
    313   1.3  augustss 	ohci_device_bulk_close,
    314  1.37  augustss 	ohci_device_clear_toggle,
    315  1.38  augustss 	ohci_device_bulk_done,
    316   1.3  augustss };
    317   1.3  augustss 
    318  1.53  augustss static struct usbd_pipe_methods ohci_device_isoc_methods = {
    319  1.43  augustss 	ohci_device_isoc_transfer,
    320  1.43  augustss 	ohci_device_isoc_start,
    321  1.43  augustss 	ohci_device_isoc_abort,
    322  1.43  augustss 	ohci_device_isoc_close,
    323  1.43  augustss 	ohci_noop,
    324  1.43  augustss 	ohci_device_isoc_done,
    325  1.43  augustss };
    326  1.43  augustss 
    327  1.55  augustss #if defined(__NetBSD__) || defined(__OpenBSD__)
    328  1.47  augustss int
    329  1.47  augustss ohci_activate(self, act)
    330  1.47  augustss 	device_ptr_t self;
    331  1.47  augustss 	enum devact act;
    332  1.47  augustss {
    333  1.49  augustss 	struct ohci_softc *sc = (struct ohci_softc *)self;
    334  1.47  augustss 	int rv = 0;
    335  1.47  augustss 
    336  1.47  augustss 	switch (act) {
    337  1.47  augustss 	case DVACT_ACTIVATE:
    338  1.47  augustss 		return (EOPNOTSUPP);
    339  1.47  augustss 		break;
    340  1.47  augustss 
    341  1.47  augustss 	case DVACT_DEACTIVATE:
    342  1.49  augustss 		if (sc->sc_child != NULL)
    343  1.49  augustss 			rv = config_deactivate(sc->sc_child);
    344  1.47  augustss 		break;
    345  1.47  augustss 	}
    346  1.47  augustss 	return (rv);
    347  1.47  augustss }
    348  1.47  augustss 
    349  1.47  augustss int
    350  1.50  augustss ohci_detach(sc, flags)
    351  1.50  augustss 	struct ohci_softc *sc;
    352  1.47  augustss 	int flags;
    353  1.47  augustss {
    354  1.47  augustss 	int rv = 0;
    355  1.47  augustss 
    356  1.47  augustss 	if (sc->sc_child != NULL)
    357  1.47  augustss 		rv = config_detach(sc->sc_child, flags);
    358  1.47  augustss 
    359  1.47  augustss 	if (rv != 0)
    360  1.47  augustss 		return (rv);
    361  1.47  augustss 
    362  1.71  augustss #if defined(__NetBSD__) || defined(__OpenBSD__)
    363  1.47  augustss 	powerhook_disestablish(sc->sc_powerhook);
    364  1.59  augustss 	shutdownhook_disestablish(sc->sc_shutdownhook);
    365  1.71  augustss #endif
    366  1.59  augustss 
    367  1.47  augustss 	/* free data structures XXX */
    368  1.47  augustss 
    369  1.47  augustss 	return (rv);
    370  1.47  augustss }
    371  1.55  augustss #endif
    372  1.47  augustss 
    373   1.1  augustss ohci_soft_ed_t *
    374   1.1  augustss ohci_alloc_sed(sc)
    375   1.1  augustss 	ohci_softc_t *sc;
    376   1.1  augustss {
    377   1.1  augustss 	ohci_soft_ed_t *sed;
    378  1.53  augustss 	usbd_status err;
    379   1.1  augustss 	int i, offs;
    380   1.4  augustss 	usb_dma_t dma;
    381   1.1  augustss 
    382  1.53  augustss 	if (sc->sc_freeeds == NULL) {
    383   1.1  augustss 		DPRINTFN(2, ("ohci_alloc_sed: allocating chunk\n"));
    384  1.53  augustss 		err = usb_allocmem(&sc->sc_bus, OHCI_SED_SIZE * OHCI_SED_CHUNK,
    385  1.53  augustss 			  OHCI_ED_ALIGN, &dma);
    386  1.53  augustss 		if (err)
    387  1.39  augustss 			return (0);
    388  1.39  augustss 		for(i = 0; i < OHCI_SED_CHUNK; i++) {
    389  1.39  augustss 			offs = i * OHCI_SED_SIZE;
    390  1.39  augustss 			sed = (ohci_soft_ed_t *)((char *)KERNADDR(&dma) +offs);
    391   1.1  augustss 			sed->physaddr = DMAADDR(&dma) + offs;
    392   1.1  augustss 			sed->next = sc->sc_freeeds;
    393   1.1  augustss 			sc->sc_freeeds = sed;
    394   1.1  augustss 		}
    395   1.1  augustss 	}
    396   1.1  augustss 	sed = sc->sc_freeeds;
    397   1.1  augustss 	sc->sc_freeeds = sed->next;
    398  1.39  augustss 	memset(&sed->ed, 0, sizeof(ohci_ed_t));
    399   1.1  augustss 	sed->next = 0;
    400  1.39  augustss 	return (sed);
    401   1.1  augustss }
    402   1.1  augustss 
    403   1.1  augustss void
    404   1.1  augustss ohci_free_sed(sc, sed)
    405   1.1  augustss 	ohci_softc_t *sc;
    406   1.1  augustss 	ohci_soft_ed_t *sed;
    407   1.1  augustss {
    408   1.1  augustss 	sed->next = sc->sc_freeeds;
    409   1.1  augustss 	sc->sc_freeeds = sed;
    410   1.1  augustss }
    411   1.1  augustss 
    412   1.1  augustss ohci_soft_td_t *
    413   1.1  augustss ohci_alloc_std(sc)
    414   1.1  augustss 	ohci_softc_t *sc;
    415   1.1  augustss {
    416   1.1  augustss 	ohci_soft_td_t *std;
    417  1.53  augustss 	usbd_status err;
    418   1.1  augustss 	int i, offs;
    419   1.4  augustss 	usb_dma_t dma;
    420  1.69  augustss 	int s;
    421   1.1  augustss 
    422  1.53  augustss 	if (sc->sc_freetds == NULL) {
    423   1.1  augustss 		DPRINTFN(2, ("ohci_alloc_std: allocating chunk\n"));
    424  1.53  augustss 		err = usb_allocmem(&sc->sc_bus, OHCI_STD_SIZE * OHCI_STD_CHUNK,
    425  1.53  augustss 			  OHCI_TD_ALIGN, &dma);
    426  1.53  augustss 		if (err)
    427  1.39  augustss 			return (0);
    428  1.69  augustss 		s = splusb();
    429  1.39  augustss 		for(i = 0; i < OHCI_STD_CHUNK; i++) {
    430  1.39  augustss 			offs = i * OHCI_STD_SIZE;
    431  1.39  augustss 			std = (ohci_soft_td_t *)((char *)KERNADDR(&dma) +offs);
    432   1.1  augustss 			std->physaddr = DMAADDR(&dma) + offs;
    433   1.1  augustss 			std->nexttd = sc->sc_freetds;
    434   1.1  augustss 			sc->sc_freetds = std;
    435   1.1  augustss 		}
    436  1.69  augustss 		splx(s);
    437   1.1  augustss 	}
    438  1.69  augustss 
    439  1.69  augustss 	s = splusb();
    440   1.1  augustss 	std = sc->sc_freetds;
    441   1.1  augustss 	sc->sc_freetds = std->nexttd;
    442  1.39  augustss 	memset(&std->td, 0, sizeof(ohci_td_t));
    443   1.1  augustss 	std->nexttd = 0;
    444  1.69  augustss 
    445  1.69  augustss 	ohci_hash_add_td(sc, std);
    446  1.69  augustss 	splx(s);
    447  1.69  augustss 
    448   1.1  augustss 	return (std);
    449   1.1  augustss }
    450   1.1  augustss 
    451   1.1  augustss void
    452   1.1  augustss ohci_free_std(sc, std)
    453   1.1  augustss 	ohci_softc_t *sc;
    454   1.1  augustss 	ohci_soft_td_t *std;
    455   1.1  augustss {
    456  1.69  augustss 	int s;
    457  1.69  augustss 
    458  1.69  augustss 	s = splusb();
    459  1.69  augustss 	ohci_hash_rem_td(sc, std);
    460  1.69  augustss 
    461   1.1  augustss 	std->nexttd = sc->sc_freetds;
    462   1.1  augustss 	sc->sc_freetds = std;
    463  1.69  augustss 	splx(s);
    464   1.1  augustss }
    465   1.1  augustss 
    466   1.1  augustss usbd_status
    467  1.61  augustss ohci_alloc_std_chain(opipe, sc, len, rd, flags, dma, sp, ep)
    468  1.61  augustss 	struct ohci_pipe *opipe;
    469  1.48  augustss 	ohci_softc_t *sc;
    470  1.61  augustss 	int len, rd;
    471  1.61  augustss 	u_int16_t flags;
    472  1.48  augustss 	usb_dma_t *dma;
    473  1.48  augustss 	ohci_soft_td_t *sp, **ep;
    474  1.48  augustss {
    475  1.48  augustss 	ohci_soft_td_t *next, *cur;
    476  1.48  augustss 	ohci_physaddr_t dataphys, dataphysend;
    477  1.61  augustss 	u_int32_t intr, tdflags;
    478  1.48  augustss 	int curlen;
    479  1.48  augustss 
    480  1.55  augustss 	DPRINTFN(len < 4096,("ohci_alloc_std_chain: start len=%d\n", len));
    481  1.48  augustss 	cur = sp;
    482  1.48  augustss 	dataphys = DMAADDR(dma);
    483  1.48  augustss 	dataphysend = OHCI_PAGE(dataphys + len - 1);
    484  1.61  augustss 	tdflags =
    485  1.61  augustss 	    (rd ? OHCI_TD_IN : OHCI_TD_OUT) |
    486  1.61  augustss 	    OHCI_TD_NOCC | OHCI_TD_TOGGLE_CARRY |
    487  1.61  augustss 	    (flags & USBD_SHORT_XFER_OK ? OHCI_TD_R : 0);
    488  1.61  augustss 
    489  1.48  augustss 	for (;;) {
    490  1.48  augustss 		next = ohci_alloc_std(sc);
    491  1.61  augustss 		if (next == 0)
    492  1.61  augustss 			goto nomem;
    493  1.48  augustss 
    494  1.48  augustss 		/* The OHCI hardware can handle at most one page crossing. */
    495  1.48  augustss 		if (OHCI_PAGE(dataphys) == dataphysend ||
    496  1.48  augustss 		    OHCI_PAGE(dataphys) + OHCI_PAGE_SIZE == dataphysend) {
    497  1.48  augustss 			/* we can handle it in this TD */
    498  1.48  augustss 			curlen = len;
    499  1.48  augustss 		} else {
    500  1.48  augustss 			/* must use multiple TDs, fill as much as possible. */
    501  1.48  augustss 			curlen = 2 * OHCI_PAGE_SIZE -
    502  1.48  augustss 				 (dataphys & (OHCI_PAGE_SIZE-1));
    503  1.48  augustss 		}
    504  1.48  augustss 		DPRINTFN(4,("ohci_alloc_std_chain: dataphys=0x%08x "
    505  1.48  augustss 			    "dataphysend=0x%08x len=%d curlen=%d\n",
    506  1.48  augustss 			    dataphys, dataphysend,
    507  1.48  augustss 			    len, curlen));
    508  1.48  augustss 		len -= curlen;
    509  1.48  augustss 
    510  1.48  augustss 		intr = len == 0 ? OHCI_TD_SET_DI(1) : OHCI_TD_NOINTR;
    511  1.61  augustss 		cur->td.td_flags = LE(tdflags | intr);
    512  1.48  augustss 		cur->td.td_cbp = LE(dataphys);
    513  1.48  augustss 		cur->nexttd = next;
    514  1.48  augustss 		cur->td.td_nexttd = LE(next->physaddr);
    515  1.48  augustss 		cur->td.td_be = LE(dataphys + curlen - 1);
    516  1.48  augustss 		cur->len = curlen;
    517  1.48  augustss 		cur->flags = OHCI_ADD_LEN;
    518  1.48  augustss 		DPRINTFN(10,("ohci_alloc_std_chain: cbp=0x%08x be=0x%08x\n",
    519  1.48  augustss 			    dataphys, dataphys + curlen - 1));
    520  1.48  augustss 		if (len == 0)
    521  1.48  augustss 			break;
    522  1.48  augustss 		DPRINTFN(10,("ohci_alloc_std_chain: extend chain\n"));
    523  1.48  augustss 		dataphys += curlen;
    524  1.48  augustss 		cur = next;
    525  1.48  augustss 	}
    526  1.61  augustss 	if ((flags & USBD_FORCE_SHORT_XFER) &&
    527  1.61  augustss 	    len % UGETW(opipe->pipe.endpoint->edesc->wMaxPacketSize) == 0) {
    528  1.61  augustss 		/* Force a 0 length transfer at the end. */
    529  1.61  augustss 		next = ohci_alloc_std(sc);
    530  1.61  augustss 		if (next == 0)
    531  1.61  augustss 			goto nomem;
    532  1.61  augustss 
    533  1.61  augustss 		cur->td.td_flags = LE(tdflags | OHCI_TD_SET_DI(1));
    534  1.61  augustss 		cur->td.td_cbp = 0; /* indicate 0 length packet */
    535  1.61  augustss 		cur->nexttd = next;
    536  1.61  augustss 		cur->td.td_nexttd = LE(next->physaddr);
    537  1.61  augustss 		cur->td.td_be = LE(dataphys - 1);
    538  1.61  augustss 		cur->len = 0;
    539  1.61  augustss 		cur->flags = 0;
    540  1.61  augustss 		cur = next;
    541  1.61  augustss 		DPRINTFN(2,("ohci_alloc_std_chain: add 0 xfer\n"));
    542  1.61  augustss 	}
    543  1.48  augustss 	cur->flags = OHCI_CALL_DONE | OHCI_ADD_LEN;
    544  1.48  augustss 	*ep = next;
    545  1.48  augustss 
    546  1.48  augustss 	return (USBD_NORMAL_COMPLETION);
    547  1.61  augustss 
    548  1.61  augustss  nomem:
    549  1.61  augustss 	/* XXX free chain */
    550  1.61  augustss 	return (USBD_NOMEM);
    551  1.48  augustss }
    552  1.48  augustss 
    553  1.53  augustss #if 0
    554  1.53  augustss static void
    555  1.48  augustss ohci_free_std_chain(sc, std, stdend)
    556  1.48  augustss 	ohci_softc_t *sc;
    557  1.48  augustss 	ohci_soft_td_t *std;
    558  1.48  augustss 	ohci_soft_td_t *stdend;
    559  1.48  augustss {
    560  1.48  augustss 	ohci_soft_td_t *p;
    561  1.48  augustss 
    562  1.48  augustss 	for (; std != stdend; std = p) {
    563  1.48  augustss 		p = std->nexttd;
    564  1.48  augustss 		ohci_free_std(sc, std);
    565  1.48  augustss 	}
    566  1.48  augustss }
    567  1.53  augustss #endif
    568  1.48  augustss 
    569  1.60  augustss ohci_soft_itd_t *
    570  1.60  augustss ohci_alloc_sitd(sc)
    571  1.60  augustss 	ohci_softc_t *sc;
    572  1.60  augustss {
    573  1.60  augustss 	ohci_soft_itd_t *sitd;
    574  1.60  augustss 	usbd_status err;
    575  1.60  augustss 	int i, offs;
    576  1.60  augustss 	usb_dma_t dma;
    577  1.60  augustss 
    578  1.60  augustss 	if (sc->sc_freeitds == NULL) {
    579  1.60  augustss 		DPRINTFN(2, ("ohci_alloc_sitd: allocating chunk\n"));
    580  1.60  augustss 		err = usb_allocmem(&sc->sc_bus, OHCI_STD_SIZE * OHCI_STD_CHUNK,
    581  1.60  augustss 			  OHCI_TD_ALIGN, &dma);
    582  1.60  augustss 		if (err)
    583  1.60  augustss 			return (0);
    584  1.60  augustss 		for(i = 0; i < OHCI_STD_CHUNK; i++) {
    585  1.60  augustss 			offs = i * OHCI_STD_SIZE;
    586  1.60  augustss 			sitd = (ohci_soft_itd_t *)((char*)KERNADDR(&dma)+offs);
    587  1.60  augustss 			sitd->physaddr = DMAADDR(&dma) + offs;
    588  1.60  augustss 			sitd->nextitd = sc->sc_freeitds;
    589  1.60  augustss 			sc->sc_freeitds = sitd;
    590  1.60  augustss 		}
    591  1.60  augustss 	}
    592  1.60  augustss 	sitd = sc->sc_freeitds;
    593  1.60  augustss 	sc->sc_freeitds = sitd->nextitd;
    594  1.60  augustss 	memset(&sitd->itd, 0, sizeof(ohci_itd_t));
    595  1.60  augustss 	sitd->nextitd = 0;
    596  1.60  augustss 	return (sitd);
    597  1.60  augustss }
    598  1.60  augustss 
    599  1.60  augustss void
    600  1.60  augustss ohci_free_sitd(sc, sitd)
    601  1.60  augustss 	ohci_softc_t *sc;
    602  1.60  augustss 	ohci_soft_itd_t *sitd;
    603  1.60  augustss {
    604  1.60  augustss 	sitd->nextitd = sc->sc_freeitds;
    605  1.60  augustss 	sc->sc_freeitds = sitd;
    606  1.60  augustss }
    607  1.60  augustss 
    608  1.48  augustss usbd_status
    609   1.1  augustss ohci_init(sc)
    610   1.1  augustss 	ohci_softc_t *sc;
    611   1.1  augustss {
    612   1.1  augustss 	ohci_soft_ed_t *sed, *psed;
    613  1.53  augustss 	usbd_status err;
    614   1.1  augustss 	int i;
    615  1.68  augustss 	u_int32_t s, ctl, ival, hcr, fm, per, rev, desca;
    616  1.16  augustss 
    617   1.1  augustss 	DPRINTF(("ohci_init: start\n"));
    618  1.36  augustss #if defined(__OpenBSD__)
    619  1.55  augustss 	printf(",");
    620  1.36  augustss #else
    621  1.55  augustss 	printf("%s:", USBDEVNAME(sc->sc_bus.bdev));
    622  1.36  augustss #endif
    623  1.56  augustss 	rev = OREAD4(sc, OHCI_REVISION);
    624  1.55  augustss 	printf(" OHCI version %d.%d%s\n", OHCI_REV_HI(rev), OHCI_REV_LO(rev),
    625   1.1  augustss 	       OHCI_REV_LEGACY(rev) ? ", legacy support" : "");
    626  1.55  augustss 
    627   1.1  augustss 	if (OHCI_REV_HI(rev) != 1 || OHCI_REV_LO(rev) != 0) {
    628   1.1  augustss 		printf("%s: unsupported OHCI revision\n",
    629  1.15  augustss 		       USBDEVNAME(sc->sc_bus.bdev));
    630  1.56  augustss 		sc->sc_bus.usbrev = USBREV_UNKNOWN;
    631   1.1  augustss 		return (USBD_INVAL);
    632   1.1  augustss 	}
    633  1.56  augustss 	sc->sc_bus.usbrev = USBREV_1_0;
    634   1.1  augustss 
    635   1.1  augustss 	for (i = 0; i < OHCI_HASH_SIZE; i++)
    636   1.1  augustss 		LIST_INIT(&sc->sc_hash_tds[i]);
    637   1.1  augustss 
    638  1.62  augustss 	SIMPLEQ_INIT(&sc->sc_free_xfers);
    639  1.62  augustss 
    640   1.1  augustss 	/* Allocate the HCCA area. */
    641  1.53  augustss 	err = usb_allocmem(&sc->sc_bus, OHCI_HCCA_SIZE,
    642   1.4  augustss 			 OHCI_HCCA_ALIGN, &sc->sc_hccadma);
    643  1.53  augustss 	if (err)
    644  1.53  augustss 		return (err);
    645   1.1  augustss 	sc->sc_hcca = (struct ohci_hcca *)KERNADDR(&sc->sc_hccadma);
    646   1.1  augustss 	memset(sc->sc_hcca, 0, OHCI_HCCA_SIZE);
    647   1.1  augustss 
    648   1.1  augustss 	sc->sc_eintrs = OHCI_NORMAL_INTRS;
    649   1.1  augustss 
    650  1.60  augustss 	/* Allocate dummy ED that starts the control list. */
    651   1.1  augustss 	sc->sc_ctrl_head = ohci_alloc_sed(sc);
    652  1.53  augustss 	if (sc->sc_ctrl_head == NULL) {
    653  1.53  augustss 		err = USBD_NOMEM;
    654   1.1  augustss 		goto bad1;
    655   1.1  augustss 	}
    656  1.39  augustss 	sc->sc_ctrl_head->ed.ed_flags |= LE(OHCI_ED_SKIP);
    657  1.34  augustss 
    658  1.60  augustss 	/* Allocate dummy ED that starts the bulk list. */
    659   1.1  augustss 	sc->sc_bulk_head = ohci_alloc_sed(sc);
    660  1.53  augustss 	if (sc->sc_bulk_head == NULL) {
    661  1.53  augustss 		err = USBD_NOMEM;
    662   1.1  augustss 		goto bad2;
    663   1.1  augustss 	}
    664  1.39  augustss 	sc->sc_bulk_head->ed.ed_flags |= LE(OHCI_ED_SKIP);
    665   1.1  augustss 
    666  1.60  augustss 	/* Allocate dummy ED that starts the isochronous list. */
    667  1.60  augustss 	sc->sc_isoc_head = ohci_alloc_sed(sc);
    668  1.60  augustss 	if (sc->sc_isoc_head == NULL) {
    669  1.60  augustss 		err = USBD_NOMEM;
    670  1.60  augustss 		goto bad3;
    671  1.60  augustss 	}
    672  1.60  augustss 	sc->sc_isoc_head->ed.ed_flags |= LE(OHCI_ED_SKIP);
    673  1.60  augustss 
    674   1.1  augustss 	/* Allocate all the dummy EDs that make up the interrupt tree. */
    675   1.1  augustss 	for (i = 0; i < OHCI_NO_EDS; i++) {
    676   1.1  augustss 		sed = ohci_alloc_sed(sc);
    677  1.53  augustss 		if (sed == NULL) {
    678   1.1  augustss 			while (--i >= 0)
    679   1.1  augustss 				ohci_free_sed(sc, sc->sc_eds[i]);
    680  1.53  augustss 			err = USBD_NOMEM;
    681  1.60  augustss 			goto bad4;
    682   1.1  augustss 		}
    683   1.1  augustss 		/* All ED fields are set to 0. */
    684   1.1  augustss 		sc->sc_eds[i] = sed;
    685  1.39  augustss 		sed->ed.ed_flags |= LE(OHCI_ED_SKIP);
    686  1.60  augustss 		if (i != 0)
    687   1.1  augustss 			psed = sc->sc_eds[(i-1) / 2];
    688  1.60  augustss 		else
    689  1.60  augustss 			psed= sc->sc_isoc_head;
    690  1.60  augustss 		sed->next = psed;
    691  1.60  augustss 		sed->ed.ed_nexted = LE(psed->physaddr);
    692   1.1  augustss 	}
    693   1.1  augustss 	/*
    694   1.1  augustss 	 * Fill HCCA interrupt table.  The bit reversal is to get
    695   1.1  augustss 	 * the tree set up properly to spread the interrupts.
    696   1.1  augustss 	 */
    697   1.1  augustss 	for (i = 0; i < OHCI_NO_INTRS; i++)
    698   1.1  augustss 		sc->sc_hcca->hcca_interrupt_table[revbits[i]] =
    699  1.16  augustss 			LE(sc->sc_eds[OHCI_NO_EDS-OHCI_NO_INTRS+i]->physaddr);
    700   1.1  augustss 
    701   1.1  augustss 	/* Determine in what context we are running. */
    702   1.1  augustss 	ctl = OREAD4(sc, OHCI_CONTROL);
    703   1.1  augustss 	if (ctl & OHCI_IR) {
    704   1.1  augustss 		/* SMM active, request change */
    705   1.1  augustss 		DPRINTF(("ohci_init: SMM active, request owner change\n"));
    706   1.1  augustss 		s = OREAD4(sc, OHCI_COMMAND_STATUS);
    707   1.1  augustss 		OWRITE4(sc, OHCI_COMMAND_STATUS, s | OHCI_OCR);
    708   1.1  augustss 		for (i = 0; i < 100 && (ctl & OHCI_IR); i++) {
    709  1.53  augustss 			usb_delay_ms(&sc->sc_bus, 1);
    710   1.1  augustss 			ctl = OREAD4(sc, OHCI_CONTROL);
    711   1.1  augustss 		}
    712   1.1  augustss 		if ((ctl & OHCI_IR) == 0) {
    713  1.15  augustss 			printf("%s: SMM does not respond, resetting\n",
    714  1.15  augustss 			       USBDEVNAME(sc->sc_bus.bdev));
    715   1.1  augustss 			OWRITE4(sc, OHCI_CONTROL, OHCI_HCFS_RESET);
    716   1.1  augustss 			goto reset;
    717   1.1  augustss 		}
    718   1.1  augustss 	} else if ((ctl & OHCI_HCFS_MASK) != OHCI_HCFS_RESET) {
    719   1.1  augustss 		/* BIOS started controller. */
    720   1.1  augustss 		DPRINTF(("ohci_init: BIOS active\n"));
    721   1.1  augustss 		if ((ctl & OHCI_HCFS_MASK) != OHCI_HCFS_OPERATIONAL) {
    722   1.1  augustss 			OWRITE4(sc, OHCI_CONTROL, OHCI_HCFS_OPERATIONAL);
    723  1.53  augustss 			usb_delay_ms(&sc->sc_bus, USB_RESUME_DELAY);
    724   1.1  augustss 		}
    725   1.1  augustss 	} else {
    726   1.1  augustss 		DPRINTF(("ohci_init: cold started\n"));
    727   1.1  augustss 	reset:
    728   1.1  augustss 		/* Controller was cold started. */
    729  1.53  augustss 		usb_delay_ms(&sc->sc_bus, USB_BUS_RESET_DELAY);
    730   1.1  augustss 	}
    731   1.1  augustss 
    732  1.16  augustss 	/*
    733  1.25  augustss 	 * This reset should not be necessary according to the OHCI spec, but
    734  1.25  augustss 	 * without it some controllers do not start.
    735  1.16  augustss 	 */
    736  1.16  augustss 	DPRINTF(("%s: resetting\n", USBDEVNAME(sc->sc_bus.bdev)));
    737  1.16  augustss 	OWRITE4(sc, OHCI_CONTROL, OHCI_HCFS_RESET);
    738  1.55  augustss 	usb_delay_ms(&sc->sc_bus, USB_BUS_RESET_DELAY);
    739  1.16  augustss 
    740   1.1  augustss 	/* We now own the host controller and the bus has been reset. */
    741   1.1  augustss 	ival = OHCI_GET_IVAL(OREAD4(sc, OHCI_FM_INTERVAL));
    742   1.1  augustss 
    743   1.1  augustss 	OWRITE4(sc, OHCI_COMMAND_STATUS, OHCI_HCR); /* Reset HC */
    744   1.1  augustss 	/* Nominal time for a reset is 10 us. */
    745   1.1  augustss 	for (i = 0; i < 10; i++) {
    746   1.1  augustss 		delay(10);
    747   1.1  augustss 		hcr = OREAD4(sc, OHCI_COMMAND_STATUS) & OHCI_HCR;
    748   1.1  augustss 		if (!hcr)
    749   1.1  augustss 			break;
    750   1.1  augustss 	}
    751   1.1  augustss 	if (hcr) {
    752  1.15  augustss 		printf("%s: reset timeout\n", USBDEVNAME(sc->sc_bus.bdev));
    753  1.53  augustss 		err = USBD_IOERROR;
    754  1.60  augustss 		goto bad5;
    755   1.1  augustss 	}
    756  1.52  augustss #ifdef OHCI_DEBUG
    757   1.1  augustss 	if (ohcidebug > 15)
    758   1.1  augustss 		ohci_dumpregs(sc);
    759   1.1  augustss #endif
    760   1.1  augustss 
    761  1.60  augustss 	/* The controller is now in SUSPEND state, we have 2ms to finish. */
    762   1.1  augustss 
    763   1.1  augustss 	/* Set up HC registers. */
    764   1.1  augustss 	OWRITE4(sc, OHCI_HCCA, DMAADDR(&sc->sc_hccadma));
    765   1.1  augustss 	OWRITE4(sc, OHCI_CONTROL_HEAD_ED, sc->sc_ctrl_head->physaddr);
    766   1.1  augustss 	OWRITE4(sc, OHCI_BULK_HEAD_ED, sc->sc_bulk_head->physaddr);
    767  1.55  augustss 	/* disable all interrupts and then switch on all desired interrupts */
    768   1.1  augustss 	OWRITE4(sc, OHCI_INTERRUPT_DISABLE, OHCI_ALL_INTRS);
    769   1.1  augustss 	OWRITE4(sc, OHCI_INTERRUPT_ENABLE, sc->sc_eintrs | OHCI_MIE);
    770  1.55  augustss 	/* switch on desired functional features */
    771   1.1  augustss 	ctl = OREAD4(sc, OHCI_CONTROL);
    772   1.1  augustss 	ctl &= ~(OHCI_CBSR_MASK | OHCI_LES | OHCI_HCFS_MASK | OHCI_IR);
    773   1.1  augustss 	ctl |= OHCI_PLE | OHCI_IE | OHCI_CLE | OHCI_BLE |
    774   1.1  augustss 		OHCI_RATIO_1_4 | OHCI_HCFS_OPERATIONAL;
    775   1.1  augustss 	/* And finally start it! */
    776   1.1  augustss 	OWRITE4(sc, OHCI_CONTROL, ctl);
    777   1.1  augustss 
    778   1.1  augustss 	/*
    779   1.1  augustss 	 * The controller is now OPERATIONAL.  Set a some final
    780   1.1  augustss 	 * registers that should be set earlier, but that the
    781   1.1  augustss 	 * controller ignores when in the SUSPEND state.
    782   1.1  augustss 	 */
    783   1.1  augustss 	fm = (OREAD4(sc, OHCI_FM_INTERVAL) & OHCI_FIT) ^ OHCI_FIT;
    784   1.1  augustss 	fm |= OHCI_FSMPS(ival) | ival;
    785   1.1  augustss 	OWRITE4(sc, OHCI_FM_INTERVAL, fm);
    786   1.1  augustss 	per = OHCI_PERIODIC(ival); /* 90% periodic */
    787   1.1  augustss 	OWRITE4(sc, OHCI_PERIODIC_START, per);
    788   1.1  augustss 
    789  1.68  augustss 	/* Fiddle the No OverCurrent Protection bit to avoid chip bug. */
    790  1.68  augustss 	desca = OREAD4(sc, OHCI_RH_DESCRIPTOR_A);
    791  1.68  augustss 	OWRITE4(sc, OHCI_RH_DESCRIPTOR_A, desca | OHCI_NOCP);
    792  1.68  augustss 	OWRITE4(sc, OHCI_RH_STATUS, OHCI_LPSC); /* Enable port power */
    793  1.68  augustss 	usb_delay_ms(&sc->sc_bus, 5);
    794  1.68  augustss 	OWRITE4(sc, OHCI_RH_DESCRIPTOR_A, desca);
    795   1.1  augustss 
    796   1.1  augustss 	sc->sc_noport = OHCI_GET_NDP(OREAD4(sc, OHCI_RH_DESCRIPTOR_A));
    797   1.1  augustss 
    798  1.52  augustss #ifdef OHCI_DEBUG
    799   1.1  augustss 	if (ohcidebug > 5)
    800   1.1  augustss 		ohci_dumpregs(sc);
    801   1.1  augustss #endif
    802   1.1  augustss 
    803   1.1  augustss 	/* Set up the bus struct. */
    804  1.42  augustss 	sc->sc_bus.methods = &ohci_bus_methods;
    805   1.1  augustss 	sc->sc_bus.pipe_size = sizeof(struct ohci_pipe);
    806   1.1  augustss 
    807  1.71  augustss #if defined(__NetBSD__) || defined(__OpenBSD__)
    808  1.47  augustss 	sc->sc_powerhook = powerhook_establish(ohci_power, sc);
    809  1.59  augustss 	sc->sc_shutdownhook = shutdownhook_establish(ohci_shutdown, sc);
    810  1.71  augustss #endif
    811  1.59  augustss 
    812   1.1  augustss 	return (USBD_NORMAL_COMPLETION);
    813   1.1  augustss 
    814  1.60  augustss  bad5:
    815  1.60  augustss 	for (i = 0; i < OHCI_NO_EDS; i++)
    816  1.60  augustss 		ohci_free_sed(sc, sc->sc_eds[i]);
    817  1.60  augustss  bad4:
    818  1.60  augustss 	ohci_free_sed(sc, sc->sc_isoc_head);
    819   1.1  augustss  bad3:
    820   1.1  augustss 	ohci_free_sed(sc, sc->sc_ctrl_head);
    821   1.1  augustss  bad2:
    822   1.1  augustss 	ohci_free_sed(sc, sc->sc_bulk_head);
    823   1.1  augustss  bad1:
    824  1.44  augustss 	usb_freemem(&sc->sc_bus, &sc->sc_hccadma);
    825  1.53  augustss 	return (err);
    826   1.1  augustss }
    827   1.1  augustss 
    828  1.42  augustss usbd_status
    829  1.42  augustss ohci_allocm(bus, dma, size)
    830  1.42  augustss 	struct usbd_bus *bus;
    831  1.42  augustss 	usb_dma_t *dma;
    832  1.42  augustss 	u_int32_t size;
    833  1.42  augustss {
    834  1.52  augustss #if defined(__NetBSD__) || defined(__OpenBSD__)
    835  1.42  augustss 	struct ohci_softc *sc = (struct ohci_softc *)bus;
    836  1.52  augustss #endif
    837  1.42  augustss 
    838  1.44  augustss 	return (usb_allocmem(&sc->sc_bus, size, 0, dma));
    839  1.42  augustss }
    840  1.42  augustss 
    841  1.42  augustss void
    842  1.42  augustss ohci_freem(bus, dma)
    843  1.42  augustss 	struct usbd_bus *bus;
    844  1.42  augustss 	usb_dma_t *dma;
    845  1.42  augustss {
    846  1.52  augustss #if defined(__NetBSD__) || defined(__OpenBSD__)
    847  1.42  augustss 	struct ohci_softc *sc = (struct ohci_softc *)bus;
    848  1.52  augustss #endif
    849  1.42  augustss 
    850  1.44  augustss 	usb_freemem(&sc->sc_bus, dma);
    851  1.62  augustss }
    852  1.62  augustss 
    853  1.62  augustss usbd_xfer_handle
    854  1.62  augustss ohci_allocx(bus)
    855  1.62  augustss 	struct usbd_bus *bus;
    856  1.62  augustss {
    857  1.62  augustss 	struct ohci_softc *sc = (struct ohci_softc *)bus;
    858  1.62  augustss 	usbd_xfer_handle xfer;
    859  1.62  augustss 
    860  1.62  augustss 	xfer = SIMPLEQ_FIRST(&sc->sc_free_xfers);
    861  1.62  augustss 	if (xfer != NULL)
    862  1.62  augustss 		SIMPLEQ_REMOVE_HEAD(&sc->sc_free_xfers, xfer, next);
    863  1.62  augustss 	else
    864  1.62  augustss 		xfer = malloc(sizeof(*xfer), M_USB, M_NOWAIT);
    865  1.63  augustss 	if (xfer != NULL)
    866  1.63  augustss 		memset(xfer, 0, sizeof *xfer);
    867  1.62  augustss 	return (xfer);
    868  1.62  augustss }
    869  1.62  augustss 
    870  1.62  augustss void
    871  1.62  augustss ohci_freex(bus, xfer)
    872  1.62  augustss 	struct usbd_bus *bus;
    873  1.62  augustss 	usbd_xfer_handle xfer;
    874  1.62  augustss {
    875  1.62  augustss 	struct ohci_softc *sc = (struct ohci_softc *)bus;
    876  1.62  augustss 
    877  1.62  augustss 	SIMPLEQ_INSERT_HEAD(&sc->sc_free_xfers, xfer, next);
    878  1.42  augustss }
    879  1.42  augustss 
    880  1.59  augustss /*
    881  1.59  augustss  * Shut down the controller when the system is going down.
    882  1.59  augustss  */
    883  1.59  augustss void
    884  1.59  augustss ohci_shutdown(v)
    885  1.59  augustss 	void *v;
    886  1.59  augustss {
    887  1.59  augustss 	ohci_softc_t *sc = v;
    888  1.59  augustss 
    889  1.59  augustss 	DPRINTF(("ohci_shutdown: stopping the HC\n"));
    890  1.59  augustss 	OWRITE4(sc, OHCI_CONTROL, OHCI_HCFS_RESET);
    891  1.59  augustss }
    892  1.59  augustss 
    893  1.59  augustss /*
    894  1.59  augustss  * Handle suspend/resume.
    895  1.59  augustss  *
    896  1.59  augustss  * We need to switch to polling mode here, because this routine is
    897  1.59  augustss  * called from an intterupt context.  This is all right since we
    898  1.59  augustss  * are almost suspended anyway.
    899  1.59  augustss  */
    900  1.33  augustss void
    901  1.33  augustss ohci_power(why, v)
    902  1.33  augustss 	int why;
    903  1.33  augustss 	void *v;
    904  1.33  augustss {
    905  1.52  augustss #ifdef OHCI_DEBUG
    906  1.33  augustss 	ohci_softc_t *sc = v;
    907  1.33  augustss 
    908  1.41  augustss 	DPRINTF(("ohci_power: sc=%p, why=%d\n", sc, why));
    909  1.33  augustss 	/* XXX should suspend/resume */
    910  1.33  augustss 	ohci_dumpregs(sc);
    911  1.33  augustss #endif
    912  1.33  augustss }
    913  1.33  augustss 
    914  1.52  augustss #ifdef OHCI_DEBUG
    915   1.1  augustss void
    916   1.1  augustss ohci_dumpregs(sc)
    917   1.1  augustss 	ohci_softc_t *sc;
    918   1.1  augustss {
    919  1.41  augustss 	DPRINTF(("ohci_dumpregs: rev=0x%08x control=0x%08x command=0x%08x\n",
    920  1.41  augustss 		 OREAD4(sc, OHCI_REVISION),
    921  1.41  augustss 		 OREAD4(sc, OHCI_CONTROL),
    922  1.41  augustss 		 OREAD4(sc, OHCI_COMMAND_STATUS)));
    923  1.41  augustss 	DPRINTF(("               intrstat=0x%08x intre=0x%08x intrd=0x%08x\n",
    924  1.41  augustss 		 OREAD4(sc, OHCI_INTERRUPT_STATUS),
    925  1.41  augustss 		 OREAD4(sc, OHCI_INTERRUPT_ENABLE),
    926  1.41  augustss 		 OREAD4(sc, OHCI_INTERRUPT_DISABLE)));
    927  1.41  augustss 	DPRINTF(("               hcca=0x%08x percur=0x%08x ctrlhd=0x%08x\n",
    928  1.41  augustss 		 OREAD4(sc, OHCI_HCCA),
    929  1.41  augustss 		 OREAD4(sc, OHCI_PERIOD_CURRENT_ED),
    930  1.41  augustss 		 OREAD4(sc, OHCI_CONTROL_HEAD_ED)));
    931  1.41  augustss 	DPRINTF(("               ctrlcur=0x%08x bulkhd=0x%08x bulkcur=0x%08x\n",
    932  1.41  augustss 		 OREAD4(sc, OHCI_CONTROL_CURRENT_ED),
    933  1.41  augustss 		 OREAD4(sc, OHCI_BULK_HEAD_ED),
    934  1.41  augustss 		 OREAD4(sc, OHCI_BULK_CURRENT_ED)));
    935  1.41  augustss 	DPRINTF(("               done=0x%08x fmival=0x%08x fmrem=0x%08x\n",
    936  1.41  augustss 		 OREAD4(sc, OHCI_DONE_HEAD),
    937  1.41  augustss 		 OREAD4(sc, OHCI_FM_INTERVAL),
    938  1.41  augustss 		 OREAD4(sc, OHCI_FM_REMAINING)));
    939  1.41  augustss 	DPRINTF(("               fmnum=0x%08x perst=0x%08x lsthrs=0x%08x\n",
    940  1.41  augustss 		 OREAD4(sc, OHCI_FM_NUMBER),
    941  1.41  augustss 		 OREAD4(sc, OHCI_PERIODIC_START),
    942  1.41  augustss 		 OREAD4(sc, OHCI_LS_THRESHOLD)));
    943  1.41  augustss 	DPRINTF(("               desca=0x%08x descb=0x%08x stat=0x%08x\n",
    944  1.41  augustss 		 OREAD4(sc, OHCI_RH_DESCRIPTOR_A),
    945  1.41  augustss 		 OREAD4(sc, OHCI_RH_DESCRIPTOR_B),
    946  1.41  augustss 		 OREAD4(sc, OHCI_RH_STATUS)));
    947  1.41  augustss 	DPRINTF(("               port1=0x%08x port2=0x%08x\n",
    948  1.41  augustss 		 OREAD4(sc, OHCI_RH_PORT_STATUS(1)),
    949  1.41  augustss 		 OREAD4(sc, OHCI_RH_PORT_STATUS(2))));
    950  1.41  augustss 	DPRINTF(("         HCCA: frame_number=0x%04x done_head=0x%08x\n",
    951  1.41  augustss 		 LE(sc->sc_hcca->hcca_frame_number),
    952  1.41  augustss 		 LE(sc->sc_hcca->hcca_done_head)));
    953   1.1  augustss }
    954   1.1  augustss #endif
    955   1.1  augustss 
    956  1.55  augustss static int ohci_intr1 __P((ohci_softc_t *));
    957  1.53  augustss 
    958   1.1  augustss int
    959   1.1  augustss ohci_intr(p)
    960   1.1  augustss 	void *p;
    961   1.1  augustss {
    962   1.1  augustss 	ohci_softc_t *sc = p;
    963  1.53  augustss 
    964  1.53  augustss 	/* If we get an interrupt while polling, then just ignore it. */
    965  1.57  augustss 	if (sc->sc_bus.use_polling) {
    966  1.57  augustss #ifdef DIAGNOSTIC
    967  1.57  augustss 		printf("ohci_intr: ignored interrupt while polling\n");
    968  1.57  augustss #endif
    969  1.53  augustss 		return (0);
    970  1.57  augustss 	}
    971  1.53  augustss 
    972  1.53  augustss 	return (ohci_intr1(sc));
    973  1.53  augustss }
    974  1.53  augustss 
    975  1.55  augustss static int
    976  1.53  augustss ohci_intr1(sc)
    977  1.53  augustss 	ohci_softc_t *sc;
    978  1.53  augustss {
    979   1.1  augustss 	u_int32_t intrs, eintrs;
    980   1.1  augustss 	ohci_physaddr_t done;
    981   1.1  augustss 
    982  1.15  augustss 	/* In case the interrupt occurs before initialization has completed. */
    983  1.34  augustss 	if (sc == NULL || sc->sc_hcca == NULL) {
    984  1.15  augustss #ifdef DIAGNOSTIC
    985  1.15  augustss 		printf("ohci_intr: sc->sc_hcca == NULL\n");
    986  1.15  augustss #endif
    987  1.15  augustss 		return (0);
    988  1.15  augustss 	}
    989  1.15  augustss 
    990  1.27  augustss         intrs = 0;
    991  1.16  augustss 	done = LE(sc->sc_hcca->hcca_done_head);
    992   1.1  augustss 	if (done != 0) {
    993  1.26  augustss 		if (done & ~OHCI_DONE_INTRS)
    994  1.26  augustss 			intrs = OHCI_WDH;
    995   1.1  augustss 		if (done & OHCI_DONE_INTRS)
    996   1.1  augustss 			intrs |= OREAD4(sc, OHCI_INTERRUPT_STATUS);
    997   1.1  augustss 	} else
    998   1.1  augustss 		intrs = OREAD4(sc, OHCI_INTERRUPT_STATUS);
    999  1.55  augustss 
   1000   1.1  augustss 	if (!intrs)
   1001   1.1  augustss 		return (0);
   1002  1.55  augustss 
   1003   1.1  augustss 	intrs &= ~OHCI_MIE;
   1004   1.1  augustss 	OWRITE4(sc, OHCI_INTERRUPT_STATUS, intrs); /* Acknowledge */
   1005   1.1  augustss 	eintrs = intrs & sc->sc_eintrs;
   1006   1.1  augustss 	if (!eintrs)
   1007   1.1  augustss 		return (0);
   1008   1.1  augustss 
   1009  1.45  augustss 	sc->sc_bus.intr_context++;
   1010  1.44  augustss 	sc->sc_bus.no_intrs++;
   1011   1.1  augustss 	DPRINTFN(7, ("ohci_intr: sc=%p intrs=%x(%x) eintr=%x\n",
   1012   1.1  augustss 		     sc, (u_int)intrs, OREAD4(sc, OHCI_INTERRUPT_STATUS),
   1013   1.1  augustss 		     (u_int)eintrs));
   1014   1.1  augustss 
   1015   1.1  augustss 	if (eintrs & OHCI_SO) {
   1016  1.15  augustss 		printf("%s: scheduling overrun\n",USBDEVNAME(sc->sc_bus.bdev));
   1017   1.1  augustss 		/* XXX do what */
   1018   1.1  augustss 		intrs &= ~OHCI_SO;
   1019   1.1  augustss 	}
   1020   1.1  augustss 	if (eintrs & OHCI_WDH) {
   1021  1.72  augustss 		done &= OHCI_DONE_INTRS;
   1022  1.72  augustss 		if (sc->sc_done == 0)
   1023  1.72  augustss 			sc->sc_done = done;
   1024  1.72  augustss 		else {
   1025  1.72  augustss 			/* Tack on at the end of sc_done. */
   1026  1.72  augustss 			ohci_physaddr_t ldone;
   1027  1.72  augustss 			ohci_soft_td_t *std;
   1028  1.72  augustss 
   1029  1.72  augustss 			for (ldone = sc->sc_done; ldone != 0;
   1030  1.72  augustss 			     ldone = LE(std->td.td_nexttd))
   1031  1.72  augustss 				std = ohci_hash_find_td(sc, done);
   1032  1.72  augustss 			std->td.td_nexttd = LE(done);
   1033  1.72  augustss 		}
   1034  1.72  augustss 		sc->sc_hcca->hcca_done_head = 0;
   1035  1.72  augustss 		usb_schedsoftintr(&sc->sc_bus);
   1036   1.1  augustss 		intrs &= ~OHCI_WDH;
   1037   1.1  augustss 	}
   1038   1.1  augustss 	if (eintrs & OHCI_RD) {
   1039  1.33  augustss 		printf("%s: resume detect\n", USBDEVNAME(sc->sc_bus.bdev));
   1040   1.1  augustss 		/* XXX process resume detect */
   1041   1.1  augustss 	}
   1042   1.1  augustss 	if (eintrs & OHCI_UE) {
   1043  1.15  augustss 		printf("%s: unrecoverable error, controller halted\n",
   1044  1.15  augustss 		       USBDEVNAME(sc->sc_bus.bdev));
   1045   1.1  augustss 		OWRITE4(sc, OHCI_CONTROL, OHCI_HCFS_RESET);
   1046   1.1  augustss 		/* XXX what else */
   1047   1.1  augustss 	}
   1048   1.1  augustss 	if (eintrs & OHCI_RHSC) {
   1049  1.53  augustss 		ohci_rhsc(sc, sc->sc_intrxfer);
   1050   1.1  augustss 		intrs &= ~OHCI_RHSC;
   1051   1.1  augustss 
   1052   1.1  augustss 		/*
   1053   1.1  augustss 		 * Disable RHSC interrupt for now, because it will be
   1054   1.1  augustss 		 * on until the port has been reset.
   1055   1.1  augustss 		 */
   1056   1.1  augustss 		ohci_rhsc_able(sc, 0);
   1057   1.1  augustss 	}
   1058   1.1  augustss 
   1059  1.45  augustss 	sc->sc_bus.intr_context--;
   1060  1.44  augustss 
   1061   1.1  augustss 	/* Block unprocessed interrupts. XXX */
   1062   1.1  augustss 	OWRITE4(sc, OHCI_INTERRUPT_DISABLE, intrs);
   1063   1.1  augustss 	sc->sc_eintrs &= ~intrs;
   1064   1.1  augustss 
   1065   1.1  augustss 	return (1);
   1066   1.1  augustss }
   1067   1.1  augustss 
   1068   1.1  augustss void
   1069   1.1  augustss ohci_rhsc_able(sc, on)
   1070   1.1  augustss 	ohci_softc_t *sc;
   1071   1.1  augustss 	int on;
   1072   1.1  augustss {
   1073   1.1  augustss 	DPRINTFN(4, ("ohci_rhsc_able: on=%d\n", on));
   1074   1.1  augustss 	if (on) {
   1075   1.1  augustss 		sc->sc_eintrs |= OHCI_RHSC;
   1076   1.1  augustss 		OWRITE4(sc, OHCI_INTERRUPT_ENABLE, OHCI_RHSC);
   1077   1.1  augustss 	} else {
   1078   1.1  augustss 		sc->sc_eintrs &= ~OHCI_RHSC;
   1079   1.1  augustss 		OWRITE4(sc, OHCI_INTERRUPT_DISABLE, OHCI_RHSC);
   1080   1.1  augustss 	}
   1081   1.1  augustss }
   1082   1.1  augustss 
   1083  1.52  augustss #ifdef OHCI_DEBUG
   1084  1.13  augustss char *ohci_cc_strs[] = {
   1085  1.13  augustss 	"NO_ERROR",
   1086  1.13  augustss 	"CRC",
   1087  1.13  augustss 	"BIT_STUFFING",
   1088  1.13  augustss 	"DATA_TOGGLE_MISMATCH",
   1089  1.13  augustss 	"STALL",
   1090  1.13  augustss 	"DEVICE_NOT_RESPONDING",
   1091  1.13  augustss 	"PID_CHECK_FAILURE",
   1092  1.13  augustss 	"UNEXPECTED_PID",
   1093  1.13  augustss 	"DATA_OVERRUN",
   1094  1.13  augustss 	"DATA_UNDERRUN",
   1095  1.13  augustss 	"BUFFER_OVERRUN",
   1096  1.13  augustss 	"BUFFER_UNDERRUN",
   1097  1.67  augustss 	"reserved",
   1098  1.67  augustss 	"reserved",
   1099  1.67  augustss 	"NOT_ACCESSED",
   1100  1.13  augustss 	"NOT_ACCESSED",
   1101  1.13  augustss };
   1102  1.13  augustss #endif
   1103  1.13  augustss 
   1104   1.1  augustss void
   1105  1.72  augustss ohci_softintr(bus)
   1106  1.72  augustss 	struct usbd_bus *bus;
   1107  1.72  augustss {
   1108  1.72  augustss 	ohci_softc_t *sc = (ohci_softc_t *)bus;
   1109   1.1  augustss 	ohci_physaddr_t done;
   1110  1.48  augustss 	ohci_soft_td_t *std, *sdone, *stdnext;
   1111  1.53  augustss 	usbd_xfer_handle xfer;
   1112  1.72  augustss 	int len, cc, s;
   1113  1.72  augustss 
   1114  1.72  augustss 	sc->sc_bus.intr_context++;
   1115  1.72  augustss 
   1116  1.72  augustss 	s = splhardusb();
   1117  1.72  augustss 	done = sc->sc_done;
   1118  1.72  augustss 	sc->sc_done = 0;
   1119  1.72  augustss 	splx(s);
   1120   1.1  augustss 
   1121   1.1  augustss 	DPRINTFN(10,("ohci_process_done: done=0x%08lx\n", (u_long)done));
   1122   1.1  augustss 
   1123   1.1  augustss 	/* Reverse the done list. */
   1124  1.69  augustss 	for (sdone = NULL; done != 0; done = LE(std->td.td_nexttd)) {
   1125   1.1  augustss 		std = ohci_hash_find_td(sc, done);
   1126   1.1  augustss 		std->dnext = sdone;
   1127   1.1  augustss 		sdone = std;
   1128   1.1  augustss 	}
   1129   1.1  augustss 
   1130  1.52  augustss #ifdef OHCI_DEBUG
   1131   1.1  augustss 	if (ohcidebug > 10) {
   1132  1.41  augustss 		DPRINTF(("ohci_process_done: TD done:\n"));
   1133   1.1  augustss 		ohci_dump_tds(sdone);
   1134   1.1  augustss 	}
   1135   1.1  augustss #endif
   1136   1.1  augustss 
   1137  1.48  augustss 	for (std = sdone; std; std = stdnext) {
   1138  1.53  augustss 		xfer = std->xfer;
   1139  1.48  augustss 		stdnext = std->dnext;
   1140  1.53  augustss 		DPRINTFN(10, ("ohci_process_done: std=%p xfer=%p hcpriv=%p\n",
   1141  1.69  augustss 				std, xfer, xfer ? xfer->hcpriv : 0));
   1142  1.71  augustss 		if (xfer == NULL) {
   1143  1.71  augustss 			/* xfer == NULL: There seems to be no xfer associated
   1144  1.71  augustss 			 * with this TD. It is tailp that happened to end up on
   1145  1.71  augustss 			 * the done queue.
   1146  1.71  augustss 			 */
   1147  1.71  augustss 			continue;
   1148  1.71  augustss 		}
   1149  1.39  augustss 		cc = OHCI_TD_GET_CC(LE(std->td.td_flags));
   1150  1.53  augustss 		usb_untimeout(ohci_timeout, xfer, xfer->timo_handle);
   1151  1.53  augustss 		if (xfer->status == USBD_CANCELLED ||
   1152  1.53  augustss 		    xfer->status == USBD_TIMEOUT) {
   1153  1.34  augustss 			DPRINTF(("ohci_process_done: cancel/timeout %p\n",
   1154  1.53  augustss 				 xfer));
   1155  1.38  augustss 			/* Handled by abort routine. */
   1156  1.34  augustss 		} else if (cc == OHCI_CC_NO_ERROR) {
   1157  1.34  augustss 			len = std->len;
   1158  1.39  augustss 			if (std->td.td_cbp != 0)
   1159  1.39  augustss 				len -= LE(std->td.td_be) -
   1160  1.39  augustss 				       LE(std->td.td_cbp) + 1;
   1161  1.48  augustss 			if (std->flags & OHCI_ADD_LEN)
   1162  1.53  augustss 				xfer->actlen += len;
   1163  1.34  augustss 			if (std->flags & OHCI_CALL_DONE) {
   1164  1.53  augustss 				xfer->status = USBD_NORMAL_COMPLETION;
   1165  1.53  augustss 				usb_transfer_complete(xfer);
   1166  1.21  augustss 			}
   1167  1.48  augustss 			ohci_free_std(sc, std);
   1168   1.1  augustss 		} else {
   1169  1.48  augustss 			/*
   1170  1.48  augustss 			 * Endpoint is halted.  First unlink all the TDs
   1171  1.48  augustss 			 * belonging to the failed transfer, and then restart
   1172  1.48  augustss 			 * the endpoint.
   1173  1.48  augustss 			 */
   1174   1.1  augustss 			ohci_soft_td_t *p, *n;
   1175   1.1  augustss 			struct ohci_pipe *opipe =
   1176  1.53  augustss 				(struct ohci_pipe *)xfer->pipe;
   1177  1.48  augustss 
   1178  1.71  augustss 			DPRINTFN(15,("ohci_process_done: error cc=%d (%s)\n",
   1179  1.53  augustss 			  OHCI_TD_GET_CC(LE(std->td.td_flags)),
   1180  1.53  augustss 			  ohci_cc_strs[OHCI_TD_GET_CC(LE(std->td.td_flags))]));
   1181  1.48  augustss 
   1182  1.48  augustss 			/* remove TDs */
   1183  1.53  augustss 			for (p = std; p->xfer == xfer; p = n) {
   1184   1.1  augustss 				n = p->nexttd;
   1185   1.1  augustss 				ohci_free_std(sc, p);
   1186   1.1  augustss 			}
   1187  1.48  augustss 
   1188  1.16  augustss 			/* clear halt */
   1189  1.39  augustss 			opipe->sed->ed.ed_headp = LE(p->physaddr);
   1190   1.1  augustss 			OWRITE4(sc, OHCI_COMMAND_STATUS, OHCI_CLF);
   1191  1.48  augustss 
   1192   1.1  augustss 			if (cc == OHCI_CC_STALL)
   1193  1.53  augustss 				xfer->status = USBD_STALLED;
   1194   1.1  augustss 			else
   1195  1.53  augustss 				xfer->status = USBD_IOERROR;
   1196  1.53  augustss 			usb_transfer_complete(xfer);
   1197   1.1  augustss 		}
   1198   1.1  augustss 	}
   1199  1.72  augustss 
   1200  1.72  augustss 	sc->sc_bus.intr_context--;
   1201   1.1  augustss }
   1202   1.1  augustss 
   1203   1.1  augustss void
   1204  1.53  augustss ohci_device_ctrl_done(xfer)
   1205  1.53  augustss 	usbd_xfer_handle xfer;
   1206   1.1  augustss {
   1207  1.53  augustss 	DPRINTFN(10,("ohci_ctrl_done: xfer=%p\n", xfer));
   1208   1.1  augustss 
   1209  1.38  augustss #ifdef DIAGNOSTIC
   1210  1.53  augustss 	if (!(xfer->rqflags & URQ_REQUEST)) {
   1211   1.8  augustss 		panic("ohci_ctrl_done: not a request\n");
   1212   1.1  augustss 	}
   1213  1.38  augustss #endif
   1214  1.55  augustss 	xfer->hcpriv = NULL;
   1215   1.1  augustss }
   1216   1.1  augustss 
   1217   1.1  augustss void
   1218  1.53  augustss ohci_device_intr_done(xfer)
   1219  1.53  augustss 	usbd_xfer_handle xfer;
   1220   1.1  augustss {
   1221  1.53  augustss 	struct ohci_pipe *opipe = (struct ohci_pipe *)xfer->pipe;
   1222  1.38  augustss 	ohci_softc_t *sc = (ohci_softc_t *)opipe->pipe.device->bus;
   1223   1.1  augustss 	ohci_soft_ed_t *sed = opipe->sed;
   1224  1.48  augustss 	ohci_soft_td_t *data, *tail;
   1225   1.1  augustss 
   1226   1.1  augustss 
   1227  1.53  augustss 	DPRINTFN(10,("ohci_intr_done: xfer=%p, actlen=%d\n",
   1228  1.53  augustss 		     xfer, xfer->actlen));
   1229   1.1  augustss 
   1230  1.55  augustss 	xfer->hcpriv = NULL;
   1231  1.38  augustss 
   1232  1.53  augustss 	if (xfer->pipe->repeat) {
   1233  1.60  augustss 		data = opipe->tail.td;
   1234   1.1  augustss 		tail = ohci_alloc_std(sc); /* XXX should reuse TD */
   1235  1.53  augustss 		if (tail == NULL) {
   1236  1.53  augustss 			xfer->status = USBD_NOMEM;
   1237   1.1  augustss 			return;
   1238   1.1  augustss 		}
   1239  1.55  augustss 		tail->xfer = NULL;
   1240   1.1  augustss 
   1241  1.48  augustss 		data->td.td_flags = LE(
   1242  1.16  augustss 			OHCI_TD_IN | OHCI_TD_NOCC |
   1243  1.16  augustss 			OHCI_TD_SET_DI(1) | OHCI_TD_TOGGLE_CARRY);
   1244  1.53  augustss 		if (xfer->flags & USBD_SHORT_XFER_OK)
   1245  1.48  augustss 			data->td.td_flags |= LE(OHCI_TD_R);
   1246  1.53  augustss 		data->td.td_cbp = LE(DMAADDR(&xfer->dmabuf));
   1247  1.48  augustss 		data->nexttd = tail;
   1248  1.48  augustss 		data->td.td_nexttd = LE(tail->physaddr);
   1249  1.53  augustss 		data->td.td_be = LE(LE(data->td.td_cbp) + xfer->length - 1);
   1250  1.53  augustss 		data->len = xfer->length;
   1251  1.53  augustss 		data->xfer = xfer;
   1252  1.48  augustss 		data->flags = OHCI_CALL_DONE | OHCI_ADD_LEN;
   1253  1.53  augustss 		xfer->hcpriv = data;
   1254  1.53  augustss 		xfer->actlen = 0;
   1255   1.1  augustss 
   1256  1.39  augustss 		sed->ed.ed_tailp = LE(tail->physaddr);
   1257  1.60  augustss 		opipe->tail.td = tail;
   1258   1.1  augustss 	}
   1259   1.1  augustss }
   1260   1.1  augustss 
   1261   1.1  augustss void
   1262  1.53  augustss ohci_device_bulk_done(xfer)
   1263  1.53  augustss 	usbd_xfer_handle xfer;
   1264   1.3  augustss {
   1265  1.53  augustss 	DPRINTFN(10,("ohci_bulk_done: xfer=%p, actlen=%d\n",
   1266  1.53  augustss 		     xfer, xfer->actlen));
   1267   1.3  augustss 
   1268  1.53  augustss 	xfer->hcpriv = NULL;
   1269   1.3  augustss }
   1270   1.3  augustss 
   1271   1.3  augustss void
   1272  1.53  augustss ohci_rhsc(sc, xfer)
   1273   1.1  augustss 	ohci_softc_t *sc;
   1274  1.53  augustss 	usbd_xfer_handle xfer;
   1275   1.1  augustss {
   1276   1.1  augustss 	usbd_pipe_handle pipe;
   1277   1.1  augustss 	struct ohci_pipe *opipe;
   1278   1.1  augustss 	u_char *p;
   1279   1.1  augustss 	int i, m;
   1280   1.1  augustss 	int hstatus;
   1281   1.1  augustss 
   1282   1.1  augustss 	hstatus = OREAD4(sc, OHCI_RH_STATUS);
   1283  1.53  augustss 	DPRINTF(("ohci_rhsc: sc=%p xfer=%p hstatus=0x%08x\n",
   1284  1.53  augustss 		 sc, xfer, hstatus));
   1285   1.1  augustss 
   1286  1.53  augustss 	if (xfer == NULL) {
   1287   1.1  augustss 		/* Just ignore the change. */
   1288   1.1  augustss 		return;
   1289   1.1  augustss 	}
   1290   1.1  augustss 
   1291  1.53  augustss 	pipe = xfer->pipe;
   1292   1.1  augustss 	opipe = (struct ohci_pipe *)pipe;
   1293   1.1  augustss 
   1294  1.53  augustss 	p = KERNADDR(&xfer->dmabuf);
   1295  1.53  augustss 	m = min(sc->sc_noport, xfer->length * 8 - 1);
   1296  1.53  augustss 	memset(p, 0, xfer->length);
   1297   1.1  augustss 	for (i = 1; i <= m; i++) {
   1298   1.1  augustss 		if (OREAD4(sc, OHCI_RH_PORT_STATUS(i)) >> 16)
   1299   1.1  augustss 			p[i/8] |= 1 << (i%8);
   1300   1.1  augustss 	}
   1301   1.1  augustss 	DPRINTF(("ohci_rhsc: change=0x%02x\n", *p));
   1302  1.53  augustss 	xfer->actlen = xfer->length;
   1303  1.53  augustss 	xfer->status = USBD_NORMAL_COMPLETION;
   1304   1.1  augustss 
   1305  1.53  augustss 	usb_transfer_complete(xfer);
   1306  1.38  augustss }
   1307  1.38  augustss 
   1308  1.38  augustss void
   1309  1.53  augustss ohci_root_intr_done(xfer)
   1310  1.65  augustss 	usbd_xfer_handle xfer;
   1311  1.65  augustss {
   1312  1.65  augustss 	xfer->hcpriv = NULL;
   1313  1.65  augustss }
   1314  1.65  augustss 
   1315  1.65  augustss void
   1316  1.65  augustss ohci_root_ctrl_done(xfer)
   1317  1.53  augustss 	usbd_xfer_handle xfer;
   1318  1.38  augustss {
   1319  1.53  augustss 	xfer->hcpriv = NULL;
   1320   1.1  augustss }
   1321   1.1  augustss 
   1322   1.1  augustss /*
   1323   1.1  augustss  * Wait here until controller claims to have an interrupt.
   1324   1.1  augustss  * Then call ohci_intr and return.  Use timeout to avoid waiting
   1325   1.1  augustss  * too long.
   1326   1.1  augustss  */
   1327   1.1  augustss void
   1328  1.53  augustss ohci_waitintr(sc, xfer)
   1329   1.1  augustss 	ohci_softc_t *sc;
   1330  1.53  augustss 	usbd_xfer_handle xfer;
   1331   1.1  augustss {
   1332  1.53  augustss 	int timo = xfer->timeout;
   1333   1.1  augustss 	int usecs;
   1334   1.1  augustss 	u_int32_t intrs;
   1335   1.1  augustss 
   1336  1.53  augustss 	xfer->status = USBD_IN_PROGRESS;
   1337   1.1  augustss 	for (usecs = timo * 1000000 / hz; usecs > 0; usecs -= 1000) {
   1338  1.20  augustss 		usb_delay_ms(&sc->sc_bus, 1);
   1339   1.1  augustss 		intrs = OREAD4(sc, OHCI_INTERRUPT_STATUS) & sc->sc_eintrs;
   1340  1.27  augustss 		DPRINTFN(15,("ohci_waitintr: 0x%04x\n", intrs));
   1341  1.52  augustss #ifdef OHCI_DEBUG
   1342   1.1  augustss 		if (ohcidebug > 15)
   1343   1.1  augustss 			ohci_dumpregs(sc);
   1344   1.1  augustss #endif
   1345   1.1  augustss 		if (intrs) {
   1346  1.53  augustss 			ohci_intr1(sc);
   1347  1.53  augustss 			if (xfer->status != USBD_IN_PROGRESS)
   1348   1.1  augustss 				return;
   1349   1.1  augustss 		}
   1350   1.1  augustss 	}
   1351  1.15  augustss 
   1352  1.15  augustss 	/* Timeout */
   1353   1.1  augustss 	DPRINTF(("ohci_waitintr: timeout\n"));
   1354  1.53  augustss 	xfer->status = USBD_TIMEOUT;
   1355  1.53  augustss 	usb_transfer_complete(xfer);
   1356  1.15  augustss 	/* XXX should free TD */
   1357   1.5  augustss }
   1358   1.5  augustss 
   1359   1.5  augustss void
   1360   1.5  augustss ohci_poll(bus)
   1361   1.5  augustss 	struct usbd_bus *bus;
   1362   1.5  augustss {
   1363   1.5  augustss 	ohci_softc_t *sc = (ohci_softc_t *)bus;
   1364   1.5  augustss 
   1365   1.5  augustss 	if (OREAD4(sc, OHCI_INTERRUPT_STATUS) & sc->sc_eintrs)
   1366  1.53  augustss 		ohci_intr1(sc);
   1367   1.1  augustss }
   1368   1.1  augustss 
   1369   1.1  augustss usbd_status
   1370  1.53  augustss ohci_device_request(xfer)
   1371  1.53  augustss 	usbd_xfer_handle xfer;
   1372   1.1  augustss {
   1373  1.53  augustss 	struct ohci_pipe *opipe = (struct ohci_pipe *)xfer->pipe;
   1374  1.53  augustss 	usb_device_request_t *req = &xfer->request;
   1375   1.1  augustss 	usbd_device_handle dev = opipe->pipe.device;
   1376   1.1  augustss 	ohci_softc_t *sc = (ohci_softc_t *)dev->bus;
   1377   1.1  augustss 	int addr = dev->address;
   1378  1.48  augustss 	ohci_soft_td_t *setup, *data = 0, *stat, *next, *tail;
   1379   1.1  augustss 	ohci_soft_ed_t *sed;
   1380   1.1  augustss 	int isread;
   1381   1.1  augustss 	int len;
   1382  1.53  augustss 	usbd_status err;
   1383   1.1  augustss 	int s;
   1384   1.1  augustss 
   1385   1.1  augustss 	isread = req->bmRequestType & UT_READ;
   1386   1.1  augustss 	len = UGETW(req->wLength);
   1387   1.1  augustss 
   1388  1.14  augustss 	DPRINTFN(3,("ohci_device_control type=0x%02x, request=0x%02x, "
   1389  1.14  augustss 		    "wValue=0x%04x, wIndex=0x%04x len=%d, addr=%d, endpt=%d\n",
   1390   1.1  augustss 		    req->bmRequestType, req->bRequest, UGETW(req->wValue),
   1391   1.1  augustss 		    UGETW(req->wIndex), len, addr,
   1392   1.1  augustss 		    opipe->pipe.endpoint->edesc->bEndpointAddress));
   1393   1.1  augustss 
   1394  1.60  augustss 	setup = opipe->tail.td;
   1395   1.1  augustss 	stat = ohci_alloc_std(sc);
   1396  1.53  augustss 	if (stat == NULL) {
   1397  1.53  augustss 		err = USBD_NOMEM;
   1398   1.1  augustss 		goto bad1;
   1399   1.1  augustss 	}
   1400   1.1  augustss 	tail = ohci_alloc_std(sc);
   1401  1.53  augustss 	if (tail == NULL) {
   1402  1.53  augustss 		err = USBD_NOMEM;
   1403   1.1  augustss 		goto bad2;
   1404   1.1  augustss 	}
   1405  1.55  augustss 	tail->xfer = NULL;
   1406   1.1  augustss 
   1407   1.1  augustss 	sed = opipe->sed;
   1408   1.1  augustss 	opipe->u.ctl.length = len;
   1409   1.1  augustss 
   1410  1.10  augustss 	/* Update device address and length since they may have changed. */
   1411  1.10  augustss 	/* XXX This only needs to be done once, but it's too early in open. */
   1412  1.39  augustss 	sed->ed.ed_flags = LE(
   1413  1.39  augustss 	 (LE(sed->ed.ed_flags) & ~(OHCI_ED_ADDRMASK | OHCI_ED_MAXPMASK)) |
   1414  1.16  augustss 	 OHCI_ED_SET_FA(addr) |
   1415  1.16  augustss 	 OHCI_ED_SET_MAXP(UGETW(opipe->pipe.endpoint->edesc->wMaxPacketSize)));
   1416   1.1  augustss 
   1417   1.1  augustss 	/* Set up data transaction */
   1418   1.1  augustss 	if (len != 0) {
   1419  1.48  augustss 		data = ohci_alloc_std(sc);
   1420  1.53  augustss 		if (data == NULL) {
   1421  1.53  augustss 			err = USBD_NOMEM;
   1422   1.1  augustss 			goto bad3;
   1423   1.1  augustss 		}
   1424  1.48  augustss 		data->td.td_flags = LE(
   1425   1.1  augustss 			(isread ? OHCI_TD_IN : OHCI_TD_OUT) | OHCI_TD_NOCC |
   1426  1.19  augustss 			OHCI_TD_TOGGLE_1 | OHCI_TD_NOINTR |
   1427  1.53  augustss 			(xfer->flags & USBD_SHORT_XFER_OK ? OHCI_TD_R : 0));
   1428  1.53  augustss 		data->td.td_cbp = LE(DMAADDR(&xfer->dmabuf));
   1429  1.48  augustss 		data->nexttd = stat;
   1430  1.48  augustss 		data->td.td_nexttd = LE(stat->physaddr);
   1431  1.48  augustss 		data->td.td_be = LE(LE(data->td.td_cbp) + len - 1);
   1432  1.48  augustss 		data->len = len;
   1433  1.53  augustss 		data->xfer = xfer;
   1434  1.48  augustss 		data->flags = OHCI_ADD_LEN;
   1435   1.1  augustss 
   1436  1.48  augustss 		next = data;
   1437  1.34  augustss 		stat->flags = OHCI_CALL_DONE;
   1438  1.34  augustss 	} else {
   1439   1.1  augustss 		next = stat;
   1440  1.48  augustss 		/* XXX ADD_LEN? */
   1441  1.48  augustss 		stat->flags = OHCI_CALL_DONE | OHCI_ADD_LEN;
   1442  1.34  augustss 	}
   1443   1.1  augustss 
   1444   1.1  augustss 	memcpy(KERNADDR(&opipe->u.ctl.reqdma), req, sizeof *req);
   1445   1.1  augustss 
   1446  1.39  augustss 	setup->td.td_flags = LE(OHCI_TD_SETUP | OHCI_TD_NOCC |
   1447  1.58  augustss 				OHCI_TD_TOGGLE_0 | OHCI_TD_NOINTR);
   1448  1.39  augustss 	setup->td.td_cbp = LE(DMAADDR(&opipe->u.ctl.reqdma));
   1449   1.1  augustss 	setup->nexttd = next;
   1450  1.39  augustss 	setup->td.td_nexttd = LE(next->physaddr);
   1451  1.39  augustss 	setup->td.td_be = LE(LE(setup->td.td_cbp) + sizeof *req - 1);
   1452   1.1  augustss 	setup->len = 0;		/* XXX The number of byte we count */
   1453  1.53  augustss 	setup->xfer = xfer;
   1454  1.34  augustss 	setup->flags = 0;
   1455  1.53  augustss 	xfer->hcpriv = setup;
   1456   1.1  augustss 
   1457  1.39  augustss 	stat->td.td_flags = LE(
   1458   1.1  augustss 		(isread ? OHCI_TD_OUT : OHCI_TD_IN) | OHCI_TD_NOCC |
   1459  1.16  augustss 		OHCI_TD_TOGGLE_1 | OHCI_TD_SET_DI(1));
   1460  1.39  augustss 	stat->td.td_cbp = 0;
   1461   1.1  augustss 	stat->nexttd = tail;
   1462  1.39  augustss 	stat->td.td_nexttd = LE(tail->physaddr);
   1463  1.39  augustss 	stat->td.td_be = 0;
   1464   1.1  augustss 	stat->len = 0;
   1465  1.53  augustss 	stat->xfer = xfer;
   1466   1.1  augustss 
   1467  1.52  augustss #ifdef OHCI_DEBUG
   1468   1.1  augustss 	if (ohcidebug > 5) {
   1469  1.41  augustss 		DPRINTF(("ohci_device_request:\n"));
   1470   1.1  augustss 		ohci_dump_ed(sed);
   1471   1.1  augustss 		ohci_dump_tds(setup);
   1472   1.1  augustss 	}
   1473   1.1  augustss #endif
   1474   1.1  augustss 
   1475   1.1  augustss 	/* Insert ED in schedule */
   1476   1.1  augustss 	s = splusb();
   1477  1.39  augustss 	sed->ed.ed_tailp = LE(tail->physaddr);
   1478  1.60  augustss 	opipe->tail.td = tail;
   1479   1.1  augustss 	OWRITE4(sc, OHCI_COMMAND_STATUS, OHCI_CLF);
   1480  1.53  augustss 	if (xfer->timeout && !sc->sc_bus.use_polling) {
   1481  1.53  augustss                 usb_timeout(ohci_timeout, xfer,
   1482  1.53  augustss 			    MS_TO_TICKS(xfer->timeout), xfer->timo_handle);
   1483  1.15  augustss 	}
   1484   1.1  augustss 	splx(s);
   1485   1.1  augustss 
   1486  1.52  augustss #ifdef OHCI_DEBUG
   1487   1.1  augustss 	if (ohcidebug > 5) {
   1488  1.55  augustss 		usb_delay_ms(&sc->sc_bus, 5);
   1489  1.41  augustss 		DPRINTF(("ohci_device_request: status=%x\n",
   1490  1.41  augustss 			 OREAD4(sc, OHCI_COMMAND_STATUS)));
   1491   1.1  augustss 		ohci_dump_ed(sed);
   1492   1.1  augustss 		ohci_dump_tds(setup);
   1493   1.1  augustss 	}
   1494   1.1  augustss #endif
   1495   1.1  augustss 
   1496   1.1  augustss 	return (USBD_NORMAL_COMPLETION);
   1497   1.1  augustss 
   1498   1.1  augustss  bad3:
   1499   1.1  augustss 	ohci_free_std(sc, tail);
   1500   1.1  augustss  bad2:
   1501   1.1  augustss 	ohci_free_std(sc, stat);
   1502   1.1  augustss  bad1:
   1503  1.53  augustss 	return (err);
   1504   1.1  augustss }
   1505   1.1  augustss 
   1506   1.1  augustss /*
   1507   1.1  augustss  * Add an ED to the schedule.  Called at splusb().
   1508   1.1  augustss  */
   1509   1.1  augustss void
   1510   1.3  augustss ohci_add_ed(sed, head)
   1511   1.1  augustss 	ohci_soft_ed_t *sed;
   1512   1.1  augustss 	ohci_soft_ed_t *head;
   1513   1.1  augustss {
   1514  1.46  augustss 	SPLUSBCHECK;
   1515   1.1  augustss 	sed->next = head->next;
   1516  1.39  augustss 	sed->ed.ed_nexted = head->ed.ed_nexted;
   1517   1.1  augustss 	head->next = sed;
   1518  1.39  augustss 	head->ed.ed_nexted = LE(sed->physaddr);
   1519   1.1  augustss }
   1520   1.1  augustss 
   1521   1.1  augustss /*
   1522   1.3  augustss  * Remove an ED from the schedule.  Called at splusb().
   1523   1.3  augustss  */
   1524   1.3  augustss void
   1525   1.3  augustss ohci_rem_ed(sed, head)
   1526   1.3  augustss 	ohci_soft_ed_t *sed;
   1527   1.3  augustss 	ohci_soft_ed_t *head;
   1528   1.3  augustss {
   1529   1.3  augustss 	ohci_soft_ed_t *p;
   1530   1.3  augustss 
   1531  1.46  augustss 	SPLUSBCHECK;
   1532  1.46  augustss 
   1533   1.3  augustss 	/* XXX */
   1534  1.55  augustss 	for (p = head; p == NULL && p->next != sed; p = p->next)
   1535   1.3  augustss 		;
   1536  1.55  augustss 	if (p == NULL)
   1537   1.3  augustss 		panic("ohci_rem_ed: ED not found\n");
   1538   1.3  augustss 	p->next = sed->next;
   1539  1.39  augustss 	p->ed.ed_nexted = sed->ed.ed_nexted;
   1540   1.3  augustss }
   1541   1.3  augustss 
   1542   1.3  augustss /*
   1543   1.1  augustss  * When a transfer is completed the TD is added to the done queue by
   1544   1.1  augustss  * the host controller.  This queue is the processed by software.
   1545   1.1  augustss  * Unfortunately the queue contains the physical address of the TD
   1546   1.9  augustss  * and we have no simple way to translate this back to a kernel address.
   1547   1.1  augustss  * To make the translation possible (and fast) we use a hash table of
   1548   1.1  augustss  * TDs currently in the schedule.  The physical address is used as the
   1549   1.1  augustss  * hash value.
   1550   1.1  augustss  */
   1551   1.1  augustss 
   1552   1.1  augustss #define HASH(a) (((a) >> 4) % OHCI_HASH_SIZE)
   1553   1.1  augustss /* Called at splusb() */
   1554   1.1  augustss void
   1555   1.1  augustss ohci_hash_add_td(sc, std)
   1556   1.1  augustss 	ohci_softc_t *sc;
   1557   1.1  augustss 	ohci_soft_td_t *std;
   1558   1.1  augustss {
   1559   1.1  augustss 	int h = HASH(std->physaddr);
   1560   1.1  augustss 
   1561  1.46  augustss 	SPLUSBCHECK;
   1562  1.46  augustss 
   1563   1.1  augustss 	LIST_INSERT_HEAD(&sc->sc_hash_tds[h], std, hnext);
   1564   1.1  augustss }
   1565   1.1  augustss 
   1566   1.1  augustss /* Called at splusb() */
   1567   1.1  augustss void
   1568   1.1  augustss ohci_hash_rem_td(sc, std)
   1569   1.1  augustss 	ohci_softc_t *sc;
   1570   1.1  augustss 	ohci_soft_td_t *std;
   1571   1.1  augustss {
   1572  1.46  augustss 	SPLUSBCHECK;
   1573  1.46  augustss 
   1574   1.1  augustss 	LIST_REMOVE(std, hnext);
   1575   1.1  augustss }
   1576   1.1  augustss 
   1577   1.1  augustss ohci_soft_td_t *
   1578   1.1  augustss ohci_hash_find_td(sc, a)
   1579   1.1  augustss 	ohci_softc_t *sc;
   1580   1.1  augustss 	ohci_physaddr_t a;
   1581   1.1  augustss {
   1582   1.1  augustss 	int h = HASH(a);
   1583   1.1  augustss 	ohci_soft_td_t *std;
   1584   1.1  augustss 
   1585   1.1  augustss 	for (std = LIST_FIRST(&sc->sc_hash_tds[h]);
   1586  1.53  augustss 	     std != NULL;
   1587   1.1  augustss 	     std = LIST_NEXT(std, hnext))
   1588   1.1  augustss 		if (std->physaddr == a)
   1589   1.1  augustss 			return (std);
   1590   1.1  augustss 	panic("ohci_hash_find_td: addr 0x%08lx not found\n", (u_long)a);
   1591   1.1  augustss }
   1592   1.1  augustss 
   1593   1.1  augustss void
   1594   1.1  augustss ohci_timeout(addr)
   1595   1.1  augustss 	void *addr;
   1596   1.1  augustss {
   1597  1.53  augustss 	usbd_xfer_handle xfer = addr;
   1598  1.48  augustss 	int s;
   1599   1.1  augustss 
   1600  1.53  augustss 	DPRINTF(("ohci_timeout: xfer=%p\n", xfer));
   1601  1.45  augustss 
   1602  1.48  augustss 	s = splusb();
   1603  1.53  augustss 	xfer->device->bus->intr_context++;
   1604  1.54  augustss 	ohci_abort_xfer(xfer, USBD_TIMEOUT);
   1605  1.53  augustss 	xfer->device->bus->intr_context--;
   1606  1.48  augustss 	splx(s);
   1607   1.1  augustss }
   1608   1.1  augustss 
   1609  1.52  augustss #ifdef OHCI_DEBUG
   1610   1.1  augustss void
   1611   1.1  augustss ohci_dump_tds(std)
   1612   1.1  augustss 	ohci_soft_td_t *std;
   1613   1.1  augustss {
   1614   1.1  augustss 	for (; std; std = std->nexttd)
   1615   1.1  augustss 		ohci_dump_td(std);
   1616   1.1  augustss }
   1617   1.1  augustss 
   1618   1.1  augustss void
   1619   1.1  augustss ohci_dump_td(std)
   1620   1.1  augustss 	ohci_soft_td_t *std;
   1621   1.1  augustss {
   1622  1.41  augustss 	DPRINTF(("TD(%p) at %08lx: %b delay=%d ec=%d cc=%d\ncbp=0x%08lx "
   1623  1.41  augustss 		 "nexttd=0x%08lx be=0x%08lx\n",
   1624  1.41  augustss 		 std, (u_long)std->physaddr,
   1625  1.41  augustss 		 (int)LE(std->td.td_flags),
   1626  1.41  augustss 		 "\20\23R\24OUT\25IN\31TOG1\32SETTOGGLE",
   1627  1.41  augustss 		 OHCI_TD_GET_DI(LE(std->td.td_flags)),
   1628  1.41  augustss 		 OHCI_TD_GET_EC(LE(std->td.td_flags)),
   1629  1.41  augustss 		 OHCI_TD_GET_CC(LE(std->td.td_flags)),
   1630  1.41  augustss 		 (u_long)LE(std->td.td_cbp),
   1631  1.41  augustss 		 (u_long)LE(std->td.td_nexttd), (u_long)LE(std->td.td_be)));
   1632   1.1  augustss }
   1633   1.1  augustss 
   1634   1.1  augustss void
   1635   1.1  augustss ohci_dump_ed(sed)
   1636   1.1  augustss 	ohci_soft_ed_t *sed;
   1637   1.1  augustss {
   1638  1.41  augustss 	DPRINTF(("ED(%p) at %08lx: addr=%d endpt=%d maxp=%d %b\ntailp=0x%08lx "
   1639  1.41  augustss 		 "headp=%b nexted=0x%08lx\n",
   1640  1.41  augustss 		 sed, (u_long)sed->physaddr,
   1641  1.41  augustss 		 OHCI_ED_GET_FA(LE(sed->ed.ed_flags)),
   1642  1.41  augustss 		 OHCI_ED_GET_EN(LE(sed->ed.ed_flags)),
   1643  1.41  augustss 		 OHCI_ED_GET_MAXP(LE(sed->ed.ed_flags)),
   1644  1.41  augustss 		 (int)LE(sed->ed.ed_flags),
   1645  1.41  augustss 		 "\20\14OUT\15IN\16LOWSPEED\17SKIP\20ISO",
   1646  1.41  augustss 		 (u_long)LE(sed->ed.ed_tailp),
   1647  1.52  augustss 		 (u_long)LE(sed->ed.ed_headp),
   1648  1.52  augustss 		 "\20\1HALT\2CARRY",
   1649  1.41  augustss 		 (u_long)LE(sed->ed.ed_nexted)));
   1650   1.1  augustss }
   1651   1.1  augustss #endif
   1652   1.1  augustss 
   1653   1.1  augustss usbd_status
   1654   1.1  augustss ohci_open(pipe)
   1655   1.1  augustss 	usbd_pipe_handle pipe;
   1656   1.1  augustss {
   1657   1.1  augustss 	usbd_device_handle dev = pipe->device;
   1658   1.1  augustss 	ohci_softc_t *sc = (ohci_softc_t *)dev->bus;
   1659   1.1  augustss 	usb_endpoint_descriptor_t *ed = pipe->endpoint->edesc;
   1660   1.1  augustss 	struct ohci_pipe *opipe = (struct ohci_pipe *)pipe;
   1661   1.1  augustss 	u_int8_t addr = dev->address;
   1662  1.60  augustss 	u_int8_t xfertype = ed->bmAttributes & UE_XFERTYPE;
   1663   1.1  augustss 	ohci_soft_ed_t *sed;
   1664   1.1  augustss 	ohci_soft_td_t *std;
   1665  1.60  augustss 	ohci_soft_itd_t *sitd;
   1666  1.60  augustss 	ohci_physaddr_t tdphys;
   1667  1.60  augustss 	u_int32_t fmt;
   1668  1.53  augustss 	usbd_status err;
   1669   1.1  augustss 	int s;
   1670  1.64  augustss 	int ival;
   1671   1.1  augustss 
   1672   1.1  augustss 	DPRINTFN(1, ("ohci_open: pipe=%p, addr=%d, endpt=%d (%d)\n",
   1673   1.1  augustss 		     pipe, addr, ed->bEndpointAddress, sc->sc_addr));
   1674   1.1  augustss 	if (addr == sc->sc_addr) {
   1675   1.1  augustss 		switch (ed->bEndpointAddress) {
   1676   1.1  augustss 		case USB_CONTROL_ENDPOINT:
   1677   1.1  augustss 			pipe->methods = &ohci_root_ctrl_methods;
   1678   1.1  augustss 			break;
   1679  1.40  augustss 		case UE_DIR_IN | OHCI_INTR_ENDPT:
   1680   1.1  augustss 			pipe->methods = &ohci_root_intr_methods;
   1681   1.1  augustss 			break;
   1682   1.1  augustss 		default:
   1683   1.1  augustss 			return (USBD_INVAL);
   1684   1.1  augustss 		}
   1685   1.1  augustss 	} else {
   1686   1.1  augustss 		sed = ohci_alloc_sed(sc);
   1687  1.53  augustss 		if (sed == NULL)
   1688   1.1  augustss 			goto bad0;
   1689   1.1  augustss 		opipe->sed = sed;
   1690  1.60  augustss 		if (xfertype == UE_ISOCHRONOUS) {
   1691  1.60  augustss 			sitd = ohci_alloc_sitd(sc);
   1692  1.60  augustss 			if (sitd == NULL) {
   1693  1.60  augustss 				ohci_free_sitd(sc, sitd);
   1694  1.60  augustss 				goto bad1;
   1695  1.60  augustss 			}
   1696  1.60  augustss 			opipe->tail.itd = sitd;
   1697  1.60  augustss 			tdphys = LE(sitd->physaddr);
   1698  1.60  augustss 			fmt = OHCI_ED_FORMAT_ISO;
   1699  1.60  augustss 		} else {
   1700  1.60  augustss 			std = ohci_alloc_std(sc);
   1701  1.60  augustss 			if (std == NULL) {
   1702  1.60  augustss 				ohci_free_std(sc, std);
   1703  1.60  augustss 				goto bad1;
   1704  1.60  augustss 			}
   1705  1.60  augustss 			opipe->tail.td = std;
   1706  1.60  augustss 			tdphys = LE(std->physaddr);
   1707  1.60  augustss 			fmt = OHCI_ED_FORMAT_GEN;
   1708  1.60  augustss 		}
   1709  1.39  augustss 		sed->ed.ed_flags = LE(
   1710   1.1  augustss 			OHCI_ED_SET_FA(addr) |
   1711   1.1  augustss 			OHCI_ED_SET_EN(ed->bEndpointAddress) |
   1712   1.1  augustss 			OHCI_ED_DIR_TD |
   1713  1.60  augustss 			(dev->lowspeed ? OHCI_ED_SPEED : 0) | fmt |
   1714  1.16  augustss 			OHCI_ED_SET_MAXP(UGETW(ed->wMaxPacketSize)));
   1715  1.60  augustss 		sed->ed.ed_headp = sed->ed.ed_tailp = tdphys;
   1716   1.1  augustss 
   1717  1.60  augustss 		switch (xfertype) {
   1718   1.1  augustss 		case UE_CONTROL:
   1719   1.1  augustss 			pipe->methods = &ohci_device_ctrl_methods;
   1720  1.53  augustss 			err = usb_allocmem(&sc->sc_bus,
   1721  1.53  augustss 				  sizeof(usb_device_request_t),
   1722  1.53  augustss 				  0, &opipe->u.ctl.reqdma);
   1723  1.53  augustss 			if (err)
   1724   1.1  augustss 				goto bad;
   1725   1.1  augustss 			s = splusb();
   1726   1.3  augustss 			ohci_add_ed(sed, sc->sc_ctrl_head);
   1727   1.1  augustss 			splx(s);
   1728   1.1  augustss 			break;
   1729   1.1  augustss 		case UE_INTERRUPT:
   1730   1.1  augustss 			pipe->methods = &ohci_device_intr_methods;
   1731  1.64  augustss 			ival = pipe->interval;
   1732  1.64  augustss 			if (ival == USBD_DEFAULT_INTERVAL)
   1733  1.64  augustss 				ival = ed->bInterval;
   1734  1.64  augustss 			return (ohci_device_setintr(sc, opipe, ival));
   1735   1.1  augustss 		case UE_ISOCHRONOUS:
   1736  1.60  augustss 			pipe->methods = &ohci_device_isoc_methods;
   1737  1.60  augustss 			return (ohci_setup_isoc(pipe));
   1738   1.1  augustss 		case UE_BULK:
   1739   1.3  augustss 			pipe->methods = &ohci_device_bulk_methods;
   1740   1.3  augustss 			s = splusb();
   1741   1.3  augustss 			ohci_add_ed(sed, sc->sc_bulk_head);
   1742   1.3  augustss 			splx(s);
   1743   1.3  augustss 			break;
   1744   1.1  augustss 		}
   1745   1.1  augustss 	}
   1746   1.1  augustss 	return (USBD_NORMAL_COMPLETION);
   1747   1.1  augustss 
   1748   1.1  augustss  bad:
   1749   1.1  augustss 	ohci_free_std(sc, std);
   1750   1.1  augustss  bad1:
   1751   1.1  augustss 	ohci_free_sed(sc, sed);
   1752   1.1  augustss  bad0:
   1753   1.1  augustss 	return (USBD_NOMEM);
   1754   1.1  augustss 
   1755   1.1  augustss }
   1756   1.1  augustss 
   1757   1.1  augustss /*
   1758  1.34  augustss  * Close a reqular pipe.
   1759  1.34  augustss  * Assumes that there are no pending transactions.
   1760  1.34  augustss  */
   1761  1.34  augustss void
   1762  1.34  augustss ohci_close_pipe(pipe, head)
   1763  1.34  augustss 	usbd_pipe_handle pipe;
   1764  1.34  augustss 	ohci_soft_ed_t *head;
   1765  1.34  augustss {
   1766  1.34  augustss 	struct ohci_pipe *opipe = (struct ohci_pipe *)pipe;
   1767  1.34  augustss 	ohci_softc_t *sc = (ohci_softc_t *)pipe->device->bus;
   1768  1.34  augustss 	ohci_soft_ed_t *sed = opipe->sed;
   1769  1.34  augustss 	int s;
   1770  1.34  augustss 
   1771  1.34  augustss 	s = splusb();
   1772  1.34  augustss #ifdef DIAGNOSTIC
   1773  1.39  augustss 	sed->ed.ed_flags |= LE(OHCI_ED_SKIP);
   1774  1.70  augustss 	if ((sed->ed.ed_tailp & LE(OHCI_HEADMASK)) !=
   1775  1.70  augustss 	    (sed->ed.ed_headp & LE(OHCI_HEADMASK))) {
   1776  1.39  augustss 		ohci_physaddr_t td = sed->ed.ed_headp;
   1777  1.34  augustss 		ohci_soft_td_t *std;
   1778  1.34  augustss 		for (std = LIST_FIRST(&sc->sc_hash_tds[HASH(td)]);
   1779  1.53  augustss 		     std != NULL;
   1780  1.34  augustss 		     std = LIST_NEXT(std, hnext))
   1781  1.34  augustss 		    if (std->physaddr == td)
   1782  1.34  augustss 			break;
   1783  1.34  augustss 		printf("ohci_close_pipe: pipe not empty sed=%p hd=0x%x "
   1784  1.34  augustss 		       "tl=0x%x pipe=%p, std=%p\n", sed,
   1785  1.39  augustss 		       (int)LE(sed->ed.ed_headp), (int)LE(sed->ed.ed_tailp),
   1786  1.34  augustss 		       pipe, std);
   1787  1.34  augustss 		usb_delay_ms(&sc->sc_bus, 2);
   1788  1.70  augustss 		if ((sed->ed.ed_tailp & LE(OHCI_HEADMASK)) !=
   1789  1.70  augustss 		    (sed->ed.ed_headp & LE(OHCI_HEADMASK)))
   1790  1.34  augustss 			printf("ohci_close_pipe: pipe still not empty\n");
   1791  1.34  augustss 	}
   1792  1.34  augustss #endif
   1793  1.34  augustss 	ohci_rem_ed(sed, head);
   1794  1.34  augustss 	splx(s);
   1795  1.34  augustss 	ohci_free_sed(sc, opipe->sed);
   1796  1.34  augustss }
   1797  1.34  augustss 
   1798  1.34  augustss /*
   1799  1.34  augustss  * Abort a device request.
   1800  1.34  augustss  * If this routine is called at splusb() it guarantees that the request
   1801  1.34  augustss  * will be removed from the hardware scheduling and that the callback
   1802  1.34  augustss  * for it will be called with USBD_CANCELLED status.
   1803  1.34  augustss  * It's impossible to guarantee that the requested transfer will not
   1804  1.34  augustss  * have happened since the hardware runs concurrently.
   1805  1.34  augustss  * If the transaction has already happened we rely on the ordinary
   1806  1.34  augustss  * interrupt processing to process it.
   1807  1.34  augustss  */
   1808  1.34  augustss void
   1809  1.54  augustss ohci_abort_xfer(xfer, status)
   1810  1.53  augustss 	usbd_xfer_handle xfer;
   1811  1.38  augustss 	usbd_status status;
   1812  1.34  augustss {
   1813  1.53  augustss 	struct ohci_pipe *opipe = (struct ohci_pipe *)xfer->pipe;
   1814  1.34  augustss 	ohci_soft_ed_t *sed;
   1815  1.34  augustss 
   1816  1.54  augustss 	DPRINTF(("ohci_abort_xfer: xfer=%p pipe=%p\n", xfer, opipe));
   1817  1.34  augustss 
   1818  1.53  augustss 	xfer->status = status;
   1819  1.34  augustss 
   1820  1.53  augustss 	usb_untimeout(ohci_timeout, xfer, xfer->timo_handle);
   1821  1.34  augustss 
   1822  1.34  augustss 	sed = opipe->sed;
   1823  1.54  augustss 	DPRINTFN(1,("ohci_abort_xfer: stop ed=%p\n", sed));
   1824  1.39  augustss 	sed->ed.ed_flags |= LE(OHCI_ED_SKIP); /* force hardware skip */
   1825  1.34  augustss 
   1826  1.61  augustss #if 1
   1827  1.53  augustss 	if (xfer->device->bus->intr_context) {
   1828  1.44  augustss 		/* We have no process context, so we can't use tsleep(). */
   1829  1.54  augustss 		timeout(ohci_abort_xfer_end, xfer, hz / USB_FRAMES_PER_SECOND);
   1830  1.44  augustss 	} else {
   1831  1.55  augustss #if defined(DIAGNOSTIC) && defined(__i386__) && defined(__FreeBSD__)
   1832  1.55  augustss 		KASSERT(intr_nesting_level == 0,
   1833  1.55  augustss 	        	("ohci_abort_req in interrupt context"));
   1834  1.55  augustss #endif
   1835  1.38  augustss 		usb_delay_ms(opipe->pipe.device->bus, 1);
   1836  1.54  augustss 		ohci_abort_xfer_end(xfer);
   1837  1.38  augustss 	}
   1838  1.61  augustss #else
   1839  1.61  augustss 	delay(1000);
   1840  1.61  augustss 	ohci_abort_xfer_end(xfer);
   1841  1.61  augustss #endif
   1842  1.38  augustss }
   1843  1.38  augustss 
   1844  1.38  augustss void
   1845  1.54  augustss ohci_abort_xfer_end(v)
   1846  1.38  augustss 	void *v;
   1847  1.38  augustss {
   1848  1.53  augustss 	usbd_xfer_handle xfer = v;
   1849  1.53  augustss 	struct ohci_pipe *opipe = (struct ohci_pipe *)xfer->pipe;
   1850  1.38  augustss 	ohci_softc_t *sc = (ohci_softc_t *)opipe->pipe.device->bus;
   1851  1.38  augustss 	ohci_soft_ed_t *sed;
   1852  1.38  augustss 	ohci_soft_td_t *p, *n;
   1853  1.38  augustss 	int s;
   1854  1.38  augustss 
   1855  1.38  augustss 	s = splusb();
   1856  1.38  augustss 
   1857  1.53  augustss 	p = xfer->hcpriv;
   1858  1.34  augustss #ifdef DIAGNOSTIC
   1859  1.55  augustss 	if (p == NULL) {
   1860  1.54  augustss 		printf("ohci_abort_xfer: hcpriv==0\n");
   1861  1.38  augustss 		return;
   1862  1.38  augustss 	}
   1863  1.34  augustss #endif
   1864  1.53  augustss 	for (; p->xfer == xfer; p = n) {
   1865  1.38  augustss 		n = p->nexttd;
   1866  1.38  augustss 		ohci_free_std(sc, p);
   1867  1.34  augustss 	}
   1868  1.34  augustss 
   1869  1.38  augustss 	sed = opipe->sed;
   1870  1.54  augustss 	DPRINTFN(2,("ohci_abort_xfer: set hd=%x, tl=%x\n",
   1871  1.39  augustss 		    (int)LE(p->physaddr), (int)LE(sed->ed.ed_tailp)));
   1872  1.39  augustss 	sed->ed.ed_headp = p->physaddr; /* unlink TDs */
   1873  1.39  augustss 	sed->ed.ed_flags &= LE(~OHCI_ED_SKIP); /* remove hardware skip */
   1874  1.38  augustss 
   1875  1.53  augustss 	usb_transfer_complete(xfer);
   1876  1.38  augustss 
   1877  1.34  augustss 	splx(s);
   1878  1.34  augustss }
   1879  1.34  augustss 
   1880  1.34  augustss /*
   1881   1.1  augustss  * Data structures and routines to emulate the root hub.
   1882   1.1  augustss  */
   1883  1.53  augustss static usb_device_descriptor_t ohci_devd = {
   1884   1.1  augustss 	USB_DEVICE_DESCRIPTOR_SIZE,
   1885   1.1  augustss 	UDESC_DEVICE,		/* type */
   1886   1.1  augustss 	{0x00, 0x01},		/* USB version */
   1887   1.1  augustss 	UCLASS_HUB,		/* class */
   1888   1.1  augustss 	USUBCLASS_HUB,		/* subclass */
   1889   1.1  augustss 	0,			/* protocol */
   1890   1.1  augustss 	64,			/* max packet */
   1891   1.1  augustss 	{0},{0},{0x00,0x01},	/* device id */
   1892   1.1  augustss 	1,2,0,			/* string indicies */
   1893   1.1  augustss 	1			/* # of configurations */
   1894   1.1  augustss };
   1895   1.1  augustss 
   1896  1.53  augustss static usb_config_descriptor_t ohci_confd = {
   1897   1.1  augustss 	USB_CONFIG_DESCRIPTOR_SIZE,
   1898   1.1  augustss 	UDESC_CONFIG,
   1899   1.1  augustss 	{USB_CONFIG_DESCRIPTOR_SIZE +
   1900   1.1  augustss 	 USB_INTERFACE_DESCRIPTOR_SIZE +
   1901   1.1  augustss 	 USB_ENDPOINT_DESCRIPTOR_SIZE},
   1902   1.1  augustss 	1,
   1903   1.1  augustss 	1,
   1904   1.1  augustss 	0,
   1905   1.1  augustss 	UC_SELF_POWERED,
   1906   1.1  augustss 	0			/* max power */
   1907   1.1  augustss };
   1908   1.1  augustss 
   1909  1.53  augustss static usb_interface_descriptor_t ohci_ifcd = {
   1910   1.1  augustss 	USB_INTERFACE_DESCRIPTOR_SIZE,
   1911   1.1  augustss 	UDESC_INTERFACE,
   1912   1.1  augustss 	0,
   1913   1.1  augustss 	0,
   1914   1.1  augustss 	1,
   1915   1.1  augustss 	UCLASS_HUB,
   1916   1.1  augustss 	USUBCLASS_HUB,
   1917   1.1  augustss 	0,
   1918   1.1  augustss 	0
   1919   1.1  augustss };
   1920   1.1  augustss 
   1921  1.53  augustss static usb_endpoint_descriptor_t ohci_endpd = {
   1922   1.1  augustss 	USB_ENDPOINT_DESCRIPTOR_SIZE,
   1923   1.1  augustss 	UDESC_ENDPOINT,
   1924  1.40  augustss 	UE_DIR_IN | OHCI_INTR_ENDPT,
   1925   1.1  augustss 	UE_INTERRUPT,
   1926   1.1  augustss 	{8, 0},			/* max packet */
   1927   1.1  augustss 	255
   1928   1.1  augustss };
   1929   1.1  augustss 
   1930  1.53  augustss static usb_hub_descriptor_t ohci_hubd = {
   1931   1.1  augustss 	USB_HUB_DESCRIPTOR_SIZE,
   1932   1.1  augustss 	UDESC_HUB,
   1933   1.1  augustss 	0,
   1934   1.1  augustss 	{0,0},
   1935   1.1  augustss 	0,
   1936   1.1  augustss 	0,
   1937   1.1  augustss 	{0},
   1938   1.1  augustss };
   1939   1.1  augustss 
   1940  1.55  augustss static int
   1941   1.1  augustss ohci_str(p, l, s)
   1942   1.1  augustss 	usb_string_descriptor_t *p;
   1943   1.1  augustss 	int l;
   1944   1.1  augustss 	char *s;
   1945   1.1  augustss {
   1946   1.1  augustss 	int i;
   1947   1.1  augustss 
   1948   1.1  augustss 	if (l == 0)
   1949   1.1  augustss 		return (0);
   1950   1.1  augustss 	p->bLength = 2 * strlen(s) + 2;
   1951   1.1  augustss 	if (l == 1)
   1952   1.1  augustss 		return (1);
   1953   1.1  augustss 	p->bDescriptorType = UDESC_STRING;
   1954   1.1  augustss 	l -= 2;
   1955   1.1  augustss 	for (i = 0; s[i] && l > 1; i++, l -= 2)
   1956   1.1  augustss 		USETW2(p->bString[i], 0, s[i]);
   1957   1.1  augustss 	return (2*i+2);
   1958   1.1  augustss }
   1959   1.1  augustss 
   1960   1.1  augustss /*
   1961   1.1  augustss  * Simulate a hardware hub by handling all the necessary requests.
   1962   1.1  augustss  */
   1963  1.55  augustss static usbd_status
   1964  1.53  augustss ohci_root_ctrl_transfer(xfer)
   1965  1.53  augustss 	usbd_xfer_handle xfer;
   1966   1.1  augustss {
   1967  1.53  augustss 	usbd_status err;
   1968  1.17  augustss 
   1969  1.46  augustss 	/* Insert last in queue. */
   1970  1.53  augustss 	err = usb_insert_transfer(xfer);
   1971  1.53  augustss 	if (err)
   1972  1.53  augustss 		return (err);
   1973  1.46  augustss 
   1974  1.46  augustss 	/* Pipe isn't running, start first */
   1975  1.53  augustss 	return (ohci_root_ctrl_start(SIMPLEQ_FIRST(&xfer->pipe->queue)));
   1976  1.17  augustss }
   1977  1.17  augustss 
   1978  1.55  augustss static usbd_status
   1979  1.53  augustss ohci_root_ctrl_start(xfer)
   1980  1.53  augustss 	usbd_xfer_handle xfer;
   1981  1.17  augustss {
   1982  1.53  augustss 	ohci_softc_t *sc = (ohci_softc_t *)xfer->pipe->device->bus;
   1983   1.1  augustss 	usb_device_request_t *req;
   1984  1.52  augustss 	void *buf = NULL;
   1985   1.1  augustss 	int port, i;
   1986  1.46  augustss 	int s, len, value, index, l, totlen = 0;
   1987   1.1  augustss 	usb_port_status_t ps;
   1988   1.1  augustss 	usb_hub_descriptor_t hubd;
   1989  1.53  augustss 	usbd_status err;
   1990   1.1  augustss 	u_int32_t v;
   1991   1.1  augustss 
   1992  1.42  augustss #ifdef DIAGNOSTIC
   1993  1.53  augustss 	if (!(xfer->rqflags & URQ_REQUEST))
   1994   1.1  augustss 		/* XXX panic */
   1995   1.1  augustss 		return (USBD_INVAL);
   1996  1.42  augustss #endif
   1997  1.53  augustss 	req = &xfer->request;
   1998   1.1  augustss 
   1999   1.1  augustss 	DPRINTFN(4,("ohci_root_ctrl_control type=0x%02x request=%02x\n",
   2000   1.1  augustss 		    req->bmRequestType, req->bRequest));
   2001   1.1  augustss 
   2002   1.1  augustss 	len = UGETW(req->wLength);
   2003   1.1  augustss 	value = UGETW(req->wValue);
   2004   1.1  augustss 	index = UGETW(req->wIndex);
   2005  1.43  augustss 
   2006  1.43  augustss 	if (len != 0)
   2007  1.53  augustss 		buf = KERNADDR(&xfer->dmabuf);
   2008  1.43  augustss 
   2009   1.1  augustss #define C(x,y) ((x) | ((y) << 8))
   2010   1.1  augustss 	switch(C(req->bRequest, req->bmRequestType)) {
   2011   1.1  augustss 	case C(UR_CLEAR_FEATURE, UT_WRITE_DEVICE):
   2012   1.1  augustss 	case C(UR_CLEAR_FEATURE, UT_WRITE_INTERFACE):
   2013   1.1  augustss 	case C(UR_CLEAR_FEATURE, UT_WRITE_ENDPOINT):
   2014   1.1  augustss 		/*
   2015  1.15  augustss 		 * DEVICE_REMOTE_WAKEUP and ENDPOINT_HALT are no-ops
   2016   1.1  augustss 		 * for the integrated root hub.
   2017   1.1  augustss 		 */
   2018   1.1  augustss 		break;
   2019   1.1  augustss 	case C(UR_GET_CONFIG, UT_READ_DEVICE):
   2020   1.1  augustss 		if (len > 0) {
   2021   1.1  augustss 			*(u_int8_t *)buf = sc->sc_conf;
   2022   1.1  augustss 			totlen = 1;
   2023   1.1  augustss 		}
   2024   1.1  augustss 		break;
   2025   1.1  augustss 	case C(UR_GET_DESCRIPTOR, UT_READ_DEVICE):
   2026   1.1  augustss 		DPRINTFN(8,("ohci_root_ctrl_control wValue=0x%04x\n", value));
   2027   1.1  augustss 		switch(value >> 8) {
   2028   1.1  augustss 		case UDESC_DEVICE:
   2029   1.1  augustss 			if ((value & 0xff) != 0) {
   2030  1.53  augustss 				err = USBD_IOERROR;
   2031   1.1  augustss 				goto ret;
   2032   1.1  augustss 			}
   2033   1.1  augustss 			totlen = l = min(len, USB_DEVICE_DESCRIPTOR_SIZE);
   2034  1.29  augustss 			USETW(ohci_devd.idVendor, sc->sc_id_vendor);
   2035   1.1  augustss 			memcpy(buf, &ohci_devd, l);
   2036   1.1  augustss 			break;
   2037   1.1  augustss 		case UDESC_CONFIG:
   2038   1.1  augustss 			if ((value & 0xff) != 0) {
   2039  1.53  augustss 				err = USBD_IOERROR;
   2040   1.1  augustss 				goto ret;
   2041   1.1  augustss 			}
   2042   1.1  augustss 			totlen = l = min(len, USB_CONFIG_DESCRIPTOR_SIZE);
   2043   1.1  augustss 			memcpy(buf, &ohci_confd, l);
   2044   1.1  augustss 			buf = (char *)buf + l;
   2045   1.1  augustss 			len -= l;
   2046   1.1  augustss 			l = min(len, USB_INTERFACE_DESCRIPTOR_SIZE);
   2047   1.1  augustss 			totlen += l;
   2048   1.1  augustss 			memcpy(buf, &ohci_ifcd, l);
   2049   1.1  augustss 			buf = (char *)buf + l;
   2050   1.1  augustss 			len -= l;
   2051   1.1  augustss 			l = min(len, USB_ENDPOINT_DESCRIPTOR_SIZE);
   2052   1.1  augustss 			totlen += l;
   2053   1.1  augustss 			memcpy(buf, &ohci_endpd, l);
   2054   1.1  augustss 			break;
   2055   1.1  augustss 		case UDESC_STRING:
   2056   1.1  augustss 			if (len == 0)
   2057   1.1  augustss 				break;
   2058   1.1  augustss 			*(u_int8_t *)buf = 0;
   2059   1.1  augustss 			totlen = 1;
   2060   1.1  augustss 			switch (value & 0xff) {
   2061   1.1  augustss 			case 1: /* Vendor */
   2062   1.1  augustss 				totlen = ohci_str(buf, len, sc->sc_vendor);
   2063   1.1  augustss 				break;
   2064   1.1  augustss 			case 2: /* Product */
   2065   1.1  augustss 				totlen = ohci_str(buf, len, "OHCI root hub");
   2066   1.1  augustss 				break;
   2067   1.1  augustss 			}
   2068   1.1  augustss 			break;
   2069   1.1  augustss 		default:
   2070  1.53  augustss 			err = USBD_IOERROR;
   2071   1.1  augustss 			goto ret;
   2072   1.1  augustss 		}
   2073   1.1  augustss 		break;
   2074   1.1  augustss 	case C(UR_GET_INTERFACE, UT_READ_INTERFACE):
   2075   1.1  augustss 		if (len > 0) {
   2076   1.1  augustss 			*(u_int8_t *)buf = 0;
   2077   1.1  augustss 			totlen = 1;
   2078   1.1  augustss 		}
   2079   1.1  augustss 		break;
   2080   1.1  augustss 	case C(UR_GET_STATUS, UT_READ_DEVICE):
   2081   1.1  augustss 		if (len > 1) {
   2082   1.1  augustss 			USETW(((usb_status_t *)buf)->wStatus,UDS_SELF_POWERED);
   2083   1.1  augustss 			totlen = 2;
   2084   1.1  augustss 		}
   2085   1.1  augustss 		break;
   2086   1.1  augustss 	case C(UR_GET_STATUS, UT_READ_INTERFACE):
   2087   1.1  augustss 	case C(UR_GET_STATUS, UT_READ_ENDPOINT):
   2088   1.1  augustss 		if (len > 1) {
   2089   1.1  augustss 			USETW(((usb_status_t *)buf)->wStatus, 0);
   2090   1.1  augustss 			totlen = 2;
   2091   1.1  augustss 		}
   2092   1.1  augustss 		break;
   2093   1.1  augustss 	case C(UR_SET_ADDRESS, UT_WRITE_DEVICE):
   2094   1.1  augustss 		if (value >= USB_MAX_DEVICES) {
   2095  1.53  augustss 			err = USBD_IOERROR;
   2096   1.1  augustss 			goto ret;
   2097   1.1  augustss 		}
   2098   1.1  augustss 		sc->sc_addr = value;
   2099   1.1  augustss 		break;
   2100   1.1  augustss 	case C(UR_SET_CONFIG, UT_WRITE_DEVICE):
   2101   1.1  augustss 		if (value != 0 && value != 1) {
   2102  1.53  augustss 			err = USBD_IOERROR;
   2103   1.1  augustss 			goto ret;
   2104   1.1  augustss 		}
   2105   1.1  augustss 		sc->sc_conf = value;
   2106   1.1  augustss 		break;
   2107   1.1  augustss 	case C(UR_SET_DESCRIPTOR, UT_WRITE_DEVICE):
   2108   1.1  augustss 		break;
   2109   1.1  augustss 	case C(UR_SET_FEATURE, UT_WRITE_DEVICE):
   2110   1.1  augustss 	case C(UR_SET_FEATURE, UT_WRITE_INTERFACE):
   2111   1.1  augustss 	case C(UR_SET_FEATURE, UT_WRITE_ENDPOINT):
   2112  1.53  augustss 		err = USBD_IOERROR;
   2113   1.1  augustss 		goto ret;
   2114   1.1  augustss 	case C(UR_SET_INTERFACE, UT_WRITE_INTERFACE):
   2115   1.1  augustss 		break;
   2116   1.1  augustss 	case C(UR_SYNCH_FRAME, UT_WRITE_ENDPOINT):
   2117   1.1  augustss 		break;
   2118   1.1  augustss 	/* Hub requests */
   2119   1.1  augustss 	case C(UR_CLEAR_FEATURE, UT_WRITE_CLASS_DEVICE):
   2120   1.1  augustss 		break;
   2121   1.1  augustss 	case C(UR_CLEAR_FEATURE, UT_WRITE_CLASS_OTHER):
   2122  1.14  augustss 		DPRINTFN(8, ("ohci_root_ctrl_control: UR_CLEAR_PORT_FEATURE "
   2123  1.14  augustss 			     "port=%d feature=%d\n",
   2124   1.1  augustss 			     index, value));
   2125   1.1  augustss 		if (index < 1 || index > sc->sc_noport) {
   2126  1.53  augustss 			err = USBD_IOERROR;
   2127   1.1  augustss 			goto ret;
   2128   1.1  augustss 		}
   2129   1.1  augustss 		port = OHCI_RH_PORT_STATUS(index);
   2130   1.1  augustss 		switch(value) {
   2131   1.1  augustss 		case UHF_PORT_ENABLE:
   2132   1.1  augustss 			OWRITE4(sc, port, UPS_CURRENT_CONNECT_STATUS);
   2133   1.1  augustss 			break;
   2134   1.1  augustss 		case UHF_PORT_SUSPEND:
   2135   1.1  augustss 			OWRITE4(sc, port, UPS_OVERCURRENT_INDICATOR);
   2136   1.1  augustss 			break;
   2137   1.1  augustss 		case UHF_PORT_POWER:
   2138   1.1  augustss 			OWRITE4(sc, port, UPS_LOW_SPEED);
   2139   1.1  augustss 			break;
   2140   1.1  augustss 		case UHF_C_PORT_CONNECTION:
   2141   1.1  augustss 			OWRITE4(sc, port, UPS_C_CONNECT_STATUS << 16);
   2142   1.1  augustss 			break;
   2143   1.1  augustss 		case UHF_C_PORT_ENABLE:
   2144   1.1  augustss 			OWRITE4(sc, port, UPS_C_PORT_ENABLED << 16);
   2145   1.1  augustss 			break;
   2146   1.1  augustss 		case UHF_C_PORT_SUSPEND:
   2147   1.1  augustss 			OWRITE4(sc, port, UPS_C_SUSPEND << 16);
   2148   1.1  augustss 			break;
   2149   1.1  augustss 		case UHF_C_PORT_OVER_CURRENT:
   2150   1.1  augustss 			OWRITE4(sc, port, UPS_C_OVERCURRENT_INDICATOR << 16);
   2151   1.1  augustss 			break;
   2152   1.1  augustss 		case UHF_C_PORT_RESET:
   2153   1.1  augustss 			OWRITE4(sc, port, UPS_C_PORT_RESET << 16);
   2154   1.1  augustss 			break;
   2155   1.1  augustss 		default:
   2156  1.53  augustss 			err = USBD_IOERROR;
   2157   1.1  augustss 			goto ret;
   2158   1.1  augustss 		}
   2159   1.1  augustss 		switch(value) {
   2160   1.1  augustss 		case UHF_C_PORT_CONNECTION:
   2161   1.1  augustss 		case UHF_C_PORT_ENABLE:
   2162   1.1  augustss 		case UHF_C_PORT_SUSPEND:
   2163   1.1  augustss 		case UHF_C_PORT_OVER_CURRENT:
   2164   1.1  augustss 		case UHF_C_PORT_RESET:
   2165   1.1  augustss 			/* Enable RHSC interrupt if condition is cleared. */
   2166   1.1  augustss 			if ((OREAD4(sc, port) >> 16) == 0)
   2167   1.1  augustss 				ohci_rhsc_able(sc, 1);
   2168   1.1  augustss 			break;
   2169   1.1  augustss 		default:
   2170   1.1  augustss 			break;
   2171   1.1  augustss 		}
   2172   1.1  augustss 		break;
   2173   1.1  augustss 	case C(UR_GET_DESCRIPTOR, UT_READ_CLASS_DEVICE):
   2174   1.1  augustss 		if (value != 0) {
   2175  1.53  augustss 			err = USBD_IOERROR;
   2176   1.1  augustss 			goto ret;
   2177   1.1  augustss 		}
   2178   1.1  augustss 		v = OREAD4(sc, OHCI_RH_DESCRIPTOR_A);
   2179   1.1  augustss 		hubd = ohci_hubd;
   2180   1.1  augustss 		hubd.bNbrPorts = sc->sc_noport;
   2181  1.15  augustss 		USETW(hubd.wHubCharacteristics,
   2182   1.1  augustss 		      (v & OHCI_NPS ? UHD_PWR_NO_SWITCH :
   2183   1.1  augustss 		       v & OHCI_PSM ? UHD_PWR_GANGED : UHD_PWR_INDIVIDUAL)
   2184   1.1  augustss 		      /* XXX overcurrent */
   2185   1.1  augustss 		      );
   2186   1.1  augustss 		hubd.bPwrOn2PwrGood = OHCI_GET_POTPGT(v);
   2187   1.1  augustss 		v = OREAD4(sc, OHCI_RH_DESCRIPTOR_B);
   2188  1.15  augustss 		for (i = 0, l = sc->sc_noport; l > 0; i++, l -= 8, v >>= 8)
   2189  1.15  augustss 			hubd.DeviceRemovable[i++] = (u_int8_t)v;
   2190  1.15  augustss 		hubd.bDescLength = USB_HUB_DESCRIPTOR_SIZE + i;
   2191   1.1  augustss 		l = min(len, hubd.bDescLength);
   2192   1.1  augustss 		totlen = l;
   2193   1.1  augustss 		memcpy(buf, &hubd, l);
   2194   1.1  augustss 		break;
   2195   1.1  augustss 	case C(UR_GET_STATUS, UT_READ_CLASS_DEVICE):
   2196   1.1  augustss 		if (len != 4) {
   2197  1.53  augustss 			err = USBD_IOERROR;
   2198   1.1  augustss 			goto ret;
   2199   1.1  augustss 		}
   2200   1.1  augustss 		memset(buf, 0, len); /* ? XXX */
   2201   1.1  augustss 		totlen = len;
   2202   1.1  augustss 		break;
   2203   1.1  augustss 	case C(UR_GET_STATUS, UT_READ_CLASS_OTHER):
   2204   1.1  augustss 		DPRINTFN(8,("ohci_root_ctrl_transfer: get port status i=%d\n",
   2205   1.1  augustss 			    index));
   2206   1.1  augustss 		if (index < 1 || index > sc->sc_noport) {
   2207  1.53  augustss 			err = USBD_IOERROR;
   2208   1.1  augustss 			goto ret;
   2209   1.1  augustss 		}
   2210   1.1  augustss 		if (len != 4) {
   2211  1.53  augustss 			err = USBD_IOERROR;
   2212   1.1  augustss 			goto ret;
   2213   1.1  augustss 		}
   2214   1.1  augustss 		v = OREAD4(sc, OHCI_RH_PORT_STATUS(index));
   2215   1.1  augustss 		DPRINTFN(8,("ohci_root_ctrl_transfer: port status=0x%04x\n",
   2216   1.1  augustss 			    v));
   2217   1.1  augustss 		USETW(ps.wPortStatus, v);
   2218   1.1  augustss 		USETW(ps.wPortChange, v >> 16);
   2219   1.1  augustss 		l = min(len, sizeof ps);
   2220   1.1  augustss 		memcpy(buf, &ps, l);
   2221   1.1  augustss 		totlen = l;
   2222   1.1  augustss 		break;
   2223   1.1  augustss 	case C(UR_SET_DESCRIPTOR, UT_WRITE_CLASS_DEVICE):
   2224  1.53  augustss 		err = USBD_IOERROR;
   2225   1.1  augustss 		goto ret;
   2226   1.1  augustss 	case C(UR_SET_FEATURE, UT_WRITE_CLASS_DEVICE):
   2227   1.1  augustss 		break;
   2228   1.1  augustss 	case C(UR_SET_FEATURE, UT_WRITE_CLASS_OTHER):
   2229   1.1  augustss 		if (index < 1 || index > sc->sc_noport) {
   2230  1.53  augustss 			err = USBD_IOERROR;
   2231   1.1  augustss 			goto ret;
   2232   1.1  augustss 		}
   2233   1.1  augustss 		port = OHCI_RH_PORT_STATUS(index);
   2234   1.1  augustss 		switch(value) {
   2235   1.1  augustss 		case UHF_PORT_ENABLE:
   2236   1.1  augustss 			OWRITE4(sc, port, UPS_PORT_ENABLED);
   2237   1.1  augustss 			break;
   2238   1.1  augustss 		case UHF_PORT_SUSPEND:
   2239   1.1  augustss 			OWRITE4(sc, port, UPS_SUSPEND);
   2240   1.1  augustss 			break;
   2241   1.1  augustss 		case UHF_PORT_RESET:
   2242  1.14  augustss 			DPRINTFN(5,("ohci_root_ctrl_transfer: reset port %d\n",
   2243  1.14  augustss 				    index));
   2244   1.1  augustss 			OWRITE4(sc, port, UPS_RESET);
   2245   1.1  augustss 			for (i = 0; i < 10; i++) {
   2246  1.20  augustss 				usb_delay_ms(&sc->sc_bus, 10);
   2247   1.1  augustss 				if ((OREAD4(sc, port) & UPS_RESET) == 0)
   2248   1.1  augustss 					break;
   2249   1.1  augustss 			}
   2250   1.1  augustss 			DPRINTFN(8,("ohci port %d reset, status = 0x%04x\n",
   2251   1.1  augustss 				    index, OREAD4(sc, port)));
   2252   1.1  augustss 			break;
   2253   1.1  augustss 		case UHF_PORT_POWER:
   2254  1.14  augustss 			DPRINTFN(2,("ohci_root_ctrl_transfer: set port power "
   2255  1.14  augustss 				    "%d\n", index));
   2256   1.1  augustss 			OWRITE4(sc, port, UPS_PORT_POWER);
   2257   1.1  augustss 			break;
   2258   1.1  augustss 		default:
   2259  1.53  augustss 			err = USBD_IOERROR;
   2260   1.1  augustss 			goto ret;
   2261   1.1  augustss 		}
   2262   1.1  augustss 		break;
   2263   1.1  augustss 	default:
   2264  1.53  augustss 		err = USBD_IOERROR;
   2265   1.1  augustss 		goto ret;
   2266   1.1  augustss 	}
   2267  1.53  augustss 	xfer->actlen = totlen;
   2268  1.53  augustss 	err = USBD_NORMAL_COMPLETION;
   2269   1.1  augustss  ret:
   2270  1.53  augustss 	xfer->status = err;
   2271  1.46  augustss 	s = splusb();
   2272  1.53  augustss 	usb_transfer_complete(xfer);
   2273  1.46  augustss 	splx(s);
   2274   1.1  augustss 	return (USBD_IN_PROGRESS);
   2275   1.1  augustss }
   2276   1.1  augustss 
   2277   1.1  augustss /* Abort a root control request. */
   2278  1.55  augustss static void
   2279  1.53  augustss ohci_root_ctrl_abort(xfer)
   2280  1.53  augustss 	usbd_xfer_handle xfer;
   2281   1.1  augustss {
   2282   1.9  augustss 	/* Nothing to do, all transfers are synchronous. */
   2283   1.1  augustss }
   2284   1.1  augustss 
   2285   1.1  augustss /* Close the root pipe. */
   2286  1.55  augustss static void
   2287   1.1  augustss ohci_root_ctrl_close(pipe)
   2288   1.1  augustss 	usbd_pipe_handle pipe;
   2289   1.1  augustss {
   2290   1.1  augustss 	DPRINTF(("ohci_root_ctrl_close\n"));
   2291  1.34  augustss 	/* Nothing to do. */
   2292   1.1  augustss }
   2293   1.1  augustss 
   2294  1.55  augustss static usbd_status
   2295  1.53  augustss ohci_root_intr_transfer(xfer)
   2296  1.53  augustss 	usbd_xfer_handle xfer;
   2297   1.1  augustss {
   2298  1.53  augustss 	usbd_status err;
   2299  1.17  augustss 
   2300  1.46  augustss 	/* Insert last in queue. */
   2301  1.53  augustss 	err = usb_insert_transfer(xfer);
   2302  1.53  augustss 	if (err)
   2303  1.53  augustss 		return (err);
   2304  1.46  augustss 
   2305  1.46  augustss 	/* Pipe isn't running, start first */
   2306  1.53  augustss 	return (ohci_root_intr_start(SIMPLEQ_FIRST(&xfer->pipe->queue)));
   2307  1.17  augustss }
   2308  1.17  augustss 
   2309  1.55  augustss static usbd_status
   2310  1.53  augustss ohci_root_intr_start(xfer)
   2311  1.53  augustss 	usbd_xfer_handle xfer;
   2312  1.17  augustss {
   2313  1.53  augustss 	usbd_pipe_handle pipe = xfer->pipe;
   2314   1.1  augustss 	ohci_softc_t *sc = (ohci_softc_t *)pipe->device->bus;
   2315   1.1  augustss 
   2316  1.53  augustss 	sc->sc_intrxfer = xfer;
   2317   1.1  augustss 
   2318   1.1  augustss 	return (USBD_IN_PROGRESS);
   2319   1.1  augustss }
   2320   1.1  augustss 
   2321   1.3  augustss /* Abort a root interrupt request. */
   2322  1.55  augustss static void
   2323  1.53  augustss ohci_root_intr_abort(xfer)
   2324  1.53  augustss 	usbd_xfer_handle xfer;
   2325   1.1  augustss {
   2326  1.53  augustss 	int s;
   2327  1.53  augustss 
   2328  1.53  augustss 	if (xfer->pipe->intrxfer == xfer) {
   2329  1.51  augustss 		DPRINTF(("ohci_root_intr_abort: remove\n"));
   2330  1.53  augustss 		xfer->pipe->intrxfer = NULL;
   2331  1.51  augustss 	}
   2332  1.53  augustss 	xfer->status = USBD_CANCELLED;
   2333  1.53  augustss 	s = splusb();
   2334  1.53  augustss 	usb_transfer_complete(xfer);
   2335  1.53  augustss 	splx(s);
   2336   1.1  augustss }
   2337   1.1  augustss 
   2338   1.1  augustss /* Close the root pipe. */
   2339  1.55  augustss static void
   2340   1.1  augustss ohci_root_intr_close(pipe)
   2341   1.1  augustss 	usbd_pipe_handle pipe;
   2342   1.1  augustss {
   2343   1.1  augustss 	ohci_softc_t *sc = (ohci_softc_t *)pipe->device->bus;
   2344   1.1  augustss 
   2345   1.1  augustss 	DPRINTF(("ohci_root_intr_close\n"));
   2346  1.34  augustss 
   2347  1.53  augustss 	sc->sc_intrxfer = NULL;
   2348   1.1  augustss }
   2349   1.1  augustss 
   2350   1.1  augustss /************************/
   2351   1.1  augustss 
   2352  1.55  augustss static usbd_status
   2353  1.53  augustss ohci_device_ctrl_transfer(xfer)
   2354  1.53  augustss 	usbd_xfer_handle xfer;
   2355   1.1  augustss {
   2356  1.53  augustss 	usbd_status err;
   2357  1.17  augustss 
   2358  1.46  augustss 	/* Insert last in queue. */
   2359  1.53  augustss 	err = usb_insert_transfer(xfer);
   2360  1.53  augustss 	if (err)
   2361  1.53  augustss 		return (err);
   2362  1.46  augustss 
   2363  1.46  augustss 	/* Pipe isn't running, start first */
   2364  1.53  augustss 	return (ohci_device_ctrl_start(SIMPLEQ_FIRST(&xfer->pipe->queue)));
   2365  1.17  augustss }
   2366  1.17  augustss 
   2367  1.55  augustss static usbd_status
   2368  1.53  augustss ohci_device_ctrl_start(xfer)
   2369  1.53  augustss 	usbd_xfer_handle xfer;
   2370  1.17  augustss {
   2371  1.53  augustss 	ohci_softc_t *sc = (ohci_softc_t *)xfer->pipe->device->bus;
   2372  1.53  augustss 	usbd_status err;
   2373   1.1  augustss 
   2374  1.42  augustss #ifdef DIAGNOSTIC
   2375  1.53  augustss 	if (!(xfer->rqflags & URQ_REQUEST)) {
   2376   1.1  augustss 		/* XXX panic */
   2377   1.1  augustss 		printf("ohci_device_ctrl_transfer: not a request\n");
   2378   1.1  augustss 		return (USBD_INVAL);
   2379   1.1  augustss 	}
   2380  1.42  augustss #endif
   2381   1.1  augustss 
   2382  1.53  augustss 	err = ohci_device_request(xfer);
   2383  1.53  augustss 	if (err)
   2384  1.53  augustss 		return (err);
   2385   1.1  augustss 
   2386   1.6  augustss 	if (sc->sc_bus.use_polling)
   2387  1.53  augustss 		ohci_waitintr(sc, xfer);
   2388   1.1  augustss 	return (USBD_IN_PROGRESS);
   2389   1.1  augustss }
   2390   1.1  augustss 
   2391   1.1  augustss /* Abort a device control request. */
   2392  1.55  augustss static void
   2393  1.53  augustss ohci_device_ctrl_abort(xfer)
   2394  1.53  augustss 	usbd_xfer_handle xfer;
   2395   1.1  augustss {
   2396  1.53  augustss 	DPRINTF(("ohci_device_ctrl_abort: xfer=%p\n", xfer));
   2397  1.54  augustss 	ohci_abort_xfer(xfer, USBD_CANCELLED);
   2398   1.1  augustss }
   2399   1.1  augustss 
   2400   1.1  augustss /* Close a device control pipe. */
   2401  1.55  augustss static void
   2402   1.1  augustss ohci_device_ctrl_close(pipe)
   2403   1.1  augustss 	usbd_pipe_handle pipe;
   2404   1.1  augustss {
   2405  1.60  augustss 	struct ohci_pipe *opipe = (struct ohci_pipe *)pipe;
   2406   1.1  augustss 	ohci_softc_t *sc = (ohci_softc_t *)pipe->device->bus;
   2407   1.1  augustss 
   2408  1.34  augustss 	DPRINTF(("ohci_device_ctrl_close: pipe=%p\n", pipe));
   2409  1.34  augustss 	ohci_close_pipe(pipe, sc->sc_ctrl_head);
   2410  1.60  augustss 	ohci_free_std(sc, opipe->tail.td);
   2411   1.3  augustss }
   2412   1.3  augustss 
   2413   1.3  augustss /************************/
   2414  1.37  augustss 
   2415  1.55  augustss static void
   2416  1.37  augustss ohci_device_clear_toggle(pipe)
   2417  1.37  augustss 	usbd_pipe_handle pipe;
   2418  1.37  augustss {
   2419  1.37  augustss 	struct ohci_pipe *opipe = (struct ohci_pipe *)pipe;
   2420  1.37  augustss 
   2421  1.66  augustss 	opipe->sed->ed.ed_headp &= LE(~OHCI_TOGGLECARRY);
   2422  1.37  augustss }
   2423  1.37  augustss 
   2424  1.55  augustss static void
   2425  1.37  augustss ohci_noop(pipe)
   2426  1.37  augustss 	usbd_pipe_handle pipe;
   2427  1.37  augustss {
   2428  1.37  augustss }
   2429   1.3  augustss 
   2430  1.55  augustss static usbd_status
   2431  1.53  augustss ohci_device_bulk_transfer(xfer)
   2432  1.53  augustss 	usbd_xfer_handle xfer;
   2433   1.3  augustss {
   2434  1.53  augustss 	usbd_status err;
   2435  1.17  augustss 
   2436  1.46  augustss 	/* Insert last in queue. */
   2437  1.53  augustss 	err = usb_insert_transfer(xfer);
   2438  1.53  augustss 	if (err)
   2439  1.53  augustss 		return (err);
   2440  1.46  augustss 
   2441  1.46  augustss 	/* Pipe isn't running, start first */
   2442  1.53  augustss 	return (ohci_device_bulk_start(SIMPLEQ_FIRST(&xfer->pipe->queue)));
   2443  1.17  augustss }
   2444  1.17  augustss 
   2445  1.55  augustss static usbd_status
   2446  1.53  augustss ohci_device_bulk_start(xfer)
   2447  1.53  augustss 	usbd_xfer_handle xfer;
   2448  1.17  augustss {
   2449  1.53  augustss 	struct ohci_pipe *opipe = (struct ohci_pipe *)xfer->pipe;
   2450   1.3  augustss 	usbd_device_handle dev = opipe->pipe.device;
   2451   1.3  augustss 	ohci_softc_t *sc = (ohci_softc_t *)dev->bus;
   2452   1.3  augustss 	int addr = dev->address;
   2453  1.48  augustss 	ohci_soft_td_t *data, *tail, *tdp;
   2454   1.3  augustss 	ohci_soft_ed_t *sed;
   2455  1.40  augustss 	int s, len, isread, endpt;
   2456  1.53  augustss 	usbd_status err;
   2457   1.3  augustss 
   2458  1.34  augustss #ifdef DIAGNOSTIC
   2459  1.53  augustss 	if (xfer->rqflags & URQ_REQUEST) {
   2460   1.3  augustss 		/* XXX panic */
   2461  1.34  augustss 		printf("ohci_device_bulk_start: a request\n");
   2462   1.3  augustss 		return (USBD_INVAL);
   2463   1.3  augustss 	}
   2464  1.34  augustss #endif
   2465   1.3  augustss 
   2466  1.53  augustss 	len = xfer->length;
   2467  1.53  augustss 	endpt = xfer->pipe->endpoint->edesc->bEndpointAddress;
   2468  1.40  augustss 	isread = UE_GET_DIR(endpt) == UE_DIR_IN;
   2469   1.3  augustss 	sed = opipe->sed;
   2470   1.3  augustss 
   2471  1.53  augustss 	DPRINTFN(4,("ohci_device_bulk_start: xfer=%p len=%d isread=%d "
   2472  1.53  augustss 		    "flags=%d endpt=%d\n", xfer, len, isread, xfer->flags,
   2473  1.40  augustss 		    endpt));
   2474  1.34  augustss 
   2475  1.32  augustss 	opipe->u.bulk.isread = isread;
   2476   1.3  augustss 	opipe->u.bulk.length = len;
   2477   1.3  augustss 
   2478   1.3  augustss 	/* Update device address */
   2479  1.39  augustss 	sed->ed.ed_flags = LE(
   2480  1.39  augustss 		(LE(sed->ed.ed_flags) & ~OHCI_ED_ADDRMASK) |
   2481  1.16  augustss 		OHCI_ED_SET_FA(addr));
   2482   1.3  augustss 
   2483  1.48  augustss 	/* Allocate a chain of new TDs (including a new tail). */
   2484  1.60  augustss 	data = opipe->tail.td;
   2485  1.61  augustss 	err = ohci_alloc_std_chain(opipe, sc, len, isread, xfer->flags,
   2486  1.53  augustss 		  &xfer->dmabuf, data, &tail);
   2487  1.53  augustss 	if (err)
   2488  1.53  augustss 		return (err);
   2489  1.48  augustss 
   2490  1.53  augustss 	tail->xfer = NULL;
   2491  1.53  augustss 	xfer->hcpriv = data;
   2492   1.3  augustss 
   2493  1.34  augustss 	DPRINTFN(4,("ohci_device_bulk_start: ed_flags=0x%08x td_flags=0x%08x "
   2494  1.34  augustss 		    "td_cbp=0x%08x td_be=0x%08x\n",
   2495  1.48  augustss 		    (int)LE(sed->ed.ed_flags), (int)LE(data->td.td_flags),
   2496  1.48  augustss 		    (int)LE(data->td.td_cbp), (int)LE(data->td.td_be)));
   2497  1.34  augustss 
   2498  1.52  augustss #ifdef OHCI_DEBUG
   2499  1.34  augustss 	if (ohcidebug > 4) {
   2500  1.34  augustss 		ohci_dump_ed(sed);
   2501  1.48  augustss 		ohci_dump_tds(data);
   2502  1.34  augustss 	}
   2503  1.34  augustss #endif
   2504  1.34  augustss 
   2505   1.3  augustss 	/* Insert ED in schedule */
   2506   1.3  augustss 	s = splusb();
   2507  1.48  augustss 	for (tdp = data; tdp != tail; tdp = tdp->nexttd) {
   2508  1.53  augustss 		tdp->xfer = xfer;
   2509  1.48  augustss 	}
   2510  1.39  augustss 	sed->ed.ed_tailp = LE(tail->physaddr);
   2511  1.60  augustss 	opipe->tail.td = tail;
   2512  1.39  augustss 	sed->ed.ed_flags &= LE(~OHCI_ED_SKIP);
   2513   1.3  augustss 	OWRITE4(sc, OHCI_COMMAND_STATUS, OHCI_BLF);
   2514  1.53  augustss 	if (xfer->timeout && !sc->sc_bus.use_polling) {
   2515  1.53  augustss                 usb_timeout(ohci_timeout, xfer,
   2516  1.53  augustss 			    MS_TO_TICKS(xfer->timeout), xfer->timo_handle);
   2517  1.15  augustss 	}
   2518  1.34  augustss 
   2519  1.52  augustss #if 0
   2520  1.52  augustss /* This goes wrong if we are too slow. */
   2521  1.34  augustss 	if (ohcidebug > 5) {
   2522  1.55  augustss 		usb_delay_ms(&sc->sc_bus, 5);
   2523  1.41  augustss 		DPRINTF(("ohci_device_intr_transfer: status=%x\n",
   2524  1.41  augustss 			 OREAD4(sc, OHCI_COMMAND_STATUS)));
   2525  1.34  augustss 		ohci_dump_ed(sed);
   2526  1.48  augustss 		ohci_dump_tds(data);
   2527  1.34  augustss 	}
   2528  1.34  augustss #endif
   2529  1.34  augustss 
   2530   1.3  augustss 	splx(s);
   2531   1.3  augustss 
   2532   1.3  augustss 	return (USBD_IN_PROGRESS);
   2533   1.3  augustss }
   2534   1.3  augustss 
   2535  1.55  augustss static void
   2536  1.53  augustss ohci_device_bulk_abort(xfer)
   2537  1.53  augustss 	usbd_xfer_handle xfer;
   2538   1.3  augustss {
   2539  1.53  augustss 	DPRINTF(("ohci_device_bulk_abort: xfer=%p\n", xfer));
   2540  1.54  augustss 	ohci_abort_xfer(xfer, USBD_CANCELLED);
   2541   1.3  augustss }
   2542   1.3  augustss 
   2543  1.34  augustss /*
   2544  1.34  augustss  * Close a device bulk pipe.
   2545  1.34  augustss  */
   2546  1.55  augustss static void
   2547   1.3  augustss ohci_device_bulk_close(pipe)
   2548   1.3  augustss 	usbd_pipe_handle pipe;
   2549   1.3  augustss {
   2550  1.60  augustss 	struct ohci_pipe *opipe = (struct ohci_pipe *)pipe;
   2551  1.34  augustss 	ohci_softc_t *sc = (ohci_softc_t *)pipe->device->bus;
   2552   1.3  augustss 
   2553  1.34  augustss 	DPRINTF(("ohci_device_bulk_close: pipe=%p\n", pipe));
   2554  1.34  augustss 	ohci_close_pipe(pipe, sc->sc_bulk_head);
   2555  1.60  augustss 	ohci_free_std(sc, opipe->tail.td);
   2556   1.1  augustss }
   2557   1.1  augustss 
   2558   1.1  augustss /************************/
   2559   1.1  augustss 
   2560  1.55  augustss static usbd_status
   2561  1.53  augustss ohci_device_intr_transfer(xfer)
   2562  1.53  augustss 	usbd_xfer_handle xfer;
   2563  1.17  augustss {
   2564  1.53  augustss 	usbd_status err;
   2565  1.17  augustss 
   2566  1.46  augustss 	/* Insert last in queue. */
   2567  1.53  augustss 	err = usb_insert_transfer(xfer);
   2568  1.53  augustss 	if (err)
   2569  1.53  augustss 		return (err);
   2570  1.46  augustss 
   2571  1.46  augustss 	/* Pipe isn't running, start first */
   2572  1.53  augustss 	return (ohci_device_intr_start(SIMPLEQ_FIRST(&xfer->pipe->queue)));
   2573  1.17  augustss }
   2574  1.17  augustss 
   2575  1.55  augustss static usbd_status
   2576  1.53  augustss ohci_device_intr_start(xfer)
   2577  1.53  augustss 	usbd_xfer_handle xfer;
   2578   1.1  augustss {
   2579  1.53  augustss 	struct ohci_pipe *opipe = (struct ohci_pipe *)xfer->pipe;
   2580   1.1  augustss 	usbd_device_handle dev = opipe->pipe.device;
   2581   1.1  augustss 	ohci_softc_t *sc = (ohci_softc_t *)dev->bus;
   2582   1.1  augustss 	ohci_soft_ed_t *sed = opipe->sed;
   2583  1.48  augustss 	ohci_soft_td_t *data, *tail;
   2584   1.1  augustss 	int len;
   2585   1.1  augustss 	int s;
   2586   1.1  augustss 
   2587  1.53  augustss 	DPRINTFN(3, ("ohci_device_intr_transfer: xfer=%p len=%d "
   2588  1.14  augustss 		     "flags=%d priv=%p\n",
   2589  1.53  augustss 		     xfer, xfer->length, xfer->flags, xfer->priv));
   2590   1.1  augustss 
   2591  1.42  augustss #ifdef DIAGNOSTIC
   2592  1.53  augustss 	if (xfer->rqflags & URQ_REQUEST)
   2593   1.1  augustss 		panic("ohci_device_intr_transfer: a request\n");
   2594  1.42  augustss #endif
   2595   1.1  augustss 
   2596  1.53  augustss 	len = xfer->length;
   2597   1.1  augustss 
   2598  1.60  augustss 	data = opipe->tail.td;
   2599   1.1  augustss 	tail = ohci_alloc_std(sc);
   2600  1.55  augustss 	if (tail == NULL)
   2601  1.43  augustss 		return (USBD_NOMEM);
   2602  1.53  augustss 	tail->xfer = NULL;
   2603   1.1  augustss 
   2604  1.48  augustss 	data->td.td_flags = LE(
   2605  1.16  augustss 		OHCI_TD_IN | OHCI_TD_NOCC |
   2606  1.16  augustss 		OHCI_TD_SET_DI(1) | OHCI_TD_TOGGLE_CARRY);
   2607  1.53  augustss 	if (xfer->flags & USBD_SHORT_XFER_OK)
   2608  1.48  augustss 		data->td.td_flags |= LE(OHCI_TD_R);
   2609  1.53  augustss 	data->td.td_cbp = LE(DMAADDR(&xfer->dmabuf));
   2610  1.48  augustss 	data->nexttd = tail;
   2611  1.48  augustss 	data->td.td_nexttd = LE(tail->physaddr);
   2612  1.48  augustss 	data->td.td_be = LE(LE(data->td.td_cbp) + len - 1);
   2613  1.48  augustss 	data->len = len;
   2614  1.53  augustss 	data->xfer = xfer;
   2615  1.48  augustss 	data->flags = OHCI_CALL_DONE | OHCI_ADD_LEN;
   2616  1.53  augustss 	xfer->hcpriv = data;
   2617   1.1  augustss 
   2618  1.52  augustss #ifdef OHCI_DEBUG
   2619   1.1  augustss 	if (ohcidebug > 5) {
   2620  1.41  augustss 		DPRINTF(("ohci_device_intr_transfer:\n"));
   2621   1.1  augustss 		ohci_dump_ed(sed);
   2622  1.48  augustss 		ohci_dump_tds(data);
   2623   1.1  augustss 	}
   2624   1.1  augustss #endif
   2625   1.1  augustss 
   2626   1.1  augustss 	/* Insert ED in schedule */
   2627   1.1  augustss 	s = splusb();
   2628  1.39  augustss 	sed->ed.ed_tailp = LE(tail->physaddr);
   2629  1.60  augustss 	opipe->tail.td = tail;
   2630  1.39  augustss 	sed->ed.ed_flags &= LE(~OHCI_ED_SKIP);
   2631   1.1  augustss 
   2632  1.52  augustss #if 0
   2633  1.52  augustss /*
   2634  1.52  augustss  * This goes horribly wrong, printing thousands of descriptors,
   2635  1.52  augustss  * because false references are followed due to the fact that the
   2636  1.52  augustss  * TD is gone.
   2637  1.52  augustss  */
   2638   1.1  augustss 	if (ohcidebug > 5) {
   2639  1.55  augustss 		usb_delay_ms(&sc->sc_bus, 5);
   2640  1.41  augustss 		DPRINTF(("ohci_device_intr_transfer: status=%x\n",
   2641  1.41  augustss 			 OREAD4(sc, OHCI_COMMAND_STATUS)));
   2642   1.1  augustss 		ohci_dump_ed(sed);
   2643  1.48  augustss 		ohci_dump_tds(data);
   2644   1.1  augustss 	}
   2645   1.1  augustss #endif
   2646  1.26  augustss 	splx(s);
   2647   1.1  augustss 
   2648   1.1  augustss 	return (USBD_IN_PROGRESS);
   2649   1.1  augustss }
   2650   1.1  augustss 
   2651   1.1  augustss /* Abort a device control request. */
   2652  1.55  augustss static void
   2653  1.53  augustss ohci_device_intr_abort(xfer)
   2654  1.53  augustss 	usbd_xfer_handle xfer;
   2655   1.1  augustss {
   2656  1.53  augustss 	if (xfer->pipe->intrxfer == xfer) {
   2657   1.1  augustss 		DPRINTF(("ohci_device_intr_abort: remove\n"));
   2658  1.55  augustss 		xfer->pipe->intrxfer = NULL;
   2659   1.1  augustss 	}
   2660  1.54  augustss 	ohci_abort_xfer(xfer, USBD_CANCELLED);
   2661   1.1  augustss }
   2662   1.1  augustss 
   2663   1.1  augustss /* Close a device interrupt pipe. */
   2664  1.55  augustss static void
   2665   1.1  augustss ohci_device_intr_close(pipe)
   2666   1.1  augustss 	usbd_pipe_handle pipe;
   2667   1.1  augustss {
   2668   1.1  augustss 	struct ohci_pipe *opipe = (struct ohci_pipe *)pipe;
   2669   1.1  augustss 	ohci_softc_t *sc = (ohci_softc_t *)pipe->device->bus;
   2670   1.1  augustss 	int nslots = opipe->u.intr.nslots;
   2671   1.1  augustss 	int pos = opipe->u.intr.pos;
   2672   1.1  augustss 	int j;
   2673   1.1  augustss 	ohci_soft_ed_t *p, *sed = opipe->sed;
   2674   1.1  augustss 	int s;
   2675   1.1  augustss 
   2676   1.1  augustss 	DPRINTFN(1,("ohci_device_intr_close: pipe=%p nslots=%d pos=%d\n",
   2677   1.1  augustss 		    pipe, nslots, pos));
   2678   1.1  augustss 	s = splusb();
   2679  1.39  augustss 	sed->ed.ed_flags |= LE(OHCI_ED_SKIP);
   2680  1.70  augustss 	if ((sed->ed.ed_tailp & LE(OHCI_HEADMASK)) !=
   2681  1.70  augustss 	    (sed->ed.ed_headp & LE(OHCI_HEADMASK)))
   2682  1.20  augustss 		usb_delay_ms(&sc->sc_bus, 2);
   2683   1.1  augustss 
   2684   1.1  augustss 	for (p = sc->sc_eds[pos]; p && p->next != sed; p = p->next)
   2685   1.1  augustss 		;
   2686  1.53  augustss #ifdef DIAGNOSTIC
   2687  1.53  augustss 	if (p == NULL)
   2688   1.1  augustss 		panic("ohci_device_intr_close: ED not found\n");
   2689  1.53  augustss #endif
   2690   1.1  augustss 	p->next = sed->next;
   2691  1.39  augustss 	p->ed.ed_nexted = sed->ed.ed_nexted;
   2692   1.1  augustss 	splx(s);
   2693   1.1  augustss 
   2694   1.1  augustss 	for (j = 0; j < nslots; j++)
   2695  1.31  wrstuden 		--sc->sc_bws[(pos * nslots + j) % OHCI_NO_INTRS];
   2696   1.1  augustss 
   2697  1.60  augustss 	ohci_free_std(sc, opipe->tail.td);
   2698   1.1  augustss 	ohci_free_sed(sc, opipe->sed);
   2699   1.1  augustss }
   2700   1.1  augustss 
   2701  1.55  augustss static usbd_status
   2702   1.1  augustss ohci_device_setintr(sc, opipe, ival)
   2703   1.1  augustss 	ohci_softc_t *sc;
   2704   1.1  augustss 	struct ohci_pipe *opipe;
   2705   1.1  augustss 	int ival;
   2706   1.1  augustss {
   2707   1.1  augustss 	int i, j, s, best;
   2708   1.1  augustss 	u_int npoll, slow, shigh, nslots;
   2709   1.1  augustss 	u_int bestbw, bw;
   2710   1.1  augustss 	ohci_soft_ed_t *hsed, *sed = opipe->sed;
   2711   1.1  augustss 
   2712   1.1  augustss 	DPRINTFN(2, ("ohci_setintr: pipe=%p\n", opipe));
   2713   1.1  augustss 	if (ival == 0) {
   2714   1.1  augustss 		printf("ohci_setintr: 0 interval\n");
   2715   1.1  augustss 		return (USBD_INVAL);
   2716   1.1  augustss 	}
   2717   1.1  augustss 
   2718   1.1  augustss 	npoll = OHCI_NO_INTRS;
   2719   1.1  augustss 	while (npoll > ival)
   2720   1.1  augustss 		npoll /= 2;
   2721   1.1  augustss 	DPRINTFN(2, ("ohci_setintr: ival=%d npoll=%d\n", ival, npoll));
   2722   1.1  augustss 
   2723   1.1  augustss 	/*
   2724   1.1  augustss 	 * We now know which level in the tree the ED must go into.
   2725   1.1  augustss 	 * Figure out which slot has most bandwidth left over.
   2726   1.1  augustss 	 * Slots to examine:
   2727   1.1  augustss 	 * npoll
   2728   1.1  augustss 	 * 1	0
   2729   1.1  augustss 	 * 2	1 2
   2730   1.1  augustss 	 * 4	3 4 5 6
   2731   1.1  augustss 	 * 8	7 8 9 10 11 12 13 14
   2732   1.1  augustss 	 * N    (N-1) .. (N-1+N-1)
   2733   1.1  augustss 	 */
   2734   1.1  augustss 	slow = npoll-1;
   2735   1.1  augustss 	shigh = slow + npoll;
   2736   1.1  augustss 	nslots = OHCI_NO_INTRS / npoll;
   2737   1.1  augustss 	for (best = i = slow, bestbw = ~0; i < shigh; i++) {
   2738   1.1  augustss 		bw = 0;
   2739   1.1  augustss 		for (j = 0; j < nslots; j++)
   2740  1.28  augustss 			bw += sc->sc_bws[(i * nslots + j) % OHCI_NO_INTRS];
   2741   1.1  augustss 		if (bw < bestbw) {
   2742   1.1  augustss 			best = i;
   2743   1.1  augustss 			bestbw = bw;
   2744   1.1  augustss 		}
   2745   1.1  augustss 	}
   2746   1.1  augustss 	DPRINTFN(2, ("ohci_setintr: best=%d(%d..%d) bestbw=%d\n",
   2747   1.1  augustss 		     best, slow, shigh, bestbw));
   2748   1.1  augustss 
   2749   1.1  augustss 	s = splusb();
   2750   1.1  augustss 	hsed = sc->sc_eds[best];
   2751   1.1  augustss 	sed->next = hsed->next;
   2752  1.39  augustss 	sed->ed.ed_nexted = hsed->ed.ed_nexted;
   2753   1.1  augustss 	hsed->next = sed;
   2754  1.39  augustss 	hsed->ed.ed_nexted = LE(sed->physaddr);
   2755   1.1  augustss 	splx(s);
   2756   1.1  augustss 
   2757   1.1  augustss 	for (j = 0; j < nslots; j++)
   2758  1.28  augustss 		++sc->sc_bws[(best * nslots + j) % OHCI_NO_INTRS];
   2759   1.1  augustss 	opipe->u.intr.nslots = nslots;
   2760   1.1  augustss 	opipe->u.intr.pos = best;
   2761   1.1  augustss 
   2762   1.1  augustss 	DPRINTFN(5, ("ohci_setintr: returns %p\n", opipe));
   2763   1.1  augustss 	return (USBD_NORMAL_COMPLETION);
   2764  1.60  augustss }
   2765  1.60  augustss 
   2766  1.60  augustss /***********************/
   2767  1.60  augustss 
   2768  1.60  augustss usbd_status
   2769  1.60  augustss ohci_device_isoc_transfer(xfer)
   2770  1.60  augustss 	usbd_xfer_handle xfer;
   2771  1.60  augustss {
   2772  1.60  augustss 	usbd_status err;
   2773  1.60  augustss 
   2774  1.60  augustss 	DPRINTFN(5,("ohci_device_isoc_transfer: xfer=%p\n", xfer));
   2775  1.60  augustss 
   2776  1.60  augustss 	/* Put it on our queue, */
   2777  1.60  augustss 	err = usb_insert_transfer(xfer);
   2778  1.60  augustss 
   2779  1.60  augustss 	/* bail out on error, */
   2780  1.60  augustss 	if (err && err != USBD_IN_PROGRESS)
   2781  1.60  augustss 		return (err);
   2782  1.60  augustss 
   2783  1.60  augustss 	/* XXX should check inuse here */
   2784  1.60  augustss 
   2785  1.60  augustss 	/* insert into schedule, */
   2786  1.60  augustss 	ohci_device_isoc_enter(xfer);
   2787  1.60  augustss 
   2788  1.60  augustss 	/* and put on interrupt list if the pipe wasn't running */
   2789  1.60  augustss 	if (!err)
   2790  1.60  augustss 		ohci_device_isoc_start(SIMPLEQ_FIRST(&xfer->pipe->queue));
   2791  1.60  augustss 
   2792  1.60  augustss 	return (err);
   2793  1.60  augustss }
   2794  1.60  augustss 
   2795  1.60  augustss void
   2796  1.60  augustss ohci_device_isoc_enter(xfer)
   2797  1.60  augustss 	usbd_xfer_handle xfer;
   2798  1.60  augustss {
   2799  1.61  augustss 	struct ohci_pipe *opipe = (struct ohci_pipe *)xfer->pipe;
   2800  1.61  augustss 	usbd_device_handle dev = opipe->pipe.device;
   2801  1.61  augustss 	ohci_softc_t *sc = (ohci_softc_t *)dev->bus;
   2802  1.61  augustss 	ohci_soft_ed_t *sed = opipe->sed;
   2803  1.61  augustss 	struct iso *iso = &opipe->u.iso;
   2804  1.61  augustss 	ohci_soft_itd_t *sitd, *nsitd;
   2805  1.61  augustss 	ohci_physaddr_t buf, offs;
   2806  1.61  augustss 	int i, ncur, nframes;
   2807  1.61  augustss 	int ncross;
   2808  1.61  augustss 	int s;
   2809  1.61  augustss 
   2810  1.61  augustss 	s = splusb();
   2811  1.61  augustss 	sitd = opipe->tail.itd;
   2812  1.61  augustss 	buf = DMAADDR(&xfer->dmabuf);
   2813  1.61  augustss 	sitd->itd.itd_bp0 = LE(buf & OHCI_ITD_PAGE_MASK);
   2814  1.61  augustss 	nframes = xfer->nframes;
   2815  1.61  augustss 	offs = buf & OHCI_ITD_OFFSET_MASK;
   2816  1.61  augustss 	for (i = ncur = 0; i < nframes; i++, ncur++) {
   2817  1.61  augustss 		if (ncur == OHCI_ITD_NOFFSET ||	/* all offsets used */
   2818  1.61  augustss 		    ncross > 1) {	/* too many page crossings */
   2819  1.61  augustss 
   2820  1.61  augustss 			nsitd = ohci_alloc_sitd(sc);
   2821  1.61  augustss 			if (nsitd == NULL) {
   2822  1.61  augustss 				/* XXX what now? */
   2823  1.61  augustss 				return;
   2824  1.61  augustss 			}
   2825  1.61  augustss 			sitd->nextitd = nsitd;
   2826  1.61  augustss 			sitd->itd.itd_nextitd = LE(nsitd->physaddr);
   2827  1.61  augustss 			sitd->itd.itd_flags = LE(
   2828  1.61  augustss 				OHCI_ITD_NOCC |
   2829  1.61  augustss 				OHCI_ITD_SET_SF(iso->next) |
   2830  1.61  augustss 				OHCI_ITD_NOINTR |
   2831  1.61  augustss 				OHCI_ITD_SET_FC(OHCI_ITD_NOFFSET));
   2832  1.61  augustss 			sitd->itd.itd_be = LE(LE(sitd->itd.itd_bp0) + offs - 1);
   2833  1.61  augustss 			nsitd->itd.itd_bp0 = LE((buf + offs) & OHCI_ITD_PAGE_MASK);
   2834  1.61  augustss 			sitd = nsitd;
   2835  1.61  augustss 			iso->next = iso->next + ncur;
   2836  1.61  augustss 			ncur = 0;
   2837  1.61  augustss 			ncross = 0;
   2838  1.61  augustss 		}
   2839  1.61  augustss 		/* XXX byte order */
   2840  1.61  augustss 		sitd->itd.itd_offset[i] =
   2841  1.61  augustss 		    offs | (ncross == 1 ? OHCI_ITD_PAGE_SELECT : 0);
   2842  1.61  augustss 		offs += xfer->frlengths[i];
   2843  1.61  augustss 		/* XXX update ncross */
   2844  1.61  augustss 	}
   2845  1.61  augustss 	nsitd = ohci_alloc_sitd(sc);
   2846  1.61  augustss 	if (nsitd == NULL) {
   2847  1.61  augustss 		/* XXX what now? */
   2848  1.61  augustss 		return;
   2849  1.61  augustss 	}
   2850  1.61  augustss 	sitd->nextitd = nsitd;
   2851  1.61  augustss 	sitd->itd.itd_nextitd = LE(nsitd->physaddr);
   2852  1.61  augustss 	sitd->itd.itd_flags = LE(
   2853  1.61  augustss 		OHCI_ITD_NOCC |
   2854  1.61  augustss 		OHCI_ITD_SET_SF(iso->next) |
   2855  1.61  augustss 		OHCI_ITD_SET_DI(0) |
   2856  1.61  augustss 		OHCI_ITD_SET_FC(ncur));
   2857  1.61  augustss 	sitd->itd.itd_be = LE(LE(sitd->itd.itd_bp0) + offs - 1);
   2858  1.61  augustss 	iso->next = iso->next + ncur;
   2859  1.61  augustss 
   2860  1.61  augustss 	opipe->tail.itd = nsitd;
   2861  1.61  augustss 	sed->ed.ed_tailp = LE(nsitd->physaddr);
   2862  1.61  augustss 	/* XXX update ED */
   2863  1.61  augustss 	splx(s);
   2864  1.60  augustss }
   2865  1.60  augustss 
   2866  1.60  augustss usbd_status
   2867  1.60  augustss ohci_device_isoc_start(xfer)
   2868  1.60  augustss 	usbd_xfer_handle xfer;
   2869  1.60  augustss {
   2870  1.60  augustss 	printf("ohci_device_isoc_start: not implemented\n");
   2871  1.60  augustss 	return (USBD_INVAL);
   2872  1.60  augustss }
   2873  1.60  augustss 
   2874  1.60  augustss void
   2875  1.60  augustss ohci_device_isoc_abort(xfer)
   2876  1.60  augustss 	usbd_xfer_handle xfer;
   2877  1.60  augustss {
   2878  1.60  augustss }
   2879  1.60  augustss 
   2880  1.60  augustss void
   2881  1.60  augustss ohci_device_isoc_done(xfer)
   2882  1.60  augustss 	usbd_xfer_handle xfer;
   2883  1.60  augustss {
   2884  1.60  augustss 	printf("ohci_device_isoc_done: not implemented\n");
   2885  1.60  augustss }
   2886  1.60  augustss 
   2887  1.60  augustss usbd_status
   2888  1.60  augustss ohci_setup_isoc(pipe)
   2889  1.60  augustss 	usbd_pipe_handle pipe;
   2890  1.60  augustss {
   2891  1.60  augustss 	struct ohci_pipe *opipe = (struct ohci_pipe *)pipe;
   2892  1.60  augustss 	struct iso *iso = &opipe->u.iso;
   2893  1.60  augustss 
   2894  1.60  augustss 	iso->next = -1;
   2895  1.60  augustss 	iso->inuse = 0;
   2896  1.60  augustss 
   2897  1.60  augustss 	return (USBD_NORMAL_COMPLETION);
   2898  1.60  augustss }
   2899  1.60  augustss 
   2900  1.60  augustss void
   2901  1.60  augustss ohci_device_isoc_close(pipe)
   2902  1.60  augustss 	usbd_pipe_handle pipe;
   2903  1.60  augustss {
   2904  1.60  augustss 	struct ohci_pipe *opipe = (struct ohci_pipe *)pipe;
   2905  1.60  augustss 	ohci_softc_t *sc = (ohci_softc_t *)pipe->device->bus;
   2906  1.60  augustss 
   2907  1.60  augustss 	DPRINTF(("ohci_device_isoc_close: pipe=%p\n", pipe));
   2908  1.60  augustss 	ohci_close_pipe(pipe, sc->sc_isoc_head);
   2909  1.60  augustss 	ohci_free_sitd(sc, opipe->tail.itd);
   2910   1.1  augustss }
   2911