Home | History | Annotate | Line # | Download | only in usb
ohci.c revision 1.5
      1  1.5  augustss /*	$NetBSD: ohci.c,v 1.5 1998/07/26 17:42:48 augustss Exp $	*/
      2  1.1  augustss 
      3  1.1  augustss /*
      4  1.1  augustss  * Copyright (c) 1998 The NetBSD Foundation, Inc.
      5  1.1  augustss  * All rights reserved.
      6  1.1  augustss  *
      7  1.1  augustss  * Author: Lennart Augustsson <augustss (at) carlstedt.se>
      8  1.1  augustss  *         Carlstedt Research & Technology
      9  1.1  augustss  *
     10  1.1  augustss  * Redistribution and use in source and binary forms, with or without
     11  1.1  augustss  * modification, are permitted provided that the following conditions
     12  1.1  augustss  * are met:
     13  1.1  augustss  * 1. Redistributions of source code must retain the above copyright
     14  1.1  augustss  *    notice, this list of conditions and the following disclaimer.
     15  1.1  augustss  * 2. Redistributions in binary form must reproduce the above copyright
     16  1.1  augustss  *    notice, this list of conditions and the following disclaimer in the
     17  1.1  augustss  *    documentation and/or other materials provided with the distribution.
     18  1.1  augustss  * 3. All advertising materials mentioning features or use of this software
     19  1.1  augustss  *    must display the following acknowledgement:
     20  1.1  augustss  *        This product includes software developed by the NetBSD
     21  1.1  augustss  *        Foundation, Inc. and its contributors.
     22  1.1  augustss  * 4. Neither the name of The NetBSD Foundation nor the names of its
     23  1.1  augustss  *    contributors may be used to endorse or promote products derived
     24  1.1  augustss  *    from this software without specific prior written permission.
     25  1.1  augustss  *
     26  1.1  augustss  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     27  1.1  augustss  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     28  1.1  augustss  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     29  1.1  augustss  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     30  1.1  augustss  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     31  1.1  augustss  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     32  1.1  augustss  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     33  1.1  augustss  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     34  1.1  augustss  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     35  1.1  augustss  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     36  1.1  augustss  * POSSIBILITY OF SUCH DAMAGE.
     37  1.1  augustss  */
     38  1.1  augustss 
     39  1.1  augustss /*
     40  1.1  augustss  * USB Open Host Controller driver.
     41  1.1  augustss  *
     42  1.1  augustss  * OHCI spec: http://www.intel.com/design/usb/ohci11d.pdf
     43  1.1  augustss  * USB spec: http://www.teleport.com/cgi-bin/mailmerge.cgi/~usb/cgiform.tpl
     44  1.1  augustss  */
     45  1.1  augustss 
     46  1.1  augustss #include <sys/param.h>
     47  1.1  augustss #include <sys/systm.h>
     48  1.1  augustss #include <sys/kernel.h>
     49  1.1  augustss #include <sys/malloc.h>
     50  1.1  augustss #include <sys/device.h>
     51  1.1  augustss #include <sys/proc.h>
     52  1.1  augustss #include <sys/queue.h>
     53  1.1  augustss #include <sys/select.h>
     54  1.1  augustss 
     55  1.4  augustss #include <machine/bus.h>
     56  1.4  augustss 
     57  1.1  augustss #include <dev/usb/usb.h>
     58  1.1  augustss #include <dev/usb/usbdi.h>
     59  1.1  augustss #include <dev/usb/usbdivar.h>
     60  1.1  augustss #include <dev/usb/usb_quirks.h>
     61  1.4  augustss #include <dev/usb/usb_mem.h>
     62  1.1  augustss 
     63  1.1  augustss #include <dev/usb/ohcireg.h>
     64  1.1  augustss #include <dev/usb/ohcivar.h>
     65  1.1  augustss 
     66  1.1  augustss int ohcidebug = 0;
     67  1.1  augustss 
     68  1.1  augustss struct ohci_pipe;
     69  1.1  augustss 
     70  1.1  augustss ohci_soft_ed_t *ohci_alloc_sed __P((ohci_softc_t *));
     71  1.1  augustss void		ohci_free_sed __P((ohci_softc_t *, ohci_soft_ed_t *));
     72  1.1  augustss 
     73  1.1  augustss ohci_soft_td_t *ohci_alloc_std __P((ohci_softc_t *));
     74  1.1  augustss void		ohci_free_std __P((ohci_softc_t *, ohci_soft_td_t *));
     75  1.1  augustss 
     76  1.1  augustss usbd_status	ohci_open __P((usbd_pipe_handle));
     77  1.5  augustss void		ohci_poll __P((struct usbd_bus *));
     78  1.1  augustss void		ohci_waitintr __P((ohci_softc_t *, usbd_request_handle));
     79  1.1  augustss void		ohci_rhsc __P((ohci_softc_t *, usbd_request_handle));
     80  1.1  augustss void		ohci_process_done __P((ohci_softc_t *, ohci_physaddr_t));
     81  1.1  augustss void		ohci_ctrl_done __P((ohci_softc_t *, usbd_request_handle));
     82  1.1  augustss void		ohci_intr_done __P((ohci_softc_t *, usbd_request_handle));
     83  1.3  augustss void		ohci_bulk_done __P((ohci_softc_t *, usbd_request_handle));
     84  1.1  augustss 
     85  1.1  augustss usbd_status	ohci_device_request __P((usbd_request_handle reqh));
     86  1.3  augustss void		ohci_add_ed __P((ohci_soft_ed_t *, ohci_soft_ed_t *));
     87  1.3  augustss void		ohci_rem_ed __P((ohci_soft_ed_t *, ohci_soft_ed_t *));
     88  1.1  augustss void		ohci_hash_add_td __P((ohci_softc_t *, ohci_soft_td_t *));
     89  1.1  augustss void		ohci_hash_rem_td __P((ohci_softc_t *, ohci_soft_td_t *));
     90  1.1  augustss ohci_soft_td_t *ohci_hash_find_td __P((ohci_softc_t *, ohci_physaddr_t));
     91  1.1  augustss 
     92  1.1  augustss usbd_status	ohci_root_ctrl_transfer __P((usbd_request_handle));
     93  1.1  augustss void		ohci_root_ctrl_abort __P((usbd_request_handle));
     94  1.1  augustss void		ohci_root_ctrl_close __P((usbd_pipe_handle));
     95  1.1  augustss 
     96  1.1  augustss usbd_status	ohci_root_intr_transfer __P((usbd_request_handle));
     97  1.1  augustss void		ohci_root_intr_abort __P((usbd_request_handle));
     98  1.1  augustss void		ohci_root_intr_close __P((usbd_pipe_handle));
     99  1.1  augustss 
    100  1.1  augustss usbd_status	ohci_device_ctrl_transfer __P((usbd_request_handle));
    101  1.1  augustss void		ohci_device_ctrl_abort __P((usbd_request_handle));
    102  1.1  augustss void		ohci_device_ctrl_close __P((usbd_pipe_handle));
    103  1.1  augustss 
    104  1.3  augustss usbd_status	ohci_device_bulk_transfer __P((usbd_request_handle));
    105  1.3  augustss void		ohci_device_bulk_abort __P((usbd_request_handle));
    106  1.3  augustss void		ohci_device_bulk_close __P((usbd_pipe_handle));
    107  1.3  augustss 
    108  1.1  augustss usbd_status	ohci_device_intr_transfer __P((usbd_request_handle));
    109  1.1  augustss void		ohci_device_intr_abort __P((usbd_request_handle));
    110  1.1  augustss void		ohci_device_intr_close __P((usbd_pipe_handle));
    111  1.1  augustss usbd_status	ohci_device_setintr __P((ohci_softc_t *sc,
    112  1.1  augustss 					 struct ohci_pipe *pipe, int ival));
    113  1.1  augustss 
    114  1.1  augustss int		ohci_str __P((usb_string_descriptor_t *, int, char *));
    115  1.1  augustss 
    116  1.1  augustss void		ohci_timeout __P((void *));
    117  1.1  augustss void		ohci_rhsc_able __P((ohci_softc_t *, int));
    118  1.1  augustss 
    119  1.1  augustss #ifdef USB_DEBUG
    120  1.1  augustss ohci_softc_t   *thesc;
    121  1.1  augustss void		ohci_dumpregs __P((ohci_softc_t *));
    122  1.1  augustss void		ohci_dump_tds __P((ohci_soft_td_t *));
    123  1.1  augustss void		ohci_dump_td __P((ohci_soft_td_t *));
    124  1.1  augustss void		ohci_dump_ed __P((ohci_soft_ed_t *));
    125  1.1  augustss #endif
    126  1.1  augustss 
    127  1.1  augustss #define OWRITE4(sc, r, x) bus_space_write_4((sc)->iot, (sc)->ioh, (r), (x))
    128  1.1  augustss #define OREAD4(sc, r) bus_space_read_4((sc)->iot, (sc)->ioh, (r))
    129  1.1  augustss #define OREAD2(sc, r) bus_space_read_2((sc)->iot, (sc)->ioh, (r))
    130  1.1  augustss 
    131  1.1  augustss /* Reverse the bits in a value 0 .. 31 */
    132  1.1  augustss static u_int8_t revbits[OHCI_NO_INTRS] =
    133  1.1  augustss   { 0x00, 0x10, 0x08, 0x18, 0x04, 0x14, 0x0c, 0x1c,
    134  1.1  augustss     0x02, 0x12, 0x0a, 0x1a, 0x06, 0x16, 0x0e, 0x1e,
    135  1.1  augustss     0x01, 0x11, 0x09, 0x19, 0x05, 0x15, 0x0d, 0x1d,
    136  1.1  augustss     0x03, 0x13, 0x0b, 0x1b, 0x07, 0x17, 0x0f, 0x1f };
    137  1.1  augustss 
    138  1.1  augustss struct ohci_pipe {
    139  1.1  augustss 	struct usbd_pipe pipe;
    140  1.1  augustss 	ohci_soft_ed_t *sed;
    141  1.1  augustss 	ohci_soft_td_t *tail;
    142  1.1  augustss 	/* Info needed for different pipe kinds. */
    143  1.1  augustss 	union {
    144  1.1  augustss 		/* Control pipe */
    145  1.1  augustss 		struct {
    146  1.4  augustss 			usb_dma_t datadma;
    147  1.4  augustss 			usb_dma_t reqdma;
    148  1.1  augustss 			u_int length;
    149  1.1  augustss 			ohci_soft_td_t *setup, *xfer, *stat;
    150  1.1  augustss 		} ctl;
    151  1.1  augustss 		/* Interrupt pipe */
    152  1.1  augustss 		struct {
    153  1.4  augustss 			usb_dma_t datadma;
    154  1.1  augustss 			int nslots;
    155  1.1  augustss 			int pos;
    156  1.1  augustss 		} intr;
    157  1.3  augustss 		/* Bulk pipe */
    158  1.3  augustss 		struct {
    159  1.4  augustss 			usb_dma_t datadma;
    160  1.3  augustss 			u_int length;
    161  1.3  augustss 		} bulk;
    162  1.1  augustss 	} u;
    163  1.1  augustss };
    164  1.1  augustss 
    165  1.1  augustss #define OHCI_INTR_ENDPT 1
    166  1.1  augustss 
    167  1.1  augustss struct usbd_methods ohci_root_ctrl_methods = {
    168  1.1  augustss 	ohci_root_ctrl_transfer,
    169  1.1  augustss 	ohci_root_ctrl_abort,
    170  1.1  augustss 	ohci_root_ctrl_close,
    171  1.1  augustss };
    172  1.1  augustss 
    173  1.1  augustss struct usbd_methods ohci_root_intr_methods = {
    174  1.1  augustss 	ohci_root_intr_transfer,
    175  1.1  augustss 	ohci_root_intr_abort,
    176  1.1  augustss 	ohci_root_intr_close,
    177  1.1  augustss };
    178  1.1  augustss 
    179  1.1  augustss struct usbd_methods ohci_device_ctrl_methods = {
    180  1.1  augustss 	ohci_device_ctrl_transfer,
    181  1.1  augustss 	ohci_device_ctrl_abort,
    182  1.1  augustss 	ohci_device_ctrl_close,
    183  1.1  augustss };
    184  1.1  augustss 
    185  1.1  augustss struct usbd_methods ohci_device_intr_methods = {
    186  1.1  augustss 	ohci_device_intr_transfer,
    187  1.1  augustss 	ohci_device_intr_abort,
    188  1.1  augustss 	ohci_device_intr_close,
    189  1.1  augustss };
    190  1.1  augustss 
    191  1.3  augustss struct usbd_methods ohci_device_bulk_methods = {
    192  1.3  augustss 	ohci_device_bulk_transfer,
    193  1.3  augustss 	ohci_device_bulk_abort,
    194  1.3  augustss 	ohci_device_bulk_close,
    195  1.3  augustss };
    196  1.3  augustss 
    197  1.1  augustss ohci_soft_ed_t *
    198  1.1  augustss ohci_alloc_sed(sc)
    199  1.1  augustss 	ohci_softc_t *sc;
    200  1.1  augustss {
    201  1.1  augustss 	ohci_soft_ed_t *sed;
    202  1.1  augustss 	usbd_status r;
    203  1.1  augustss 	int i, offs;
    204  1.4  augustss 	usb_dma_t dma;
    205  1.1  augustss 
    206  1.1  augustss 	if (!sc->sc_freeeds) {
    207  1.1  augustss 		DPRINTFN(2, ("ohci_alloc_sed: allocating chunk\n"));
    208  1.1  augustss 		sed = malloc(sizeof(ohci_soft_ed_t) * OHCI_ED_CHUNK,
    209  1.1  augustss 			     M_USBDEV, M_NOWAIT);
    210  1.1  augustss 		if (!sed)
    211  1.1  augustss 			return 0;
    212  1.4  augustss 		r = usb_allocmem(sc->sc_dmatag, OHCI_ED_SIZE * OHCI_ED_CHUNK,
    213  1.4  augustss 				 OHCI_ED_ALIGN, &dma);
    214  1.1  augustss 		if (r != USBD_NORMAL_COMPLETION) {
    215  1.1  augustss 			free(sed, M_USBDEV);
    216  1.1  augustss 			return 0;
    217  1.1  augustss 		}
    218  1.1  augustss 		for(i = 0; i < OHCI_ED_CHUNK; i++, sed++) {
    219  1.1  augustss 			offs = i * OHCI_ED_SIZE;
    220  1.1  augustss 			sed->physaddr = DMAADDR(&dma) + offs;
    221  1.1  augustss 			sed->ed = (ohci_ed_t *)
    222  1.1  augustss 					((char *)KERNADDR(&dma) + offs);
    223  1.1  augustss 			sed->next = sc->sc_freeeds;
    224  1.1  augustss 			sc->sc_freeeds = sed;
    225  1.1  augustss 		}
    226  1.1  augustss 	}
    227  1.1  augustss 	sed = sc->sc_freeeds;
    228  1.1  augustss 	sc->sc_freeeds = sed->next;
    229  1.1  augustss 	memset(sed->ed, 0, OHCI_ED_SIZE);
    230  1.1  augustss 	sed->next = 0;
    231  1.1  augustss 	return sed;
    232  1.1  augustss }
    233  1.1  augustss 
    234  1.1  augustss void
    235  1.1  augustss ohci_free_sed(sc, sed)
    236  1.1  augustss 	ohci_softc_t *sc;
    237  1.1  augustss 	ohci_soft_ed_t *sed;
    238  1.1  augustss {
    239  1.1  augustss 	sed->next = sc->sc_freeeds;
    240  1.1  augustss 	sc->sc_freeeds = sed;
    241  1.1  augustss }
    242  1.1  augustss 
    243  1.1  augustss ohci_soft_td_t *
    244  1.1  augustss ohci_alloc_std(sc)
    245  1.1  augustss 	ohci_softc_t *sc;
    246  1.1  augustss {
    247  1.1  augustss 	ohci_soft_td_t *std;
    248  1.1  augustss 	usbd_status r;
    249  1.1  augustss 	int i, offs;
    250  1.4  augustss 	usb_dma_t dma;
    251  1.1  augustss 
    252  1.1  augustss 	if (!sc->sc_freetds) {
    253  1.1  augustss 		DPRINTFN(2, ("ohci_alloc_std: allocating chunk\n"));
    254  1.1  augustss 		std = malloc(sizeof(ohci_soft_td_t) * OHCI_TD_CHUNK,
    255  1.1  augustss 			     M_USBDEV, M_NOWAIT);
    256  1.1  augustss 		if (!std)
    257  1.1  augustss 			return 0;
    258  1.4  augustss 		r = usb_allocmem(sc->sc_dmatag, OHCI_TD_SIZE * OHCI_TD_CHUNK,
    259  1.4  augustss 				 OHCI_TD_ALIGN, &dma);
    260  1.1  augustss 		if (r != USBD_NORMAL_COMPLETION) {
    261  1.1  augustss 			free(std, M_USBDEV);
    262  1.1  augustss 			return 0;
    263  1.1  augustss 		}
    264  1.1  augustss 		for(i = 0; i < OHCI_TD_CHUNK; i++, std++) {
    265  1.1  augustss 			offs = i * OHCI_TD_SIZE;
    266  1.1  augustss 			std->physaddr = DMAADDR(&dma) + offs;
    267  1.1  augustss 			std->td = (ohci_td_t *)
    268  1.1  augustss 					((char *)KERNADDR(&dma) + offs);
    269  1.1  augustss 			std->nexttd = sc->sc_freetds;
    270  1.1  augustss 			sc->sc_freetds = std;
    271  1.1  augustss 		}
    272  1.1  augustss 	}
    273  1.1  augustss 	std = sc->sc_freetds;
    274  1.1  augustss 	sc->sc_freetds = std->nexttd;
    275  1.1  augustss 	memset(std->td, 0, OHCI_TD_SIZE);
    276  1.1  augustss 	std->nexttd = 0;
    277  1.1  augustss 	return (std);
    278  1.1  augustss }
    279  1.1  augustss 
    280  1.1  augustss void
    281  1.1  augustss ohci_free_std(sc, std)
    282  1.1  augustss 	ohci_softc_t *sc;
    283  1.1  augustss 	ohci_soft_td_t *std;
    284  1.1  augustss {
    285  1.1  augustss 	std->nexttd = sc->sc_freetds;
    286  1.1  augustss 	sc->sc_freetds = std;
    287  1.1  augustss }
    288  1.1  augustss 
    289  1.1  augustss usbd_status
    290  1.1  augustss ohci_init(sc)
    291  1.1  augustss 	ohci_softc_t *sc;
    292  1.1  augustss {
    293  1.1  augustss 	ohci_soft_ed_t *sed, *psed;
    294  1.1  augustss 	usbd_status r;
    295  1.1  augustss 	int rev;
    296  1.1  augustss 	int i;
    297  1.1  augustss 	u_int32_t s, ctl, ival, hcr, fm, per;
    298  1.1  augustss 
    299  1.1  augustss 	DPRINTF(("ohci_init: start\n"));
    300  1.1  augustss 	rev = OREAD4(sc, OHCI_REVISION);
    301  1.1  augustss 	printf("%s: OHCI version %d.%d%s\n", sc->sc_bus.bdev.dv_xname,
    302  1.1  augustss 	       OHCI_REV_HI(rev), OHCI_REV_LO(rev),
    303  1.1  augustss 	       OHCI_REV_LEGACY(rev) ? ", legacy support" : "");
    304  1.1  augustss 	if (OHCI_REV_HI(rev) != 1 || OHCI_REV_LO(rev) != 0) {
    305  1.1  augustss 		printf("%s: unsupported OHCI revision\n",
    306  1.1  augustss 		       sc->sc_bus.bdev.dv_xname);
    307  1.1  augustss 		return (USBD_INVAL);
    308  1.1  augustss 	}
    309  1.1  augustss 
    310  1.1  augustss 	for (i = 0; i < OHCI_HASH_SIZE; i++)
    311  1.1  augustss 		LIST_INIT(&sc->sc_hash_tds[i]);
    312  1.1  augustss 
    313  1.1  augustss 	/* Allocate the HCCA area. */
    314  1.4  augustss 	r = usb_allocmem(sc->sc_dmatag, OHCI_HCCA_SIZE,
    315  1.4  augustss 			 OHCI_HCCA_ALIGN, &sc->sc_hccadma);
    316  1.1  augustss 	if (r != USBD_NORMAL_COMPLETION)
    317  1.1  augustss 		return (r);
    318  1.1  augustss 	sc->sc_hcca = (struct ohci_hcca *)KERNADDR(&sc->sc_hccadma);
    319  1.1  augustss 	memset(sc->sc_hcca, 0, OHCI_HCCA_SIZE);
    320  1.1  augustss 
    321  1.1  augustss 	sc->sc_eintrs = OHCI_NORMAL_INTRS;
    322  1.1  augustss 
    323  1.1  augustss 	sc->sc_ctrl_head = ohci_alloc_sed(sc);
    324  1.1  augustss 	if (!sc->sc_ctrl_head) {
    325  1.1  augustss 		r = USBD_NOMEM;
    326  1.1  augustss 		goto bad1;
    327  1.1  augustss 	}
    328  1.1  augustss 	sc->sc_ctrl_head->ed->ed_flags |= OHCI_ED_SKIP;
    329  1.1  augustss 	sc->sc_bulk_head = ohci_alloc_sed(sc);
    330  1.1  augustss 	if (!sc->sc_bulk_head) {
    331  1.1  augustss 		r = USBD_NOMEM;
    332  1.1  augustss 		goto bad2;
    333  1.1  augustss 	}
    334  1.1  augustss 	sc->sc_bulk_head->ed->ed_flags |= OHCI_ED_SKIP;
    335  1.1  augustss 
    336  1.1  augustss 	/* Allocate all the dummy EDs that make up the interrupt tree. */
    337  1.1  augustss 	for (i = 0; i < OHCI_NO_EDS; i++) {
    338  1.1  augustss 		sed = ohci_alloc_sed(sc);
    339  1.1  augustss 		if (!sed) {
    340  1.1  augustss 			while (--i >= 0)
    341  1.1  augustss 				ohci_free_sed(sc, sc->sc_eds[i]);
    342  1.1  augustss 			r = USBD_NOMEM;
    343  1.1  augustss 			goto bad3;
    344  1.1  augustss 		}
    345  1.1  augustss 		/* All ED fields are set to 0. */
    346  1.1  augustss 		sc->sc_eds[i] = sed;
    347  1.1  augustss 		sed->ed->ed_flags |= OHCI_ED_SKIP;
    348  1.1  augustss 		if (i != 0) {
    349  1.1  augustss 			psed = sc->sc_eds[(i-1) / 2];
    350  1.1  augustss 			sed->next = psed;
    351  1.1  augustss 			sed->ed->ed_nexted = psed->physaddr;
    352  1.1  augustss 		}
    353  1.1  augustss 	}
    354  1.1  augustss 	/*
    355  1.1  augustss 	 * Fill HCCA interrupt table.  The bit reversal is to get
    356  1.1  augustss 	 * the tree set up properly to spread the interrupts.
    357  1.1  augustss 	 */
    358  1.1  augustss 	for (i = 0; i < OHCI_NO_INTRS; i++)
    359  1.1  augustss 		sc->sc_hcca->hcca_interrupt_table[revbits[i]] =
    360  1.1  augustss 			sc->sc_eds[OHCI_NO_EDS-OHCI_NO_INTRS+i]->physaddr;
    361  1.1  augustss 
    362  1.1  augustss 	/* Determine in what context we are running. */
    363  1.1  augustss 	ctl = OREAD4(sc, OHCI_CONTROL);
    364  1.1  augustss 	if (ctl & OHCI_IR) {
    365  1.1  augustss 		/* SMM active, request change */
    366  1.1  augustss 		DPRINTF(("ohci_init: SMM active, request owner change\n"));
    367  1.1  augustss 		s = OREAD4(sc, OHCI_COMMAND_STATUS);
    368  1.1  augustss 		OWRITE4(sc, OHCI_COMMAND_STATUS, s | OHCI_OCR);
    369  1.1  augustss 		for (i = 0; i < 100 && (ctl & OHCI_IR); i++) {
    370  1.1  augustss 			delay(1000);
    371  1.1  augustss 			ctl = OREAD4(sc, OHCI_CONTROL);
    372  1.1  augustss 		}
    373  1.1  augustss 		if ((ctl & OHCI_IR) == 0) {
    374  1.1  augustss 			printf("%s: SMM does not respond, resetting\n",
    375  1.1  augustss 			       sc->sc_bus.bdev.dv_xname);
    376  1.1  augustss 			OWRITE4(sc, OHCI_CONTROL, OHCI_HCFS_RESET);
    377  1.1  augustss 			goto reset;
    378  1.1  augustss 		}
    379  1.1  augustss 	} else if ((ctl & OHCI_HCFS_MASK) != OHCI_HCFS_RESET) {
    380  1.1  augustss 		/* BIOS started controller. */
    381  1.1  augustss 		DPRINTF(("ohci_init: BIOS active\n"));
    382  1.1  augustss 		if ((ctl & OHCI_HCFS_MASK) != OHCI_HCFS_OPERATIONAL) {
    383  1.1  augustss 			OWRITE4(sc, OHCI_CONTROL, OHCI_HCFS_OPERATIONAL);
    384  1.1  augustss 			delay(USB_RESUME_DELAY * 1000);
    385  1.1  augustss 		}
    386  1.1  augustss 	} else {
    387  1.1  augustss 		DPRINTF(("ohci_init: cold started\n"));
    388  1.1  augustss 	reset:
    389  1.1  augustss 		/* Controller was cold started. */
    390  1.1  augustss 		delay(USB_RESET_DELAY * 1000);
    391  1.1  augustss 	}
    392  1.1  augustss 
    393  1.1  augustss 	/* We now own the host controller and the bus has been reset. */
    394  1.1  augustss 	ival = OHCI_GET_IVAL(OREAD4(sc, OHCI_FM_INTERVAL));
    395  1.1  augustss 
    396  1.1  augustss 	OWRITE4(sc, OHCI_COMMAND_STATUS, OHCI_HCR); /* Reset HC */
    397  1.1  augustss 	/* Nominal time for a reset is 10 us. */
    398  1.1  augustss 	for (i = 0; i < 10; i++) {
    399  1.1  augustss 		delay(10);
    400  1.1  augustss 		hcr = OREAD4(sc, OHCI_COMMAND_STATUS) & OHCI_HCR;
    401  1.1  augustss 		if (!hcr)
    402  1.1  augustss 			break;
    403  1.1  augustss 	}
    404  1.1  augustss 	if (hcr) {
    405  1.1  augustss 		printf("%s: reset timeout\n", sc->sc_bus.bdev.dv_xname);
    406  1.1  augustss 		r = USBD_IOERROR;
    407  1.1  augustss 		goto bad3;
    408  1.1  augustss 	}
    409  1.1  augustss #ifdef USB_DEBUG
    410  1.1  augustss 	thesc = sc;
    411  1.1  augustss 	if (ohcidebug > 15)
    412  1.1  augustss 		ohci_dumpregs(sc);
    413  1.1  augustss #endif
    414  1.1  augustss 
    415  1.1  augustss 	/* The controller is now in suspend state, we have 2ms to finish. */
    416  1.1  augustss 
    417  1.1  augustss 	/* Set up HC registers. */
    418  1.1  augustss 	OWRITE4(sc, OHCI_HCCA, DMAADDR(&sc->sc_hccadma));
    419  1.1  augustss 	OWRITE4(sc, OHCI_CONTROL_HEAD_ED, sc->sc_ctrl_head->physaddr);
    420  1.1  augustss 	OWRITE4(sc, OHCI_BULK_HEAD_ED, sc->sc_bulk_head->physaddr);
    421  1.1  augustss 	OWRITE4(sc, OHCI_INTERRUPT_DISABLE, OHCI_ALL_INTRS);
    422  1.1  augustss 	OWRITE4(sc, OHCI_INTERRUPT_ENABLE, sc->sc_eintrs | OHCI_MIE);
    423  1.1  augustss 	ctl = OREAD4(sc, OHCI_CONTROL);
    424  1.1  augustss 	ctl &= ~(OHCI_CBSR_MASK | OHCI_LES | OHCI_HCFS_MASK | OHCI_IR);
    425  1.1  augustss 	ctl |= OHCI_PLE | OHCI_IE | OHCI_CLE | OHCI_BLE |
    426  1.1  augustss 		OHCI_RATIO_1_4 | OHCI_HCFS_OPERATIONAL;
    427  1.1  augustss 	/* And finally start it! */
    428  1.1  augustss 	OWRITE4(sc, OHCI_CONTROL, ctl);
    429  1.1  augustss 
    430  1.1  augustss 	/*
    431  1.1  augustss 	 * The controller is now OPERATIONAL.  Set a some final
    432  1.1  augustss 	 * registers that should be set earlier, but that the
    433  1.1  augustss 	 * controller ignores when in the SUSPEND state.
    434  1.1  augustss 	 */
    435  1.1  augustss 	fm = (OREAD4(sc, OHCI_FM_INTERVAL) & OHCI_FIT) ^ OHCI_FIT;
    436  1.1  augustss 	fm |= OHCI_FSMPS(ival) | ival;
    437  1.1  augustss 	OWRITE4(sc, OHCI_FM_INTERVAL, fm);
    438  1.1  augustss 	per = OHCI_PERIODIC(ival); /* 90% periodic */
    439  1.1  augustss 	OWRITE4(sc, OHCI_PERIODIC_START, per);
    440  1.1  augustss 
    441  1.1  augustss 	OWRITE4(sc, OHCI_RH_STATUS, OHCI_LPSC);	/* Enable port power */
    442  1.1  augustss 
    443  1.1  augustss 	sc->sc_noport = OHCI_GET_NDP(OREAD4(sc, OHCI_RH_DESCRIPTOR_A));
    444  1.1  augustss 	printf("%s: %d downstream port%s\n",
    445  1.1  augustss 	       sc->sc_bus.bdev.dv_xname, sc->sc_noport,
    446  1.1  augustss 	       sc->sc_noport != 1 ? "s" : "");
    447  1.1  augustss 
    448  1.1  augustss #ifdef USB_DEBUG
    449  1.1  augustss 	if (ohcidebug > 5)
    450  1.1  augustss 		ohci_dumpregs(sc);
    451  1.1  augustss #endif
    452  1.1  augustss 
    453  1.1  augustss 	/* Set up the bus struct. */
    454  1.1  augustss 	sc->sc_bus.open_pipe = ohci_open;
    455  1.1  augustss 	sc->sc_bus.pipe_size = sizeof(struct ohci_pipe);
    456  1.5  augustss 	sc->sc_bus.do_poll = ohci_poll;
    457  1.1  augustss 
    458  1.1  augustss 	return (USBD_NORMAL_COMPLETION);
    459  1.1  augustss 
    460  1.1  augustss  bad3:
    461  1.1  augustss 	ohci_free_sed(sc, sc->sc_ctrl_head);
    462  1.1  augustss  bad2:
    463  1.1  augustss 	ohci_free_sed(sc, sc->sc_bulk_head);
    464  1.1  augustss  bad1:
    465  1.4  augustss 	usb_freemem(sc->sc_dmatag, &sc->sc_hccadma);
    466  1.1  augustss 	return (r);
    467  1.1  augustss }
    468  1.1  augustss 
    469  1.1  augustss #ifdef USB_DEBUG
    470  1.1  augustss void ohcidump(void);
    471  1.1  augustss void ohcidump(void) { ohci_dumpregs(thesc); }
    472  1.1  augustss 
    473  1.1  augustss void
    474  1.1  augustss ohci_dumpregs(sc)
    475  1.1  augustss 	ohci_softc_t *sc;
    476  1.1  augustss {
    477  1.1  augustss 	printf("ohci_dumpregs: rev=0x%08x control=0x%08x command=0x%08x\n",
    478  1.1  augustss 	       OREAD4(sc, OHCI_REVISION),
    479  1.1  augustss 	       OREAD4(sc, OHCI_CONTROL),
    480  1.1  augustss 	       OREAD4(sc, OHCI_COMMAND_STATUS));
    481  1.1  augustss 	printf("               intrstat=0x%08x intre=0x%08x intrd=0x%08x\n",
    482  1.1  augustss 	       OREAD4(sc, OHCI_INTERRUPT_STATUS),
    483  1.1  augustss 	       OREAD4(sc, OHCI_INTERRUPT_ENABLE),
    484  1.1  augustss 	       OREAD4(sc, OHCI_INTERRUPT_DISABLE));
    485  1.1  augustss 	printf("               hcca=0x%08x percur=0x%08x ctrlhd=0x%08x\n",
    486  1.1  augustss 	       OREAD4(sc, OHCI_HCCA),
    487  1.1  augustss 	       OREAD4(sc, OHCI_PERIOD_CURRENT_ED),
    488  1.1  augustss 	       OREAD4(sc, OHCI_CONTROL_HEAD_ED));
    489  1.1  augustss 	printf("               ctrlcur=0x%08x bulkhd=0x%08x bulkcur=0x%08x\n",
    490  1.1  augustss 	       OREAD4(sc, OHCI_CONTROL_CURRENT_ED),
    491  1.1  augustss 	       OREAD4(sc, OHCI_BULK_HEAD_ED),
    492  1.1  augustss 	       OREAD4(sc, OHCI_BULK_CURRENT_ED));
    493  1.1  augustss 	printf("               done=0x%08x fmival=0x%08x fmrem=0x%08x\n",
    494  1.1  augustss 	       OREAD4(sc, OHCI_DONE_HEAD),
    495  1.1  augustss 	       OREAD4(sc, OHCI_FM_INTERVAL),
    496  1.1  augustss 	       OREAD4(sc, OHCI_FM_REMAINING));
    497  1.1  augustss 	printf("               fmnum=0x%08x perst=0x%08x lsthrs=0x%08x\n",
    498  1.1  augustss 	       OREAD4(sc, OHCI_FM_NUMBER),
    499  1.1  augustss 	       OREAD4(sc, OHCI_PERIODIC_START),
    500  1.1  augustss 	       OREAD4(sc, OHCI_LS_THRESHOLD));
    501  1.1  augustss 	printf("               desca=0x%08x descb=0x%08x stat=0x%08x\n",
    502  1.1  augustss 	       OREAD4(sc, OHCI_RH_DESCRIPTOR_A),
    503  1.1  augustss 	       OREAD4(sc, OHCI_RH_DESCRIPTOR_B),
    504  1.1  augustss 	       OREAD4(sc, OHCI_RH_STATUS));
    505  1.1  augustss 	printf("               port1=0x%08x port2=0x%08x\n",
    506  1.1  augustss 	       OREAD4(sc, OHCI_RH_PORT_STATUS(1)),
    507  1.1  augustss 	       OREAD4(sc, OHCI_RH_PORT_STATUS(2)));
    508  1.1  augustss 	printf("         HCCA: frame_number=0x%04x done_head=0x%08x\n",
    509  1.1  augustss 	       sc->sc_hcca->hcca_frame_number,
    510  1.1  augustss 	       sc->sc_hcca->hcca_done_head);
    511  1.1  augustss }
    512  1.1  augustss #endif
    513  1.1  augustss 
    514  1.1  augustss int
    515  1.1  augustss ohci_intr(p)
    516  1.1  augustss 	void *p;
    517  1.1  augustss {
    518  1.1  augustss 	ohci_softc_t *sc = p;
    519  1.1  augustss 	u_int32_t intrs, eintrs;
    520  1.1  augustss 	ohci_physaddr_t done;
    521  1.1  augustss 
    522  1.1  augustss 	done = sc->sc_hcca->hcca_done_head;
    523  1.1  augustss 	if (done != 0) {
    524  1.1  augustss 		intrs = OHCI_WDH;
    525  1.1  augustss 		if (done & OHCI_DONE_INTRS)
    526  1.1  augustss 			intrs |= OREAD4(sc, OHCI_INTERRUPT_STATUS);
    527  1.1  augustss 	} else
    528  1.1  augustss 		intrs = OREAD4(sc, OHCI_INTERRUPT_STATUS);
    529  1.1  augustss 	if (!intrs)
    530  1.1  augustss 		return (0);
    531  1.1  augustss 	intrs &= ~OHCI_MIE;
    532  1.1  augustss 	OWRITE4(sc, OHCI_INTERRUPT_STATUS, intrs); /* Acknowledge */
    533  1.1  augustss 	eintrs = intrs & sc->sc_eintrs;
    534  1.1  augustss 	if (!eintrs)
    535  1.1  augustss 		return (0);
    536  1.1  augustss 
    537  1.1  augustss 	sc->sc_intrs++;
    538  1.1  augustss 	DPRINTFN(7, ("ohci_intr: sc=%p intrs=%x(%x) eintr=%x\n",
    539  1.1  augustss 		     sc, (u_int)intrs, OREAD4(sc, OHCI_INTERRUPT_STATUS),
    540  1.1  augustss 		     (u_int)eintrs));
    541  1.1  augustss 
    542  1.1  augustss 	if (eintrs & OHCI_SO) {
    543  1.1  augustss 		printf("%s: scheduling overrun\n", sc->sc_bus.bdev.dv_xname);
    544  1.1  augustss 		/* XXX do what */
    545  1.1  augustss 		intrs &= ~OHCI_SO;
    546  1.1  augustss 	}
    547  1.1  augustss 	if (eintrs & OHCI_WDH) {
    548  1.1  augustss 		ohci_process_done(sc, done &~ OHCI_DONE_INTRS);
    549  1.1  augustss 		sc->sc_hcca->hcca_done_head = 0;
    550  1.1  augustss 		intrs &= ~OHCI_WDH;
    551  1.1  augustss 	}
    552  1.1  augustss 	if (eintrs & OHCI_RD) {
    553  1.1  augustss 		/* XXX process resume detect */
    554  1.1  augustss 	}
    555  1.1  augustss 	if (eintrs & OHCI_UE) {
    556  1.1  augustss 		printf("%s: unrecoverable error, controller halted\n",
    557  1.1  augustss 		       sc->sc_bus.bdev.dv_xname);
    558  1.1  augustss 		OWRITE4(sc, OHCI_CONTROL, OHCI_HCFS_RESET);
    559  1.1  augustss 		/* XXX what else */
    560  1.1  augustss 	}
    561  1.1  augustss 	if (eintrs & OHCI_RHSC) {
    562  1.1  augustss 		ohci_rhsc(sc, sc->sc_intrreqh);
    563  1.1  augustss 		intrs &= ~OHCI_RHSC;
    564  1.1  augustss 
    565  1.1  augustss 		/*
    566  1.1  augustss 		 * Disable RHSC interrupt for now, because it will be
    567  1.1  augustss 		 * on until the port has been reset.
    568  1.1  augustss 		 */
    569  1.1  augustss 		ohci_rhsc_able(sc, 0);
    570  1.1  augustss 	}
    571  1.1  augustss 
    572  1.1  augustss 	/* Block unprocessed interrupts. XXX */
    573  1.1  augustss 	OWRITE4(sc, OHCI_INTERRUPT_DISABLE, intrs);
    574  1.1  augustss 	sc->sc_eintrs &= ~intrs;
    575  1.1  augustss 
    576  1.1  augustss 	return (1);
    577  1.1  augustss }
    578  1.1  augustss 
    579  1.1  augustss void
    580  1.1  augustss ohci_rhsc_able(sc, on)
    581  1.1  augustss 	ohci_softc_t *sc;
    582  1.1  augustss 	int on;
    583  1.1  augustss {
    584  1.1  augustss 	DPRINTFN(4, ("ohci_rhsc_able: on=%d\n", on));
    585  1.1  augustss 	if (on) {
    586  1.1  augustss 		sc->sc_eintrs |= OHCI_RHSC;
    587  1.1  augustss 		OWRITE4(sc, OHCI_INTERRUPT_ENABLE, OHCI_RHSC);
    588  1.1  augustss 	} else {
    589  1.1  augustss 		sc->sc_eintrs &= ~OHCI_RHSC;
    590  1.1  augustss 		OWRITE4(sc, OHCI_INTERRUPT_DISABLE, OHCI_RHSC);
    591  1.1  augustss 	}
    592  1.1  augustss }
    593  1.1  augustss 
    594  1.1  augustss void
    595  1.1  augustss ohci_process_done(sc, done)
    596  1.1  augustss 	ohci_softc_t *sc;
    597  1.1  augustss 	ohci_physaddr_t done;
    598  1.1  augustss {
    599  1.1  augustss 	ohci_soft_td_t *std, *sdone;
    600  1.1  augustss 	usbd_request_handle reqh;
    601  1.1  augustss 	int len, cc;
    602  1.1  augustss 
    603  1.1  augustss 	DPRINTFN(10,("ohci_process_done: done=0x%08lx\n", (u_long)done));
    604  1.1  augustss 
    605  1.1  augustss 	/* Reverse the done list. */
    606  1.1  augustss 	for (sdone = 0; done; done = std->td->td_nexttd) {
    607  1.1  augustss 		std = ohci_hash_find_td(sc, done);
    608  1.1  augustss 		std->dnext = sdone;
    609  1.1  augustss 		sdone = std;
    610  1.1  augustss 	}
    611  1.1  augustss 
    612  1.1  augustss #ifdef USB_DEBUG
    613  1.1  augustss 	if (ohcidebug > 10) {
    614  1.1  augustss 		printf("ohci_process_done: TD done:\n");
    615  1.1  augustss 		ohci_dump_tds(sdone);
    616  1.1  augustss 	}
    617  1.1  augustss #endif
    618  1.1  augustss 
    619  1.1  augustss 	for (std = sdone; std; std = std->dnext) {
    620  1.1  augustss 		reqh = std->reqh;
    621  1.1  augustss 		DPRINTFN(10, ("ohci_process_done: std=%p reqh=%p\n",std,reqh));
    622  1.1  augustss 		cc = OHCI_TD_GET_CC(std->td->td_flags);
    623  1.1  augustss 		if (cc == OHCI_CC_NO_ERROR) {
    624  1.1  augustss 			if (std->td->td_cbp == 0)
    625  1.1  augustss 				len = std->len;
    626  1.1  augustss 			else
    627  1.1  augustss 				len = std->td->td_be - std->td->td_cbp + 1;
    628  1.1  augustss 			reqh->actlen += len;
    629  1.1  augustss 			if (reqh->hcpriv == std) {
    630  1.1  augustss 				switch (reqh->pipe->endpoint->edesc->bmAttributes & UE_XFERTYPE) {
    631  1.1  augustss 				case UE_CONTROL:
    632  1.1  augustss 					ohci_ctrl_done(sc, reqh);
    633  1.1  augustss 					break;
    634  1.1  augustss 				case UE_INTERRUPT:
    635  1.1  augustss 					ohci_intr_done(sc, reqh);
    636  1.1  augustss 					break;
    637  1.1  augustss 				case UE_BULK:
    638  1.3  augustss 					ohci_bulk_done(sc, reqh);
    639  1.1  augustss 					break;
    640  1.1  augustss 				case UE_ISOCHRONOUS:
    641  1.1  augustss 					printf("ohci_process_done: ISO done?\n");
    642  1.1  augustss 					break;
    643  1.1  augustss 				}
    644  1.1  augustss 				/* And finally execute callback. */
    645  1.1  augustss 				reqh->status = USBD_NORMAL_COMPLETION;
    646  1.1  augustss 				reqh->xfercb(reqh);
    647  1.1  augustss 			}
    648  1.1  augustss 		} else {
    649  1.1  augustss 			ohci_soft_td_t *p, *n;
    650  1.1  augustss 			struct ohci_pipe *opipe =
    651  1.1  augustss 				(struct ohci_pipe *)reqh->pipe;
    652  1.1  augustss 			DPRINTFN(-1,("ohci_process_done: error cc=%d\n",
    653  1.1  augustss 				     OHCI_TD_GET_CC(std->td->td_flags)));
    654  1.1  augustss 			/*
    655  1.1  augustss 			 * Endpoint is halted.  First unlink all the TDs
    656  1.1  augustss 			 * belonging to the failed transfer, and then restart
    657  1.1  augustss 			 * the endpoint.
    658  1.1  augustss 			 */
    659  1.1  augustss 			for (p = std->nexttd; p->reqh == reqh; p = n) {
    660  1.1  augustss 				n = p->nexttd;
    661  1.1  augustss 				ohci_hash_rem_td(sc, p);
    662  1.1  augustss 				ohci_free_std(sc, p);
    663  1.1  augustss 			}
    664  1.1  augustss 			opipe->sed->ed->ed_headp = p->physaddr;/* clear halt */
    665  1.1  augustss 			OWRITE4(sc, OHCI_COMMAND_STATUS, OHCI_CLF);
    666  1.1  augustss 
    667  1.1  augustss 			if (cc == OHCI_CC_STALL)
    668  1.1  augustss 				reqh->status = USBD_STALLED;
    669  1.1  augustss 			else
    670  1.1  augustss 				reqh->status = USBD_IOERROR;
    671  1.1  augustss 			reqh->xfercb(reqh);
    672  1.1  augustss 		}
    673  1.1  augustss 		ohci_hash_rem_td(sc, std);
    674  1.1  augustss 		ohci_free_std(sc, std);
    675  1.1  augustss 	}
    676  1.1  augustss }
    677  1.1  augustss 
    678  1.1  augustss void
    679  1.1  augustss ohci_ctrl_done(sc, reqh)
    680  1.1  augustss 	ohci_softc_t *sc;
    681  1.1  augustss 	usbd_request_handle reqh;
    682  1.1  augustss {
    683  1.1  augustss 	struct ohci_pipe *opipe = (struct ohci_pipe *)reqh->pipe;
    684  1.1  augustss 	u_int len = opipe->u.ctl.length;
    685  1.4  augustss 	usb_dma_t *dma;
    686  1.1  augustss 
    687  1.1  augustss 	DPRINTFN(10,("ohci_ctrl_done: reqh=%p\n", reqh));
    688  1.1  augustss 
    689  1.1  augustss 	if (!reqh->isreq) {
    690  1.1  augustss 		panic("uhci_ctrl_done: not a request\n");
    691  1.1  augustss 		return;
    692  1.1  augustss 	}
    693  1.1  augustss 
    694  1.1  augustss 	if (len != 0) {
    695  1.1  augustss 		dma = &opipe->u.ctl.datadma;
    696  1.1  augustss 		if (reqh->request.bmRequestType & UT_READ)
    697  1.1  augustss 			memcpy(reqh->buffer, KERNADDR(dma), len);
    698  1.4  augustss 		usb_freemem(sc->sc_dmatag, dma);
    699  1.1  augustss 	}
    700  1.1  augustss }
    701  1.1  augustss 
    702  1.1  augustss void
    703  1.1  augustss ohci_intr_done(sc, reqh)
    704  1.1  augustss 	ohci_softc_t *sc;
    705  1.1  augustss 	usbd_request_handle reqh;
    706  1.1  augustss {
    707  1.1  augustss 	struct ohci_pipe *opipe = (struct ohci_pipe *)reqh->pipe;
    708  1.4  augustss 	usb_dma_t *dma;
    709  1.1  augustss 	ohci_soft_ed_t *sed = opipe->sed;
    710  1.1  augustss 	ohci_soft_td_t *xfer, *tail;
    711  1.1  augustss 
    712  1.1  augustss 
    713  1.1  augustss 	DPRINTFN(10,("ohci_intr_done: reqh=%p, actlen=%d\n",
    714  1.1  augustss 		     reqh, reqh->actlen));
    715  1.1  augustss 
    716  1.1  augustss 	dma = &opipe->u.intr.datadma;
    717  1.1  augustss 	memcpy(reqh->buffer, KERNADDR(dma), reqh->actlen);
    718  1.1  augustss 
    719  1.1  augustss 	if (reqh->pipe->intrreqh == reqh) {
    720  1.1  augustss 		xfer = opipe->tail;
    721  1.1  augustss 		tail = ohci_alloc_std(sc); /* XXX should reuse TD */
    722  1.1  augustss 		if (!tail) {
    723  1.1  augustss 			reqh->status = USBD_NOMEM;
    724  1.1  augustss 			return;
    725  1.1  augustss 		}
    726  1.1  augustss 		tail->reqh = 0;
    727  1.1  augustss 
    728  1.1  augustss 		xfer->td->td_flags = OHCI_TD_IN | OHCI_TD_NOCC |
    729  1.1  augustss 			OHCI_TD_SET_DI(1) | OHCI_TD_TOGGLE_CARRY;
    730  1.1  augustss 		xfer->td->td_cbp = DMAADDR(dma);
    731  1.1  augustss 		xfer->nexttd = tail;
    732  1.1  augustss 		xfer->td->td_nexttd = tail->physaddr;
    733  1.1  augustss 		xfer->td->td_be = xfer->td->td_cbp + reqh->length - 1;
    734  1.1  augustss 		xfer->len = reqh->length;
    735  1.1  augustss 		xfer->reqh = reqh;
    736  1.1  augustss 
    737  1.1  augustss 		reqh->actlen = 0;
    738  1.1  augustss 		reqh->hcpriv = xfer;
    739  1.1  augustss 
    740  1.1  augustss 		ohci_hash_add_td(sc, xfer);
    741  1.1  augustss 		sed->ed->ed_tailp = tail->physaddr;
    742  1.1  augustss 		opipe->tail = tail;
    743  1.1  augustss 	} else {
    744  1.4  augustss 		usb_freemem(sc->sc_dmatag, dma);
    745  1.1  augustss 	}
    746  1.1  augustss }
    747  1.1  augustss 
    748  1.1  augustss void
    749  1.3  augustss ohci_bulk_done(sc, reqh)
    750  1.3  augustss 	ohci_softc_t *sc;
    751  1.3  augustss 	usbd_request_handle reqh;
    752  1.3  augustss {
    753  1.3  augustss 	struct ohci_pipe *opipe = (struct ohci_pipe *)reqh->pipe;
    754  1.4  augustss 	usb_dma_t *dma;
    755  1.3  augustss 
    756  1.3  augustss 
    757  1.3  augustss 	DPRINTFN(10,("ohci_bulk_done: reqh=%p, actlen=%d\n",
    758  1.3  augustss 		     reqh, reqh->actlen));
    759  1.3  augustss 
    760  1.3  augustss 	dma = &opipe->u.bulk.datadma;
    761  1.3  augustss 	if (reqh->request.bmRequestType & UT_READ)
    762  1.3  augustss 		memcpy(reqh->buffer, KERNADDR(dma), reqh->actlen);
    763  1.4  augustss 	usb_freemem(sc->sc_dmatag, dma);
    764  1.3  augustss }
    765  1.3  augustss 
    766  1.3  augustss void
    767  1.1  augustss ohci_rhsc(sc, reqh)
    768  1.1  augustss 	ohci_softc_t *sc;
    769  1.1  augustss 	usbd_request_handle reqh;
    770  1.1  augustss {
    771  1.1  augustss 	usbd_pipe_handle pipe;
    772  1.1  augustss 	struct ohci_pipe *opipe;
    773  1.1  augustss 	u_char *p;
    774  1.1  augustss 	int i, m;
    775  1.1  augustss 	int hstatus;
    776  1.1  augustss 
    777  1.1  augustss 	hstatus = OREAD4(sc, OHCI_RH_STATUS);
    778  1.1  augustss 	DPRINTF(("ohci_rhsc: sc=%p reqh=%p hstatus=0x%08x\n",
    779  1.1  augustss 		 sc, reqh, hstatus));
    780  1.1  augustss 
    781  1.1  augustss 	if (reqh == 0) {
    782  1.1  augustss 		/* Just ignore the change. */
    783  1.1  augustss 		return;
    784  1.1  augustss 	}
    785  1.1  augustss 
    786  1.1  augustss 	pipe = reqh->pipe;
    787  1.1  augustss 	opipe = (struct ohci_pipe *)pipe;
    788  1.1  augustss 
    789  1.1  augustss 	p = KERNADDR(&opipe->u.intr.datadma);
    790  1.1  augustss 	m = min(sc->sc_noport, reqh->length * 8 - 1);
    791  1.1  augustss 	memset(p, 0, reqh->length);
    792  1.1  augustss 	for (i = 1; i <= m; i++) {
    793  1.1  augustss 		if (OREAD4(sc, OHCI_RH_PORT_STATUS(i)) >> 16)
    794  1.1  augustss 			p[i/8] |= 1 << (i%8);
    795  1.1  augustss 	}
    796  1.1  augustss 	DPRINTF(("ohci_rhsc: change=0x%02x\n", *p));
    797  1.1  augustss 	reqh->actlen = reqh->length;
    798  1.1  augustss 	reqh->status = USBD_NORMAL_COMPLETION;
    799  1.1  augustss 	reqh->xfercb(reqh);
    800  1.1  augustss 
    801  1.1  augustss 	if (reqh->pipe->intrreqh != reqh) {
    802  1.1  augustss 		sc->sc_intrreqh = 0;
    803  1.4  augustss 		usb_freemem(sc->sc_dmatag, &opipe->u.intr.datadma);
    804  1.1  augustss 	}
    805  1.1  augustss }
    806  1.1  augustss 
    807  1.1  augustss /*
    808  1.1  augustss  * Wait here until controller claims to have an interrupt.
    809  1.1  augustss  * Then call ohci_intr and return.  Use timeout to avoid waiting
    810  1.1  augustss  * too long.
    811  1.1  augustss  */
    812  1.1  augustss void
    813  1.1  augustss ohci_waitintr(sc, reqh)
    814  1.1  augustss 	ohci_softc_t *sc;
    815  1.1  augustss 	usbd_request_handle reqh;
    816  1.1  augustss {
    817  1.1  augustss 	int timo = reqh->timeout;
    818  1.1  augustss 	int usecs;
    819  1.1  augustss 	u_int32_t intrs;
    820  1.1  augustss 
    821  1.1  augustss 	reqh->status = USBD_IN_PROGRESS;
    822  1.1  augustss 	for (usecs = timo * 1000000 / hz; usecs > 0; usecs -= 1000) {
    823  1.1  augustss 		delay(1000);
    824  1.1  augustss 		intrs = OREAD4(sc, OHCI_INTERRUPT_STATUS) & sc->sc_eintrs;
    825  1.1  augustss 		DPRINTFN(10,("ohci_waitintr: 0x%04x\n", intrs));
    826  1.1  augustss #ifdef USB_DEBUG
    827  1.1  augustss 		if (ohcidebug > 15)
    828  1.1  augustss 			ohci_dumpregs(sc);
    829  1.1  augustss #endif
    830  1.1  augustss 		if (intrs) {
    831  1.1  augustss 			ohci_intr(sc);
    832  1.1  augustss 			if (reqh->status != USBD_IN_PROGRESS)
    833  1.1  augustss 				return;
    834  1.1  augustss 		}
    835  1.1  augustss 	}
    836  1.1  augustss 	DPRINTF(("ohci_waitintr: timeout\n"));
    837  1.1  augustss 	reqh->status = USBD_TIMEOUT;
    838  1.1  augustss 	reqh->xfercb(reqh);
    839  1.5  augustss }
    840  1.5  augustss 
    841  1.5  augustss void
    842  1.5  augustss ohci_poll(bus)
    843  1.5  augustss 	struct usbd_bus *bus;
    844  1.5  augustss {
    845  1.5  augustss 	ohci_softc_t *sc = (ohci_softc_t *)bus;
    846  1.5  augustss 
    847  1.5  augustss 	if (OREAD4(sc, OHCI_INTERRUPT_STATUS) & sc->sc_eintrs)
    848  1.5  augustss 		ohci_intr(sc);
    849  1.1  augustss }
    850  1.1  augustss 
    851  1.1  augustss usbd_status
    852  1.1  augustss ohci_device_request(reqh)
    853  1.1  augustss 	usbd_request_handle reqh;
    854  1.1  augustss {
    855  1.1  augustss 	struct ohci_pipe *opipe = (struct ohci_pipe *)reqh->pipe;
    856  1.1  augustss 	usb_device_request_t *req = &reqh->request;
    857  1.1  augustss 	usbd_device_handle dev = opipe->pipe.device;
    858  1.1  augustss 	ohci_softc_t *sc = (ohci_softc_t *)dev->bus;
    859  1.1  augustss 	int addr = dev->address;
    860  1.1  augustss 	ohci_soft_td_t *setup, *xfer = 0, *stat, *next, *tail;
    861  1.1  augustss 	ohci_soft_ed_t *sed;
    862  1.4  augustss 	usb_dma_t *dmap;
    863  1.1  augustss 	int isread;
    864  1.1  augustss 	int len;
    865  1.1  augustss 	usbd_status r;
    866  1.1  augustss 	int s;
    867  1.1  augustss 
    868  1.1  augustss 	isread = req->bmRequestType & UT_READ;
    869  1.1  augustss 	len = UGETW(req->wLength);
    870  1.1  augustss 
    871  1.1  augustss 	DPRINTFN(3,("ohci_device_control type=0x%02x, request=0x%02x, wValue=0x%04x, wIndex=0x%04x len=%d, addr=%d, endpt=%d\n",
    872  1.1  augustss 		    req->bmRequestType, req->bRequest, UGETW(req->wValue),
    873  1.1  augustss 		    UGETW(req->wIndex), len, addr,
    874  1.1  augustss 		    opipe->pipe.endpoint->edesc->bEndpointAddress));
    875  1.1  augustss 
    876  1.1  augustss 	setup = opipe->tail;
    877  1.1  augustss 	stat = ohci_alloc_std(sc);
    878  1.1  augustss 	if (!stat) {
    879  1.1  augustss 		r = USBD_NOMEM;
    880  1.1  augustss 		goto bad1;
    881  1.1  augustss 	}
    882  1.1  augustss 	tail = ohci_alloc_std(sc);
    883  1.1  augustss 	if (!tail) {
    884  1.1  augustss 		r = USBD_NOMEM;
    885  1.1  augustss 		goto bad2;
    886  1.1  augustss 	}
    887  1.1  augustss 	tail->reqh = 0;
    888  1.1  augustss 
    889  1.1  augustss 	sed = opipe->sed;
    890  1.1  augustss 	dmap = &opipe->u.ctl.datadma;
    891  1.1  augustss 	opipe->u.ctl.length = len;
    892  1.1  augustss 
    893  1.1  augustss 	/* Update device address */
    894  1.1  augustss 	sed->ed->ed_flags =
    895  1.1  augustss 		(sed->ed->ed_flags & ~OHCI_ED_ADDRMASK) |
    896  1.1  augustss 		OHCI_ED_SET_FA(addr);
    897  1.1  augustss 
    898  1.1  augustss 	/* Set up data transaction */
    899  1.1  augustss 	if (len != 0) {
    900  1.1  augustss 		xfer = ohci_alloc_std(sc);
    901  1.1  augustss 		if (!xfer) {
    902  1.1  augustss 			r = USBD_NOMEM;
    903  1.1  augustss 			goto bad3;
    904  1.1  augustss 		}
    905  1.4  augustss 		r = usb_allocmem(sc->sc_dmatag, len, 0, dmap);
    906  1.1  augustss 		if (r != USBD_NORMAL_COMPLETION)
    907  1.1  augustss 			goto bad4;
    908  1.1  augustss 		xfer->td->td_flags =
    909  1.1  augustss 			(isread ? OHCI_TD_IN : OHCI_TD_OUT) | OHCI_TD_NOCC |
    910  1.1  augustss 			OHCI_TD_TOGGLE_1 | OHCI_TD_NOINTR;
    911  1.1  augustss 		xfer->td->td_cbp = DMAADDR(dmap);
    912  1.1  augustss 		xfer->nexttd = stat;
    913  1.1  augustss 		xfer->td->td_nexttd = stat->physaddr;
    914  1.1  augustss 		xfer->td->td_be = xfer->td->td_cbp + len - 1;
    915  1.1  augustss 		xfer->len = len;
    916  1.1  augustss 		xfer->reqh = reqh;
    917  1.1  augustss 
    918  1.1  augustss 		next = xfer;
    919  1.1  augustss 	} else
    920  1.1  augustss 		next = stat;
    921  1.1  augustss 
    922  1.1  augustss 	memcpy(KERNADDR(&opipe->u.ctl.reqdma), req, sizeof *req);
    923  1.1  augustss 	if (!isread && len != 0)
    924  1.1  augustss 		memcpy(KERNADDR(dmap), reqh->buffer, len);
    925  1.1  augustss 
    926  1.1  augustss 	setup->td->td_flags = OHCI_TD_SETUP | OHCI_TD_NOCC |
    927  1.1  augustss 		              OHCI_TD_TOGGLE_0 | OHCI_TD_NOINTR;
    928  1.1  augustss 	setup->td->td_cbp = DMAADDR(&opipe->u.ctl.reqdma);
    929  1.1  augustss 	setup->nexttd = next;
    930  1.1  augustss 	setup->td->td_nexttd = next->physaddr;
    931  1.1  augustss 	setup->td->td_be = setup->td->td_cbp + sizeof *req - 1;
    932  1.1  augustss 	setup->len = 0;		/* XXX The number of byte we count */
    933  1.1  augustss 	setup->reqh = reqh;
    934  1.1  augustss 
    935  1.1  augustss 	stat->td->td_flags =
    936  1.1  augustss 		(isread ? OHCI_TD_OUT : OHCI_TD_IN) | OHCI_TD_NOCC |
    937  1.1  augustss 		OHCI_TD_TOGGLE_1 | OHCI_TD_SET_DI(1);
    938  1.1  augustss 	stat->td->td_cbp = 0;
    939  1.1  augustss 	stat->nexttd = tail;
    940  1.1  augustss 	stat->td->td_nexttd = tail->physaddr;
    941  1.1  augustss 	stat->td->td_be = 0;
    942  1.1  augustss 	stat->len = 0;
    943  1.1  augustss 	stat->reqh = reqh;
    944  1.1  augustss 
    945  1.1  augustss 	reqh->actlen = 0;
    946  1.1  augustss 	reqh->hcpriv = stat;
    947  1.1  augustss 
    948  1.1  augustss #if USB_DEBUG
    949  1.1  augustss 	if (ohcidebug > 5) {
    950  1.1  augustss 		printf("ohci_device_request:\n");
    951  1.1  augustss 		ohci_dump_ed(sed);
    952  1.1  augustss 		ohci_dump_tds(setup);
    953  1.1  augustss 	}
    954  1.1  augustss #endif
    955  1.1  augustss 
    956  1.1  augustss 	/* Insert ED in schedule */
    957  1.1  augustss 	s = splusb();
    958  1.1  augustss 	ohci_hash_add_td(sc, setup);
    959  1.1  augustss 	if (len != 0)
    960  1.1  augustss 		ohci_hash_add_td(sc, xfer);
    961  1.1  augustss 	ohci_hash_add_td(sc, stat);
    962  1.1  augustss 	sed->ed->ed_tailp = tail->physaddr;
    963  1.1  augustss 	opipe->tail = tail;
    964  1.1  augustss 	OWRITE4(sc, OHCI_COMMAND_STATUS, OHCI_CLF);
    965  1.1  augustss 	if (reqh->timeout && !usbd_use_polling)
    966  1.1  augustss 		timeout(ohci_timeout, reqh, MS_TO_TICKS(reqh->timeout));
    967  1.1  augustss 	splx(s);
    968  1.1  augustss 
    969  1.1  augustss #if USB_DEBUG
    970  1.1  augustss 	if (ohcidebug > 5) {
    971  1.1  augustss 		delay(5000);
    972  1.1  augustss 		printf("ohci_device_request: status=%x\n",
    973  1.1  augustss 		       OREAD4(sc, OHCI_COMMAND_STATUS));
    974  1.1  augustss 		ohci_dump_ed(sed);
    975  1.1  augustss 		ohci_dump_tds(setup);
    976  1.1  augustss 	}
    977  1.1  augustss #endif
    978  1.1  augustss 
    979  1.1  augustss 	return (USBD_NORMAL_COMPLETION);
    980  1.1  augustss 
    981  1.1  augustss  bad4:
    982  1.1  augustss 	ohci_free_std(sc, xfer);
    983  1.1  augustss  bad3:
    984  1.1  augustss 	ohci_free_std(sc, tail);
    985  1.1  augustss  bad2:
    986  1.1  augustss 	ohci_free_std(sc, stat);
    987  1.1  augustss  bad1:
    988  1.1  augustss 	return (r);
    989  1.1  augustss }
    990  1.1  augustss 
    991  1.1  augustss /*
    992  1.1  augustss  * Add an ED to the schedule.  Called at splusb().
    993  1.1  augustss  */
    994  1.1  augustss void
    995  1.3  augustss ohci_add_ed(sed, head)
    996  1.1  augustss 	ohci_soft_ed_t *sed;
    997  1.1  augustss 	ohci_soft_ed_t *head;
    998  1.1  augustss {
    999  1.1  augustss 	sed->next = head->next;
   1000  1.1  augustss 	sed->ed->ed_nexted = head->ed->ed_nexted;
   1001  1.1  augustss 	head->next = sed;
   1002  1.1  augustss 	head->ed->ed_nexted = sed->physaddr;
   1003  1.1  augustss }
   1004  1.1  augustss 
   1005  1.1  augustss /*
   1006  1.3  augustss  * Remove an ED from the schedule.  Called at splusb().
   1007  1.3  augustss  */
   1008  1.3  augustss void
   1009  1.3  augustss ohci_rem_ed(sed, head)
   1010  1.3  augustss 	ohci_soft_ed_t *sed;
   1011  1.3  augustss 	ohci_soft_ed_t *head;
   1012  1.3  augustss {
   1013  1.3  augustss 	ohci_soft_ed_t *p;
   1014  1.3  augustss 
   1015  1.3  augustss 	/* XXX */
   1016  1.3  augustss 	for (p = head; p && p->next != sed; p = p->next)
   1017  1.3  augustss 		;
   1018  1.3  augustss 	if (!p)
   1019  1.3  augustss 		panic("ohci_rem_ed: ED not found\n");
   1020  1.3  augustss 	p->next = sed->next;
   1021  1.3  augustss 	p->ed->ed_nexted = sed->ed->ed_nexted;
   1022  1.3  augustss }
   1023  1.3  augustss 
   1024  1.3  augustss /*
   1025  1.1  augustss  * When a transfer is completed the TD is added to the done queue by
   1026  1.1  augustss  * the host controller.  This queue is the processed by software.
   1027  1.1  augustss  * Unfortunately the queue contains the physical address of the TD
   1028  1.1  augustss  * and we have no simple way to translate this back a kernel address.
   1029  1.1  augustss  * To make the translation possible (and fast) we use a hash table of
   1030  1.1  augustss  * TDs currently in the schedule.  The physical address is used as the
   1031  1.1  augustss  * hash value.
   1032  1.1  augustss  */
   1033  1.1  augustss 
   1034  1.1  augustss #define HASH(a) (((a) >> 4) % OHCI_HASH_SIZE)
   1035  1.1  augustss /* Called at splusb() */
   1036  1.1  augustss void
   1037  1.1  augustss ohci_hash_add_td(sc, std)
   1038  1.1  augustss 	ohci_softc_t *sc;
   1039  1.1  augustss 	ohci_soft_td_t *std;
   1040  1.1  augustss {
   1041  1.1  augustss 	int h = HASH(std->physaddr);
   1042  1.1  augustss 
   1043  1.1  augustss 	LIST_INSERT_HEAD(&sc->sc_hash_tds[h], std, hnext);
   1044  1.1  augustss }
   1045  1.1  augustss 
   1046  1.1  augustss /* Called at splusb() */
   1047  1.1  augustss void
   1048  1.1  augustss ohci_hash_rem_td(sc, std)
   1049  1.1  augustss 	ohci_softc_t *sc;
   1050  1.1  augustss 	ohci_soft_td_t *std;
   1051  1.1  augustss {
   1052  1.1  augustss 	LIST_REMOVE(std, hnext);
   1053  1.1  augustss }
   1054  1.1  augustss 
   1055  1.1  augustss ohci_soft_td_t *
   1056  1.1  augustss ohci_hash_find_td(sc, a)
   1057  1.1  augustss 	ohci_softc_t *sc;
   1058  1.1  augustss 	ohci_physaddr_t a;
   1059  1.1  augustss {
   1060  1.1  augustss 	int h = HASH(a);
   1061  1.1  augustss 	ohci_soft_td_t *std;
   1062  1.1  augustss 
   1063  1.1  augustss 	for (std = LIST_FIRST(&sc->sc_hash_tds[h]);
   1064  1.1  augustss 	     std != 0;
   1065  1.1  augustss 	     std = LIST_NEXT(std, hnext))
   1066  1.1  augustss 		if (std->physaddr == a)
   1067  1.1  augustss 			return (std);
   1068  1.1  augustss 	panic("ohci_hash_find_td: addr 0x%08lx not found\n", (u_long)a);
   1069  1.1  augustss }
   1070  1.1  augustss 
   1071  1.1  augustss void
   1072  1.1  augustss ohci_timeout(addr)
   1073  1.1  augustss 	void *addr;
   1074  1.1  augustss {
   1075  1.1  augustss #if 0
   1076  1.1  augustss 	usbd_request_handle *reqh = addr;
   1077  1.1  augustss 	int s;
   1078  1.1  augustss 
   1079  1.1  augustss 	DPRINTF(("ohci_timeout: reqh=%p\n", reqh));
   1080  1.1  augustss 	s = splusb();
   1081  1.1  augustss 	/* XXX need to inactivate TD before calling interrupt routine */
   1082  1.1  augustss 	ohci_XXX_done(reqh);
   1083  1.1  augustss 	splx(s);
   1084  1.1  augustss #endif
   1085  1.1  augustss }
   1086  1.1  augustss 
   1087  1.1  augustss #ifdef USB_DEBUG
   1088  1.1  augustss void
   1089  1.1  augustss ohci_dump_tds(std)
   1090  1.1  augustss 	ohci_soft_td_t *std;
   1091  1.1  augustss {
   1092  1.1  augustss 	for (; std; std = std->nexttd)
   1093  1.1  augustss 		ohci_dump_td(std);
   1094  1.1  augustss }
   1095  1.1  augustss 
   1096  1.1  augustss void
   1097  1.1  augustss ohci_dump_td(std)
   1098  1.1  augustss 	ohci_soft_td_t *std;
   1099  1.1  augustss {
   1100  1.1  augustss 	printf("TD(%p) at %08lx: %b delay=%d ec=%d cc=%d\ncbp=0x%08lx nexttd=0x%08lx be=0x%08lx\n",
   1101  1.1  augustss 	       std, (u_long)std->physaddr,
   1102  1.1  augustss 	       (u_long)std->td->td_flags,
   1103  1.1  augustss 	       "\20\23R\24OUT\25IN\31TOG1\32SETTOGGLE",
   1104  1.1  augustss 	       OHCI_TD_GET_DI(std->td->td_flags),
   1105  1.1  augustss 	       OHCI_TD_GET_EC(std->td->td_flags),
   1106  1.1  augustss 	       OHCI_TD_GET_CC(std->td->td_flags),
   1107  1.1  augustss 	       (u_long)std->td->td_cbp,
   1108  1.1  augustss 	       (u_long)std->td->td_nexttd, (u_long)std->td->td_be);
   1109  1.1  augustss }
   1110  1.1  augustss 
   1111  1.1  augustss void
   1112  1.1  augustss ohci_dump_ed(sed)
   1113  1.1  augustss 	ohci_soft_ed_t *sed;
   1114  1.1  augustss {
   1115  1.1  augustss 	printf("ED(%p) at %08lx: addr=%d endpt=%d maxp=%d %b\ntailp=0x%08lx headp=%b nexted=0x%08lx\n",
   1116  1.1  augustss 	       sed, (u_long)sed->physaddr,
   1117  1.1  augustss 	       OHCI_ED_GET_FA(sed->ed->ed_flags),
   1118  1.1  augustss 	       OHCI_ED_GET_EN(sed->ed->ed_flags),
   1119  1.1  augustss 	       OHCI_ED_GET_MAXP(sed->ed->ed_flags),
   1120  1.1  augustss 	       (u_long)sed->ed->ed_flags,
   1121  1.1  augustss 	       "\20\14OUT\15IN\16LOWSPEED\17SKIP\18ISO",
   1122  1.1  augustss 	       (u_long)sed->ed->ed_tailp,
   1123  1.1  augustss 	       (u_long)sed->ed->ed_headp, "\20\1HALT\2CARRY",
   1124  1.1  augustss 	       (u_long)sed->ed->ed_nexted);
   1125  1.1  augustss }
   1126  1.1  augustss #endif
   1127  1.1  augustss 
   1128  1.1  augustss usbd_status
   1129  1.1  augustss ohci_open(pipe)
   1130  1.1  augustss 	usbd_pipe_handle pipe;
   1131  1.1  augustss {
   1132  1.1  augustss 	usbd_device_handle dev = pipe->device;
   1133  1.1  augustss 	ohci_softc_t *sc = (ohci_softc_t *)dev->bus;
   1134  1.1  augustss 	usb_endpoint_descriptor_t *ed = pipe->endpoint->edesc;
   1135  1.1  augustss 	struct ohci_pipe *opipe = (struct ohci_pipe *)pipe;
   1136  1.1  augustss 	u_int8_t addr = dev->address;
   1137  1.1  augustss 	ohci_soft_ed_t *sed;
   1138  1.1  augustss 	ohci_soft_td_t *std;
   1139  1.1  augustss 	usbd_status r;
   1140  1.1  augustss 	int s;
   1141  1.1  augustss 
   1142  1.1  augustss 	DPRINTFN(1, ("ohci_open: pipe=%p, addr=%d, endpt=%d (%d)\n",
   1143  1.1  augustss 		     pipe, addr, ed->bEndpointAddress, sc->sc_addr));
   1144  1.1  augustss 	if (addr == sc->sc_addr) {
   1145  1.1  augustss 		switch (ed->bEndpointAddress) {
   1146  1.1  augustss 		case USB_CONTROL_ENDPOINT:
   1147  1.1  augustss 			pipe->methods = &ohci_root_ctrl_methods;
   1148  1.1  augustss 			break;
   1149  1.1  augustss 		case UE_IN | OHCI_INTR_ENDPT:
   1150  1.1  augustss 			pipe->methods = &ohci_root_intr_methods;
   1151  1.1  augustss 			break;
   1152  1.1  augustss 		default:
   1153  1.1  augustss 			return (USBD_INVAL);
   1154  1.1  augustss 		}
   1155  1.1  augustss 	} else {
   1156  1.1  augustss 		sed = ohci_alloc_sed(sc);
   1157  1.1  augustss 		if (sed == 0)
   1158  1.1  augustss 			goto bad0;
   1159  1.1  augustss 	        std = ohci_alloc_std(sc);
   1160  1.1  augustss 		if (std == 0)
   1161  1.1  augustss 			goto bad1;
   1162  1.1  augustss 		opipe->sed = sed;
   1163  1.1  augustss 		opipe->tail = std;
   1164  1.1  augustss 		sed->ed->ed_flags =
   1165  1.1  augustss 			OHCI_ED_SET_FA(addr) |
   1166  1.1  augustss 			OHCI_ED_SET_EN(ed->bEndpointAddress) |
   1167  1.1  augustss 			OHCI_ED_DIR_TD |
   1168  1.1  augustss 			(dev->lowspeed ? OHCI_ED_SPEED : 0) |
   1169  1.1  augustss 			((ed->bmAttributes & UE_XFERTYPE) == UE_ISOCHRONOUS ?
   1170  1.1  augustss 			 OHCI_ED_FORMAT_ISO : OHCI_ED_FORMAT_GEN) |
   1171  1.2  augustss 			OHCI_ED_SET_MAXP(UGETW(pipe->endpoint->edesc->wMaxPacketSize));
   1172  1.1  augustss 		sed->ed->ed_headp = sed->ed->ed_tailp = std->physaddr;
   1173  1.1  augustss 
   1174  1.1  augustss 		switch (ed->bmAttributes & UE_XFERTYPE) {
   1175  1.1  augustss 		case UE_CONTROL:
   1176  1.1  augustss 			pipe->methods = &ohci_device_ctrl_methods;
   1177  1.4  augustss 			r = usb_allocmem(sc->sc_dmatag,
   1178  1.4  augustss 					 sizeof(usb_device_request_t),
   1179  1.4  augustss 					 0, &opipe->u.ctl.reqdma);
   1180  1.1  augustss 			if (r != USBD_NORMAL_COMPLETION)
   1181  1.1  augustss 				goto bad;
   1182  1.1  augustss 			s = splusb();
   1183  1.3  augustss 			ohci_add_ed(sed, sc->sc_ctrl_head);
   1184  1.1  augustss 			splx(s);
   1185  1.1  augustss 			break;
   1186  1.1  augustss 		case UE_INTERRUPT:
   1187  1.1  augustss 			pipe->methods = &ohci_device_intr_methods;
   1188  1.1  augustss 			return (ohci_device_setintr(sc, opipe, ed->bInterval));
   1189  1.1  augustss 		case UE_ISOCHRONOUS:
   1190  1.1  augustss 			printf("ohci_open: open iso unimplemented\n");
   1191  1.1  augustss 			return (USBD_XXX);
   1192  1.1  augustss 		case UE_BULK:
   1193  1.3  augustss 			pipe->methods = &ohci_device_bulk_methods;
   1194  1.3  augustss 			s = splusb();
   1195  1.3  augustss 			ohci_add_ed(sed, sc->sc_bulk_head);
   1196  1.3  augustss 			splx(s);
   1197  1.3  augustss 			break;
   1198  1.1  augustss 		}
   1199  1.1  augustss 	}
   1200  1.1  augustss 	return (USBD_NORMAL_COMPLETION);
   1201  1.1  augustss 
   1202  1.1  augustss  bad:
   1203  1.1  augustss 	ohci_free_std(sc, std);
   1204  1.1  augustss  bad1:
   1205  1.1  augustss 	ohci_free_sed(sc, sed);
   1206  1.1  augustss  bad0:
   1207  1.1  augustss 	return (USBD_NOMEM);
   1208  1.1  augustss 
   1209  1.1  augustss }
   1210  1.1  augustss 
   1211  1.1  augustss /*
   1212  1.1  augustss  * Data structures and routines to emulate the root hub.
   1213  1.1  augustss  */
   1214  1.1  augustss usb_device_descriptor_t ohci_devd = {
   1215  1.1  augustss 	USB_DEVICE_DESCRIPTOR_SIZE,
   1216  1.1  augustss 	UDESC_DEVICE,		/* type */
   1217  1.1  augustss 	{0x00, 0x01},		/* USB version */
   1218  1.1  augustss 	UCLASS_HUB,		/* class */
   1219  1.1  augustss 	USUBCLASS_HUB,		/* subclass */
   1220  1.1  augustss 	0,			/* protocol */
   1221  1.1  augustss 	64,			/* max packet */
   1222  1.1  augustss 	{0},{0},{0x00,0x01},	/* device id */
   1223  1.1  augustss 	1,2,0,			/* string indicies */
   1224  1.1  augustss 	1			/* # of configurations */
   1225  1.1  augustss };
   1226  1.1  augustss 
   1227  1.1  augustss usb_config_descriptor_t ohci_confd = {
   1228  1.1  augustss 	USB_CONFIG_DESCRIPTOR_SIZE,
   1229  1.1  augustss 	UDESC_CONFIG,
   1230  1.1  augustss 	{USB_CONFIG_DESCRIPTOR_SIZE +
   1231  1.1  augustss 	 USB_INTERFACE_DESCRIPTOR_SIZE +
   1232  1.1  augustss 	 USB_ENDPOINT_DESCRIPTOR_SIZE},
   1233  1.1  augustss 	1,
   1234  1.1  augustss 	1,
   1235  1.1  augustss 	0,
   1236  1.1  augustss 	UC_SELF_POWERED,
   1237  1.1  augustss 	0			/* max power */
   1238  1.1  augustss };
   1239  1.1  augustss 
   1240  1.1  augustss usb_interface_descriptor_t ohci_ifcd = {
   1241  1.1  augustss 	USB_INTERFACE_DESCRIPTOR_SIZE,
   1242  1.1  augustss 	UDESC_INTERFACE,
   1243  1.1  augustss 	0,
   1244  1.1  augustss 	0,
   1245  1.1  augustss 	1,
   1246  1.1  augustss 	UCLASS_HUB,
   1247  1.1  augustss 	USUBCLASS_HUB,
   1248  1.1  augustss 	0,
   1249  1.1  augustss 	0
   1250  1.1  augustss };
   1251  1.1  augustss 
   1252  1.1  augustss usb_endpoint_descriptor_t ohci_endpd = {
   1253  1.1  augustss 	USB_ENDPOINT_DESCRIPTOR_SIZE,
   1254  1.1  augustss 	UDESC_ENDPOINT,
   1255  1.1  augustss 	UE_IN | OHCI_INTR_ENDPT,
   1256  1.1  augustss 	UE_INTERRUPT,
   1257  1.1  augustss 	{8, 0},			/* max packet */
   1258  1.1  augustss 	255
   1259  1.1  augustss };
   1260  1.1  augustss 
   1261  1.1  augustss usb_hub_descriptor_t ohci_hubd = {
   1262  1.1  augustss 	USB_HUB_DESCRIPTOR_SIZE,
   1263  1.1  augustss 	UDESC_HUB,
   1264  1.1  augustss 	0,
   1265  1.1  augustss 	{0,0},
   1266  1.1  augustss 	0,
   1267  1.1  augustss 	0,
   1268  1.1  augustss 	{0},
   1269  1.1  augustss 	{0},
   1270  1.1  augustss };
   1271  1.1  augustss 
   1272  1.1  augustss int
   1273  1.1  augustss ohci_str(p, l, s)
   1274  1.1  augustss 	usb_string_descriptor_t *p;
   1275  1.1  augustss 	int l;
   1276  1.1  augustss 	char *s;
   1277  1.1  augustss {
   1278  1.1  augustss 	int i;
   1279  1.1  augustss 
   1280  1.1  augustss 	if (l == 0)
   1281  1.1  augustss 		return (0);
   1282  1.1  augustss 	p->bLength = 2 * strlen(s) + 2;
   1283  1.1  augustss 	if (l == 1)
   1284  1.1  augustss 		return (1);
   1285  1.1  augustss 	p->bDescriptorType = UDESC_STRING;
   1286  1.1  augustss 	l -= 2;
   1287  1.1  augustss 	for (i = 0; s[i] && l > 1; i++, l -= 2)
   1288  1.1  augustss 		USETW2(p->bString[i], 0, s[i]);
   1289  1.1  augustss 	return (2*i+2);
   1290  1.1  augustss }
   1291  1.1  augustss 
   1292  1.1  augustss /*
   1293  1.1  augustss  * Simulate a hardware hub by handling all the necessary requests.
   1294  1.1  augustss  */
   1295  1.1  augustss usbd_status
   1296  1.1  augustss ohci_root_ctrl_transfer(reqh)
   1297  1.1  augustss 	usbd_request_handle reqh;
   1298  1.1  augustss {
   1299  1.1  augustss 	ohci_softc_t *sc = (ohci_softc_t *)reqh->pipe->device->bus;
   1300  1.1  augustss 	usb_device_request_t *req;
   1301  1.1  augustss 	void *buf;
   1302  1.1  augustss 	int port, i;
   1303  1.1  augustss 	int len, value, index, l, totlen = 0;
   1304  1.1  augustss 	usb_port_status_t ps;
   1305  1.1  augustss 	usb_hub_descriptor_t hubd;
   1306  1.1  augustss 	usbd_status r;
   1307  1.1  augustss 	u_int32_t v;
   1308  1.1  augustss 
   1309  1.1  augustss 	if (!reqh->isreq)
   1310  1.1  augustss 		/* XXX panic */
   1311  1.1  augustss 		return (USBD_INVAL);
   1312  1.1  augustss 	req = &reqh->request;
   1313  1.1  augustss 	buf = reqh->buffer;
   1314  1.1  augustss 
   1315  1.1  augustss 	DPRINTFN(4,("ohci_root_ctrl_control type=0x%02x request=%02x\n",
   1316  1.1  augustss 		    req->bmRequestType, req->bRequest));
   1317  1.1  augustss 
   1318  1.1  augustss 	len = UGETW(req->wLength);
   1319  1.1  augustss 	value = UGETW(req->wValue);
   1320  1.1  augustss 	index = UGETW(req->wIndex);
   1321  1.1  augustss #define C(x,y) ((x) | ((y) << 8))
   1322  1.1  augustss 	switch(C(req->bRequest, req->bmRequestType)) {
   1323  1.1  augustss 	case C(UR_CLEAR_FEATURE, UT_WRITE_DEVICE):
   1324  1.1  augustss 	case C(UR_CLEAR_FEATURE, UT_WRITE_INTERFACE):
   1325  1.1  augustss 	case C(UR_CLEAR_FEATURE, UT_WRITE_ENDPOINT):
   1326  1.1  augustss 		/*
   1327  1.1  augustss 		 * DEVICE_REMOTE_WAKEUP and ENDPOINT_STALL are no-ops
   1328  1.1  augustss 		 * for the integrated root hub.
   1329  1.1  augustss 		 */
   1330  1.1  augustss 		break;
   1331  1.1  augustss 	case C(UR_GET_CONFIG, UT_READ_DEVICE):
   1332  1.1  augustss 		if (len > 0) {
   1333  1.1  augustss 			*(u_int8_t *)buf = sc->sc_conf;
   1334  1.1  augustss 			totlen = 1;
   1335  1.1  augustss 		}
   1336  1.1  augustss 		break;
   1337  1.1  augustss 	case C(UR_GET_DESCRIPTOR, UT_READ_DEVICE):
   1338  1.1  augustss 		DPRINTFN(8,("ohci_root_ctrl_control wValue=0x%04x\n", value));
   1339  1.1  augustss 		switch(value >> 8) {
   1340  1.1  augustss 		case UDESC_DEVICE:
   1341  1.1  augustss 			if ((value & 0xff) != 0) {
   1342  1.1  augustss 				r = USBD_IOERROR;
   1343  1.1  augustss 				goto ret;
   1344  1.1  augustss 			}
   1345  1.1  augustss 			totlen = l = min(len, USB_DEVICE_DESCRIPTOR_SIZE);
   1346  1.1  augustss 			memcpy(buf, &ohci_devd, l);
   1347  1.1  augustss 			break;
   1348  1.1  augustss 		case UDESC_CONFIG:
   1349  1.1  augustss 			if ((value & 0xff) != 0) {
   1350  1.1  augustss 				r = USBD_IOERROR;
   1351  1.1  augustss 				goto ret;
   1352  1.1  augustss 			}
   1353  1.1  augustss 			totlen = l = min(len, USB_CONFIG_DESCRIPTOR_SIZE);
   1354  1.1  augustss 			memcpy(buf, &ohci_confd, l);
   1355  1.1  augustss 			buf = (char *)buf + l;
   1356  1.1  augustss 			len -= l;
   1357  1.1  augustss 			l = min(len, USB_INTERFACE_DESCRIPTOR_SIZE);
   1358  1.1  augustss 			totlen += l;
   1359  1.1  augustss 			memcpy(buf, &ohci_ifcd, l);
   1360  1.1  augustss 			buf = (char *)buf + l;
   1361  1.1  augustss 			len -= l;
   1362  1.1  augustss 			l = min(len, USB_ENDPOINT_DESCRIPTOR_SIZE);
   1363  1.1  augustss 			totlen += l;
   1364  1.1  augustss 			memcpy(buf, &ohci_endpd, l);
   1365  1.1  augustss 			break;
   1366  1.1  augustss 		case UDESC_STRING:
   1367  1.1  augustss 			if (len == 0)
   1368  1.1  augustss 				break;
   1369  1.1  augustss 			*(u_int8_t *)buf = 0;
   1370  1.1  augustss 			totlen = 1;
   1371  1.1  augustss 			switch (value & 0xff) {
   1372  1.1  augustss 			case 1: /* Vendor */
   1373  1.1  augustss 				totlen = ohci_str(buf, len, sc->sc_vendor);
   1374  1.1  augustss 				break;
   1375  1.1  augustss 			case 2: /* Product */
   1376  1.1  augustss 				totlen = ohci_str(buf, len, "OHCI root hub");
   1377  1.1  augustss 				break;
   1378  1.1  augustss 			}
   1379  1.1  augustss 			break;
   1380  1.1  augustss 		default:
   1381  1.1  augustss 			r = USBD_IOERROR;
   1382  1.1  augustss 			goto ret;
   1383  1.1  augustss 		}
   1384  1.1  augustss 		break;
   1385  1.1  augustss 	case C(UR_GET_INTERFACE, UT_READ_INTERFACE):
   1386  1.1  augustss 		if (len > 0) {
   1387  1.1  augustss 			*(u_int8_t *)buf = 0;
   1388  1.1  augustss 			totlen = 1;
   1389  1.1  augustss 		}
   1390  1.1  augustss 		break;
   1391  1.1  augustss 	case C(UR_GET_STATUS, UT_READ_DEVICE):
   1392  1.1  augustss 		if (len > 1) {
   1393  1.1  augustss 			USETW(((usb_status_t *)buf)->wStatus,UDS_SELF_POWERED);
   1394  1.1  augustss 			totlen = 2;
   1395  1.1  augustss 		}
   1396  1.1  augustss 		break;
   1397  1.1  augustss 	case C(UR_GET_STATUS, UT_READ_INTERFACE):
   1398  1.1  augustss 	case C(UR_GET_STATUS, UT_READ_ENDPOINT):
   1399  1.1  augustss 		if (len > 1) {
   1400  1.1  augustss 			USETW(((usb_status_t *)buf)->wStatus, 0);
   1401  1.1  augustss 			totlen = 2;
   1402  1.1  augustss 		}
   1403  1.1  augustss 		break;
   1404  1.1  augustss 	case C(UR_SET_ADDRESS, UT_WRITE_DEVICE):
   1405  1.1  augustss 		if (value >= USB_MAX_DEVICES) {
   1406  1.1  augustss 			r = USBD_IOERROR;
   1407  1.1  augustss 			goto ret;
   1408  1.1  augustss 		}
   1409  1.1  augustss 		sc->sc_addr = value;
   1410  1.1  augustss 		break;
   1411  1.1  augustss 	case C(UR_SET_CONFIG, UT_WRITE_DEVICE):
   1412  1.1  augustss 		if (value != 0 && value != 1) {
   1413  1.1  augustss 			r = USBD_IOERROR;
   1414  1.1  augustss 			goto ret;
   1415  1.1  augustss 		}
   1416  1.1  augustss 		sc->sc_conf = value;
   1417  1.1  augustss 		break;
   1418  1.1  augustss 	case C(UR_SET_DESCRIPTOR, UT_WRITE_DEVICE):
   1419  1.1  augustss 		break;
   1420  1.1  augustss 	case C(UR_SET_FEATURE, UT_WRITE_DEVICE):
   1421  1.1  augustss 	case C(UR_SET_FEATURE, UT_WRITE_INTERFACE):
   1422  1.1  augustss 	case C(UR_SET_FEATURE, UT_WRITE_ENDPOINT):
   1423  1.1  augustss 		r = USBD_IOERROR;
   1424  1.1  augustss 		goto ret;
   1425  1.1  augustss 	case C(UR_SET_INTERFACE, UT_WRITE_INTERFACE):
   1426  1.1  augustss 		break;
   1427  1.1  augustss 	case C(UR_SYNCH_FRAME, UT_WRITE_ENDPOINT):
   1428  1.1  augustss 		break;
   1429  1.1  augustss 	/* Hub requests */
   1430  1.1  augustss 	case C(UR_CLEAR_FEATURE, UT_WRITE_CLASS_DEVICE):
   1431  1.1  augustss 		break;
   1432  1.1  augustss 	case C(UR_CLEAR_FEATURE, UT_WRITE_CLASS_OTHER):
   1433  1.1  augustss 		DPRINTFN(8, ("ohci_root_ctrl_control: UR_CLEAR_PORT_FEATURE port=%d feature=%d\n",
   1434  1.1  augustss 			     index, value));
   1435  1.1  augustss 		if (index < 1 || index > sc->sc_noport) {
   1436  1.1  augustss 			r = USBD_IOERROR;
   1437  1.1  augustss 			goto ret;
   1438  1.1  augustss 		}
   1439  1.1  augustss 		port = OHCI_RH_PORT_STATUS(index);
   1440  1.1  augustss 		switch(value) {
   1441  1.1  augustss 		case UHF_PORT_ENABLE:
   1442  1.1  augustss 			OWRITE4(sc, port, UPS_CURRENT_CONNECT_STATUS);
   1443  1.1  augustss 			break;
   1444  1.1  augustss 		case UHF_PORT_SUSPEND:
   1445  1.1  augustss 			OWRITE4(sc, port, UPS_OVERCURRENT_INDICATOR);
   1446  1.1  augustss 			break;
   1447  1.1  augustss 		case UHF_PORT_POWER:
   1448  1.1  augustss 			OWRITE4(sc, port, UPS_LOW_SPEED);
   1449  1.1  augustss 			break;
   1450  1.1  augustss 		case UHF_C_PORT_CONNECTION:
   1451  1.1  augustss 			OWRITE4(sc, port, UPS_C_CONNECT_STATUS << 16);
   1452  1.1  augustss 			break;
   1453  1.1  augustss 		case UHF_C_PORT_ENABLE:
   1454  1.1  augustss 			OWRITE4(sc, port, UPS_C_PORT_ENABLED << 16);
   1455  1.1  augustss 			break;
   1456  1.1  augustss 		case UHF_C_PORT_SUSPEND:
   1457  1.1  augustss 			OWRITE4(sc, port, UPS_C_SUSPEND << 16);
   1458  1.1  augustss 			break;
   1459  1.1  augustss 		case UHF_C_PORT_OVER_CURRENT:
   1460  1.1  augustss 			OWRITE4(sc, port, UPS_C_OVERCURRENT_INDICATOR << 16);
   1461  1.1  augustss 			break;
   1462  1.1  augustss 		case UHF_C_PORT_RESET:
   1463  1.1  augustss 			OWRITE4(sc, port, UPS_C_PORT_RESET << 16);
   1464  1.1  augustss 			break;
   1465  1.1  augustss 		default:
   1466  1.1  augustss 			r = USBD_IOERROR;
   1467  1.1  augustss 			goto ret;
   1468  1.1  augustss 		}
   1469  1.1  augustss 		switch(value) {
   1470  1.1  augustss 		case UHF_C_PORT_CONNECTION:
   1471  1.1  augustss 		case UHF_C_PORT_ENABLE:
   1472  1.1  augustss 		case UHF_C_PORT_SUSPEND:
   1473  1.1  augustss 		case UHF_C_PORT_OVER_CURRENT:
   1474  1.1  augustss 		case UHF_C_PORT_RESET:
   1475  1.1  augustss 			/* Enable RHSC interrupt if condition is cleared. */
   1476  1.1  augustss 			if ((OREAD4(sc, port) >> 16) == 0)
   1477  1.1  augustss 				ohci_rhsc_able(sc, 1);
   1478  1.1  augustss 			break;
   1479  1.1  augustss 		default:
   1480  1.1  augustss 			break;
   1481  1.1  augustss 		}
   1482  1.1  augustss 		break;
   1483  1.1  augustss 	case C(UR_GET_DESCRIPTOR, UT_READ_CLASS_DEVICE):
   1484  1.1  augustss 		if (value != 0) {
   1485  1.1  augustss 			r = USBD_IOERROR;
   1486  1.1  augustss 			goto ret;
   1487  1.1  augustss 		}
   1488  1.1  augustss 		v = OREAD4(sc, OHCI_RH_DESCRIPTOR_A);
   1489  1.1  augustss 		hubd = ohci_hubd;
   1490  1.1  augustss 		hubd.bNbrPorts = sc->sc_noport;
   1491  1.1  augustss 		USETW(hubd.bHubCharacteristics,
   1492  1.1  augustss 		      (v & OHCI_NPS ? UHD_PWR_NO_SWITCH :
   1493  1.1  augustss 		       v & OHCI_PSM ? UHD_PWR_GANGED : UHD_PWR_INDIVIDUAL)
   1494  1.1  augustss 		      /* XXX overcurrent */
   1495  1.1  augustss 		      );
   1496  1.1  augustss 		hubd.bPwrOn2PwrGood = OHCI_GET_POTPGT(v);
   1497  1.1  augustss 		v = OREAD4(sc, OHCI_RH_DESCRIPTOR_B);
   1498  1.1  augustss 		if (sc->sc_noport < 8) {
   1499  1.1  augustss 			hubd.DeviceRemovable[0] = (u_int8_t)v;
   1500  1.1  augustss 			hubd.PortPowerCtrlMask[0] = (u_int8_t)(v >> 16);
   1501  1.1  augustss 			hubd.bDescLength = USB_HUB_DESCRIPTOR_SIZE;
   1502  1.1  augustss 		} else {
   1503  1.1  augustss 			hubd.DeviceRemovable[0] = (u_int8_t)v;
   1504  1.1  augustss 			hubd.DeviceRemovable[1] = (u_int8_t)(v>>8);
   1505  1.1  augustss 			hubd.PortPowerCtrlMask[1] = (u_int8_t)(v >> 16);
   1506  1.1  augustss 			hubd.PortPowerCtrlMask[2] = (u_int8_t)(v >> 24);
   1507  1.1  augustss 			hubd.bDescLength = USB_HUB_DESCRIPTOR_SIZE + 2;
   1508  1.1  augustss 		}
   1509  1.1  augustss 		l = min(len, hubd.bDescLength);
   1510  1.1  augustss 		totlen = l;
   1511  1.1  augustss 		memcpy(buf, &hubd, l);
   1512  1.1  augustss 		break;
   1513  1.1  augustss 	case C(UR_GET_STATUS, UT_READ_CLASS_DEVICE):
   1514  1.1  augustss 		if (len != 4) {
   1515  1.1  augustss 			r = USBD_IOERROR;
   1516  1.1  augustss 			goto ret;
   1517  1.1  augustss 		}
   1518  1.1  augustss 		memset(buf, 0, len); /* ? XXX */
   1519  1.1  augustss 		totlen = len;
   1520  1.1  augustss 		break;
   1521  1.1  augustss 	case C(UR_GET_STATUS, UT_READ_CLASS_OTHER):
   1522  1.1  augustss 		DPRINTFN(8,("ohci_root_ctrl_transfer: get port status i=%d\n",
   1523  1.1  augustss 			    index));
   1524  1.1  augustss 		if (index < 1 || index > sc->sc_noport) {
   1525  1.1  augustss 			r = USBD_IOERROR;
   1526  1.1  augustss 			goto ret;
   1527  1.1  augustss 		}
   1528  1.1  augustss 		if (len != 4) {
   1529  1.1  augustss 			r = USBD_IOERROR;
   1530  1.1  augustss 			goto ret;
   1531  1.1  augustss 		}
   1532  1.1  augustss 		v = OREAD4(sc, OHCI_RH_PORT_STATUS(index));
   1533  1.1  augustss 		DPRINTFN(8,("ohci_root_ctrl_transfer: port status=0x%04x\n",
   1534  1.1  augustss 			    v));
   1535  1.1  augustss 		USETW(ps.wPortStatus, v);
   1536  1.1  augustss 		USETW(ps.wPortChange, v >> 16);
   1537  1.1  augustss 		l = min(len, sizeof ps);
   1538  1.1  augustss 		memcpy(buf, &ps, l);
   1539  1.1  augustss 		totlen = l;
   1540  1.1  augustss 		break;
   1541  1.1  augustss 	case C(UR_SET_DESCRIPTOR, UT_WRITE_CLASS_DEVICE):
   1542  1.1  augustss 		r = USBD_IOERROR;
   1543  1.1  augustss 		goto ret;
   1544  1.1  augustss 	case C(UR_SET_FEATURE, UT_WRITE_CLASS_DEVICE):
   1545  1.1  augustss 		break;
   1546  1.1  augustss 	case C(UR_SET_FEATURE, UT_WRITE_CLASS_OTHER):
   1547  1.1  augustss 		if (index < 1 || index > sc->sc_noport) {
   1548  1.1  augustss 			r = USBD_IOERROR;
   1549  1.1  augustss 			goto ret;
   1550  1.1  augustss 		}
   1551  1.1  augustss 		port = OHCI_RH_PORT_STATUS(index);
   1552  1.1  augustss 		switch(value) {
   1553  1.1  augustss 		case UHF_PORT_ENABLE:
   1554  1.1  augustss 			OWRITE4(sc, port, UPS_PORT_ENABLED);
   1555  1.1  augustss 			break;
   1556  1.1  augustss 		case UHF_PORT_SUSPEND:
   1557  1.1  augustss 			OWRITE4(sc, port, UPS_SUSPEND);
   1558  1.1  augustss 			break;
   1559  1.1  augustss 		case UHF_PORT_RESET:
   1560  1.1  augustss 			DPRINTFN(5,("ohci_root_ctrl_transfer: reset port %d\n", index));
   1561  1.1  augustss 			OWRITE4(sc, port, UPS_RESET);
   1562  1.1  augustss 			for (i = 0; i < 10; i++) {
   1563  1.1  augustss 				usbd_delay_ms(10);
   1564  1.1  augustss 				if ((OREAD4(sc, port) & UPS_RESET) == 0)
   1565  1.1  augustss 					break;
   1566  1.1  augustss 			}
   1567  1.1  augustss 			DPRINTFN(8,("ohci port %d reset, status = 0x%04x\n",
   1568  1.1  augustss 				    index, OREAD4(sc, port)));
   1569  1.1  augustss 			break;
   1570  1.1  augustss 		case UHF_PORT_POWER:
   1571  1.1  augustss 			DPRINTFN(2,("ohci_root_ctrl_transfer: set port power %d\n", index));
   1572  1.1  augustss 			OWRITE4(sc, port, UPS_PORT_POWER);
   1573  1.1  augustss 			break;
   1574  1.1  augustss 		default:
   1575  1.1  augustss 			r = USBD_IOERROR;
   1576  1.1  augustss 			goto ret;
   1577  1.1  augustss 		}
   1578  1.1  augustss 		break;
   1579  1.1  augustss 	default:
   1580  1.1  augustss 		r = USBD_IOERROR;
   1581  1.1  augustss 		goto ret;
   1582  1.1  augustss 	}
   1583  1.1  augustss 	reqh->actlen = totlen;
   1584  1.1  augustss 	r = USBD_NORMAL_COMPLETION;
   1585  1.1  augustss  ret:
   1586  1.1  augustss 	reqh->status = r;
   1587  1.1  augustss 	reqh->xfercb(reqh);
   1588  1.1  augustss 	return (USBD_IN_PROGRESS);
   1589  1.1  augustss }
   1590  1.1  augustss 
   1591  1.1  augustss /* Abort a root control request. */
   1592  1.1  augustss void
   1593  1.1  augustss ohci_root_ctrl_abort(reqh)
   1594  1.1  augustss 	usbd_request_handle reqh;
   1595  1.1  augustss {
   1596  1.3  augustss 	/* Nothing to do, all transfers are syncronous. */
   1597  1.1  augustss }
   1598  1.1  augustss 
   1599  1.1  augustss /* Close the root pipe. */
   1600  1.1  augustss void
   1601  1.1  augustss ohci_root_ctrl_close(pipe)
   1602  1.1  augustss 	usbd_pipe_handle pipe;
   1603  1.1  augustss {
   1604  1.1  augustss 	DPRINTF(("ohci_root_ctrl_close\n"));
   1605  1.1  augustss }
   1606  1.1  augustss 
   1607  1.1  augustss usbd_status
   1608  1.1  augustss ohci_root_intr_transfer(reqh)
   1609  1.1  augustss 	usbd_request_handle reqh;
   1610  1.1  augustss {
   1611  1.1  augustss 	usbd_pipe_handle pipe = reqh->pipe;
   1612  1.1  augustss 	ohci_softc_t *sc = (ohci_softc_t *)pipe->device->bus;
   1613  1.1  augustss 	struct ohci_pipe *upipe = (struct ohci_pipe *)pipe;
   1614  1.4  augustss 	usb_dma_t *dmap;
   1615  1.1  augustss 	usbd_status r;
   1616  1.1  augustss 	int len;
   1617  1.1  augustss 
   1618  1.1  augustss 	len = reqh->length;
   1619  1.1  augustss 	dmap = &upipe->u.intr.datadma;
   1620  1.1  augustss 	if (len == 0)
   1621  1.1  augustss 		return (USBD_INVAL); /* XXX should it be? */
   1622  1.1  augustss 
   1623  1.4  augustss 	r = usb_allocmem(sc->sc_dmatag, len, 0, dmap);
   1624  1.1  augustss 	if (r != USBD_NORMAL_COMPLETION)
   1625  1.1  augustss 		return (r);
   1626  1.1  augustss 	sc->sc_intrreqh = reqh;
   1627  1.1  augustss 
   1628  1.1  augustss 	return (USBD_IN_PROGRESS);
   1629  1.1  augustss }
   1630  1.1  augustss 
   1631  1.3  augustss /* Abort a root interrupt request. */
   1632  1.1  augustss void
   1633  1.1  augustss ohci_root_intr_abort(reqh)
   1634  1.1  augustss 	usbd_request_handle reqh;
   1635  1.1  augustss {
   1636  1.3  augustss 	/* No need to abort. */
   1637  1.1  augustss }
   1638  1.1  augustss 
   1639  1.1  augustss /* Close the root pipe. */
   1640  1.1  augustss void
   1641  1.1  augustss ohci_root_intr_close(pipe)
   1642  1.1  augustss 	usbd_pipe_handle pipe;
   1643  1.1  augustss {
   1644  1.1  augustss 	ohci_softc_t *sc = (ohci_softc_t *)pipe->device->bus;
   1645  1.1  augustss 	sc->sc_intrreqh = 0;
   1646  1.1  augustss 
   1647  1.1  augustss 	DPRINTF(("ohci_root_intr_close\n"));
   1648  1.1  augustss }
   1649  1.1  augustss 
   1650  1.1  augustss /************************/
   1651  1.1  augustss 
   1652  1.1  augustss usbd_status
   1653  1.1  augustss ohci_device_ctrl_transfer(reqh)
   1654  1.1  augustss 	usbd_request_handle reqh;
   1655  1.1  augustss {
   1656  1.1  augustss 	usbd_status r;
   1657  1.1  augustss 
   1658  1.1  augustss 	if (!reqh->isreq) {
   1659  1.1  augustss 		/* XXX panic */
   1660  1.1  augustss 		printf("ohci_device_ctrl_transfer: not a request\n");
   1661  1.1  augustss 		return (USBD_INVAL);
   1662  1.1  augustss 	}
   1663  1.1  augustss 
   1664  1.1  augustss 	r = ohci_device_request(reqh);
   1665  1.1  augustss 	if (r != USBD_NORMAL_COMPLETION)
   1666  1.1  augustss 		return (r);
   1667  1.1  augustss 
   1668  1.1  augustss 	if (usbd_use_polling)
   1669  1.1  augustss 		ohci_waitintr((ohci_softc_t *)reqh->pipe->device->bus, reqh);
   1670  1.1  augustss 	return (USBD_IN_PROGRESS);
   1671  1.1  augustss }
   1672  1.1  augustss 
   1673  1.1  augustss /* Abort a device control request. */
   1674  1.1  augustss void
   1675  1.1  augustss ohci_device_ctrl_abort(reqh)
   1676  1.1  augustss 	usbd_request_handle reqh;
   1677  1.1  augustss {
   1678  1.3  augustss 	/* XXX inactivate */
   1679  1.3  augustss 	usbd_delay_ms(1);	/* make sure it is finished */
   1680  1.3  augustss 	/* XXX call done */
   1681  1.1  augustss }
   1682  1.1  augustss 
   1683  1.1  augustss /* Close a device control pipe. */
   1684  1.1  augustss void
   1685  1.1  augustss ohci_device_ctrl_close(pipe)
   1686  1.1  augustss 	usbd_pipe_handle pipe;
   1687  1.1  augustss {
   1688  1.1  augustss 	struct ohci_pipe *opipe = (struct ohci_pipe *)pipe;
   1689  1.1  augustss 	ohci_softc_t *sc = (ohci_softc_t *)pipe->device->bus;
   1690  1.3  augustss 	ohci_soft_ed_t *sed = opipe->sed;
   1691  1.1  augustss 	int s;
   1692  1.1  augustss 
   1693  1.1  augustss 	s = splusb();
   1694  1.1  augustss 	sed->ed->ed_flags |= OHCI_ED_SKIP;
   1695  1.1  augustss 	if ((sed->ed->ed_tailp & OHCI_TAILMASK) != sed->ed->ed_headp)
   1696  1.1  augustss 		usbd_delay_ms(2);
   1697  1.3  augustss 	ohci_rem_ed(sed, sc->sc_ctrl_head);
   1698  1.3  augustss 	splx(s);
   1699  1.3  augustss 	ohci_free_std(sc, opipe->tail);
   1700  1.3  augustss 	ohci_free_sed(sc, opipe->sed);
   1701  1.3  augustss 	/* XXX free other resources */
   1702  1.3  augustss }
   1703  1.3  augustss 
   1704  1.3  augustss /************************/
   1705  1.3  augustss 
   1706  1.3  augustss usbd_status
   1707  1.3  augustss ohci_device_bulk_transfer(reqh)
   1708  1.3  augustss 	usbd_request_handle reqh;
   1709  1.3  augustss {
   1710  1.3  augustss 	struct ohci_pipe *opipe = (struct ohci_pipe *)reqh->pipe;
   1711  1.3  augustss 	usbd_device_handle dev = opipe->pipe.device;
   1712  1.3  augustss 	ohci_softc_t *sc = (ohci_softc_t *)dev->bus;
   1713  1.3  augustss 	int addr = dev->address;
   1714  1.3  augustss 	ohci_soft_td_t *xfer, *tail;
   1715  1.3  augustss 	ohci_soft_ed_t *sed;
   1716  1.4  augustss 	usb_dma_t *dmap;
   1717  1.3  augustss 	usbd_status r;
   1718  1.3  augustss 	int s, len, isread;
   1719  1.3  augustss 
   1720  1.3  augustss 	if (reqh->isreq) {
   1721  1.3  augustss 		/* XXX panic */
   1722  1.3  augustss 		printf("ohci_device_bulk_transfer: a request\n");
   1723  1.3  augustss 		return (USBD_INVAL);
   1724  1.3  augustss 	}
   1725  1.3  augustss 
   1726  1.3  augustss 	len = reqh->length;
   1727  1.3  augustss 	dmap = &opipe->u.bulk.datadma;
   1728  1.3  augustss 	isread = reqh->pipe->endpoint->edesc->bEndpointAddress & UE_IN;
   1729  1.3  augustss 	sed = opipe->sed;
   1730  1.3  augustss 
   1731  1.3  augustss 	opipe->u.bulk.length = len;
   1732  1.3  augustss 
   1733  1.4  augustss 	r = usb_allocmem(sc->sc_dmatag, len, 0, dmap);
   1734  1.3  augustss 	if (r != USBD_NORMAL_COMPLETION)
   1735  1.3  augustss 		goto ret1;
   1736  1.3  augustss 
   1737  1.3  augustss 	tail = ohci_alloc_std(sc);
   1738  1.3  augustss 	if (!tail) {
   1739  1.3  augustss 		r = USBD_NOMEM;
   1740  1.3  augustss 		goto ret2;
   1741  1.3  augustss 	}
   1742  1.3  augustss 	tail->reqh = 0;
   1743  1.3  augustss 
   1744  1.3  augustss 	/* Update device address */
   1745  1.3  augustss 	sed->ed->ed_flags =
   1746  1.3  augustss 		(sed->ed->ed_flags & ~OHCI_ED_ADDRMASK) |
   1747  1.3  augustss 		OHCI_ED_SET_FA(addr);
   1748  1.3  augustss 
   1749  1.3  augustss 	/* Set up data transaction */
   1750  1.3  augustss 	xfer = opipe->tail;
   1751  1.3  augustss 	xfer->td->td_flags =
   1752  1.3  augustss 		(isread ? OHCI_TD_IN : OHCI_TD_OUT) | OHCI_TD_NOCC |
   1753  1.3  augustss 		OHCI_TD_SET_DI(1) | OHCI_TD_TOGGLE_CARRY;
   1754  1.3  augustss 	xfer->td->td_cbp = DMAADDR(dmap);
   1755  1.3  augustss 	xfer->nexttd = tail;
   1756  1.3  augustss 	xfer->td->td_nexttd = tail->physaddr;
   1757  1.3  augustss 	xfer->td->td_be = xfer->td->td_cbp + len - 1;
   1758  1.3  augustss 	xfer->len = len;
   1759  1.3  augustss 	xfer->reqh = reqh;
   1760  1.3  augustss 
   1761  1.3  augustss 	reqh->actlen = 0;
   1762  1.3  augustss 	reqh->hcpriv = xfer;
   1763  1.3  augustss 
   1764  1.3  augustss 	if (!isread)
   1765  1.3  augustss 		memcpy(KERNADDR(dmap), reqh->buffer, len);
   1766  1.3  augustss 
   1767  1.3  augustss 	/* Insert ED in schedule */
   1768  1.3  augustss 	s = splusb();
   1769  1.3  augustss 	ohci_hash_add_td(sc, xfer);
   1770  1.3  augustss 	sed->ed->ed_tailp = tail->physaddr;
   1771  1.3  augustss 	opipe->tail = tail;
   1772  1.3  augustss 	OWRITE4(sc, OHCI_COMMAND_STATUS, OHCI_BLF);
   1773  1.3  augustss 	if (reqh->timeout && !usbd_use_polling)
   1774  1.3  augustss 		timeout(ohci_timeout, reqh, MS_TO_TICKS(reqh->timeout));
   1775  1.3  augustss 	splx(s);
   1776  1.3  augustss 
   1777  1.3  augustss 	return (USBD_IN_PROGRESS);
   1778  1.3  augustss 
   1779  1.3  augustss  ret2:
   1780  1.4  augustss 	usb_freemem(sc->sc_dmatag, dmap);
   1781  1.3  augustss  ret1:
   1782  1.3  augustss 	return (r);
   1783  1.3  augustss }
   1784  1.3  augustss 
   1785  1.3  augustss /* Abort a device bulk request. */
   1786  1.3  augustss void
   1787  1.3  augustss ohci_device_bulk_abort(reqh)
   1788  1.3  augustss 	usbd_request_handle reqh;
   1789  1.3  augustss {
   1790  1.3  augustss #if 0
   1791  1.3  augustss 	sed->ed->ed_flags |= OHCI_ED_SKIP;
   1792  1.3  augustss 	if ((sed->ed->ed_tailp & OHCI_TAILMASK) != sed->ed->ed_headp)
   1793  1.3  augustss 		usbd_delay_ms(2);
   1794  1.3  augustss #endif
   1795  1.3  augustss 	/* XXX inactivate */
   1796  1.3  augustss 	usbd_delay_ms(1);	/* make sure it is finished */
   1797  1.3  augustss 	/* XXX call done */
   1798  1.3  augustss }
   1799  1.3  augustss 
   1800  1.3  augustss /* Close a device bulk pipe. */
   1801  1.3  augustss void
   1802  1.3  augustss ohci_device_bulk_close(pipe)
   1803  1.3  augustss 	usbd_pipe_handle pipe;
   1804  1.3  augustss {
   1805  1.3  augustss 	struct ohci_pipe *opipe = (struct ohci_pipe *)pipe;
   1806  1.3  augustss 	usbd_device_handle dev = opipe->pipe.device;
   1807  1.3  augustss 	ohci_softc_t *sc = (ohci_softc_t *)dev->bus;
   1808  1.3  augustss 	int s;
   1809  1.3  augustss 
   1810  1.3  augustss 	s = splusb();
   1811  1.3  augustss 	ohci_rem_ed(opipe->sed, sc->sc_bulk_head);
   1812  1.1  augustss 	splx(s);
   1813  1.1  augustss 	ohci_free_std(sc, opipe->tail);
   1814  1.1  augustss 	ohci_free_sed(sc, opipe->sed);
   1815  1.1  augustss 	/* XXX free other resources */
   1816  1.1  augustss }
   1817  1.1  augustss 
   1818  1.1  augustss /************************/
   1819  1.1  augustss 
   1820  1.1  augustss usbd_status
   1821  1.1  augustss ohci_device_intr_transfer(reqh)
   1822  1.1  augustss 	usbd_request_handle reqh;
   1823  1.1  augustss {
   1824  1.1  augustss 	struct ohci_pipe *opipe = (struct ohci_pipe *)reqh->pipe;
   1825  1.1  augustss 	usbd_device_handle dev = opipe->pipe.device;
   1826  1.1  augustss 	ohci_softc_t *sc = (ohci_softc_t *)dev->bus;
   1827  1.1  augustss 	ohci_soft_ed_t *sed = opipe->sed;
   1828  1.1  augustss 	ohci_soft_td_t *xfer, *tail;
   1829  1.4  augustss 	usb_dma_t *dmap;
   1830  1.1  augustss 	usbd_status r;
   1831  1.1  augustss 	int len;
   1832  1.1  augustss 	int s;
   1833  1.1  augustss 
   1834  1.1  augustss 	DPRINTFN(3, ("ohci_device_intr_transfer: reqh=%p buf=%p len=%d flags=%d priv=%p\n",
   1835  1.1  augustss 		 reqh, reqh->buffer, reqh->length, reqh->flags, reqh->priv));
   1836  1.1  augustss 
   1837  1.1  augustss 	if (reqh->isreq)
   1838  1.1  augustss 		panic("ohci_device_intr_transfer: a request\n");
   1839  1.1  augustss 
   1840  1.1  augustss 	len = reqh->length;
   1841  1.1  augustss 	dmap = &opipe->u.intr.datadma;
   1842  1.1  augustss 	if (len == 0)
   1843  1.1  augustss 		return (USBD_INVAL); /* XXX should it be? */
   1844  1.1  augustss 
   1845  1.1  augustss 	xfer = opipe->tail;
   1846  1.1  augustss 	tail = ohci_alloc_std(sc);
   1847  1.1  augustss 	if (!tail) {
   1848  1.1  augustss 		r = USBD_NOMEM;
   1849  1.1  augustss 		goto ret1;
   1850  1.1  augustss 	}
   1851  1.1  augustss 	tail->reqh = 0;
   1852  1.1  augustss 
   1853  1.4  augustss 	r = usb_allocmem(sc->sc_dmatag, len, 0, dmap);
   1854  1.1  augustss 	if (r != USBD_NORMAL_COMPLETION)
   1855  1.1  augustss 		goto ret2;
   1856  1.1  augustss 
   1857  1.1  augustss 	xfer->td->td_flags = OHCI_TD_IN | OHCI_TD_NOCC |
   1858  1.1  augustss 		OHCI_TD_SET_DI(1) | OHCI_TD_TOGGLE_CARRY;
   1859  1.1  augustss 	xfer->td->td_cbp = DMAADDR(dmap);
   1860  1.1  augustss 	xfer->nexttd = tail;
   1861  1.1  augustss 	xfer->td->td_nexttd = tail->physaddr;
   1862  1.1  augustss 	xfer->td->td_be = xfer->td->td_cbp + len - 1;
   1863  1.1  augustss 	xfer->len = len;
   1864  1.1  augustss 	xfer->reqh = reqh;
   1865  1.1  augustss 
   1866  1.1  augustss 	reqh->actlen = 0;
   1867  1.1  augustss 	reqh->hcpriv = xfer;
   1868  1.1  augustss 
   1869  1.1  augustss #if USB_DEBUG
   1870  1.1  augustss 	if (ohcidebug > 5) {
   1871  1.1  augustss 		printf("ohci_device_intr_transfer:\n");
   1872  1.1  augustss 		ohci_dump_ed(sed);
   1873  1.1  augustss 		ohci_dump_tds(xfer);
   1874  1.1  augustss 	}
   1875  1.1  augustss #endif
   1876  1.1  augustss 
   1877  1.1  augustss 	/* Insert ED in schedule */
   1878  1.1  augustss 	s = splusb();
   1879  1.1  augustss 	ohci_hash_add_td(sc, xfer);
   1880  1.1  augustss 	sed->ed->ed_tailp = tail->physaddr;
   1881  1.1  augustss 	opipe->tail = tail;
   1882  1.1  augustss #if 0
   1883  1.1  augustss 	if (reqh->timeout && !usbd_use_polling)
   1884  1.1  augustss 		timeout(ohci_timeout, reqh, MS_TO_TICKS(reqh->timeout));
   1885  1.1  augustss #endif
   1886  1.1  augustss 	sed->ed->ed_flags &= ~OHCI_ED_SKIP;
   1887  1.1  augustss 	splx(s);
   1888  1.1  augustss 
   1889  1.1  augustss #ifdef USB_DEBUG
   1890  1.1  augustss 	if (ohcidebug > 5) {
   1891  1.1  augustss 		delay(5000);
   1892  1.1  augustss 		printf("ohci_device_intr_transfer: status=%x\n",
   1893  1.1  augustss 		       OREAD4(sc, OHCI_COMMAND_STATUS));
   1894  1.1  augustss 		ohci_dump_ed(sed);
   1895  1.1  augustss 		ohci_dump_tds(xfer);
   1896  1.1  augustss 	}
   1897  1.1  augustss #endif
   1898  1.1  augustss 
   1899  1.1  augustss 	return (USBD_IN_PROGRESS);
   1900  1.1  augustss 
   1901  1.1  augustss  ret2:
   1902  1.1  augustss 	ohci_free_std(sc, xfer);
   1903  1.1  augustss  ret1:
   1904  1.1  augustss 	return (r);
   1905  1.1  augustss }
   1906  1.1  augustss 
   1907  1.1  augustss /* Abort a device control request. */
   1908  1.1  augustss void
   1909  1.1  augustss ohci_device_intr_abort(reqh)
   1910  1.1  augustss 	usbd_request_handle reqh;
   1911  1.1  augustss {
   1912  1.1  augustss 	struct uhci_pipe *opipe;
   1913  1.1  augustss 
   1914  1.3  augustss 	/* XXX inactivate */
   1915  1.3  augustss 	usbd_delay_ms(1);	/* make sure it is finished */
   1916  1.1  augustss 	if (reqh->pipe->intrreqh == reqh) {
   1917  1.1  augustss 		DPRINTF(("ohci_device_intr_abort: remove\n"));
   1918  1.1  augustss 		reqh->pipe->intrreqh = 0;
   1919  1.1  augustss 		opipe = (struct uhci_pipe *)reqh->pipe;
   1920  1.1  augustss 		ohci_intr_done((ohci_softc_t *)reqh->pipe->device->bus, reqh);
   1921  1.1  augustss 	}
   1922  1.1  augustss }
   1923  1.1  augustss 
   1924  1.1  augustss /* Close a device interrupt pipe. */
   1925  1.1  augustss void
   1926  1.1  augustss ohci_device_intr_close(pipe)
   1927  1.1  augustss 	usbd_pipe_handle pipe;
   1928  1.1  augustss {
   1929  1.1  augustss 	struct ohci_pipe *opipe = (struct ohci_pipe *)pipe;
   1930  1.1  augustss 	ohci_softc_t *sc = (ohci_softc_t *)pipe->device->bus;
   1931  1.1  augustss 	int nslots = opipe->u.intr.nslots;
   1932  1.1  augustss 	int pos = opipe->u.intr.pos;
   1933  1.1  augustss 	int j;
   1934  1.1  augustss 	ohci_soft_ed_t *p, *sed = opipe->sed;
   1935  1.1  augustss 	int s;
   1936  1.1  augustss 
   1937  1.1  augustss 	DPRINTFN(1,("ohci_device_intr_close: pipe=%p nslots=%d pos=%d\n",
   1938  1.1  augustss 		    pipe, nslots, pos));
   1939  1.1  augustss 	s = splusb();
   1940  1.1  augustss 	sed->ed->ed_flags |= OHCI_ED_SKIP;
   1941  1.1  augustss 	if ((sed->ed->ed_tailp & OHCI_TAILMASK) != sed->ed->ed_headp)
   1942  1.1  augustss 		usbd_delay_ms(2);
   1943  1.1  augustss 
   1944  1.1  augustss 	for (p = sc->sc_eds[pos]; p && p->next != sed; p = p->next)
   1945  1.1  augustss 		;
   1946  1.1  augustss 	if (!p)
   1947  1.1  augustss 		panic("ohci_device_intr_close: ED not found\n");
   1948  1.1  augustss 	p->next = sed->next;
   1949  1.1  augustss 	p->ed->ed_nexted = sed->ed->ed_nexted;
   1950  1.1  augustss 	splx(s);
   1951  1.1  augustss 
   1952  1.1  augustss 	for (j = 0; j < nslots; j++)
   1953  1.1  augustss 		--sc->sc_bws[pos * nslots + j];
   1954  1.1  augustss 
   1955  1.1  augustss 	ohci_free_std(sc, opipe->tail);
   1956  1.1  augustss 	ohci_free_sed(sc, opipe->sed);
   1957  1.1  augustss 	/* XXX free other resources */
   1958  1.1  augustss }
   1959  1.1  augustss 
   1960  1.1  augustss usbd_status
   1961  1.1  augustss ohci_device_setintr(sc, opipe, ival)
   1962  1.1  augustss 	ohci_softc_t *sc;
   1963  1.1  augustss 	struct ohci_pipe *opipe;
   1964  1.1  augustss 	int ival;
   1965  1.1  augustss {
   1966  1.1  augustss 	int i, j, s, best;
   1967  1.1  augustss 	u_int npoll, slow, shigh, nslots;
   1968  1.1  augustss 	u_int bestbw, bw;
   1969  1.1  augustss 	ohci_soft_ed_t *hsed, *sed = opipe->sed;
   1970  1.1  augustss 
   1971  1.1  augustss 	DPRINTFN(2, ("ohci_setintr: pipe=%p\n", opipe));
   1972  1.1  augustss 	if (ival == 0) {
   1973  1.1  augustss 		printf("ohci_setintr: 0 interval\n");
   1974  1.1  augustss 		return (USBD_INVAL);
   1975  1.1  augustss 	}
   1976  1.1  augustss 
   1977  1.1  augustss 	npoll = OHCI_NO_INTRS;
   1978  1.1  augustss 	while (npoll > ival)
   1979  1.1  augustss 		npoll /= 2;
   1980  1.1  augustss 	DPRINTFN(2, ("ohci_setintr: ival=%d npoll=%d\n", ival, npoll));
   1981  1.1  augustss 
   1982  1.1  augustss 	/*
   1983  1.1  augustss 	 * We now know which level in the tree the ED must go into.
   1984  1.1  augustss 	 * Figure out which slot has most bandwidth left over.
   1985  1.1  augustss 	 * Slots to examine:
   1986  1.1  augustss 	 * npoll
   1987  1.1  augustss 	 * 1	0
   1988  1.1  augustss 	 * 2	1 2
   1989  1.1  augustss 	 * 4	3 4 5 6
   1990  1.1  augustss 	 * 8	7 8 9 10 11 12 13 14
   1991  1.1  augustss 	 * N    (N-1) .. (N-1+N-1)
   1992  1.1  augustss 	 */
   1993  1.1  augustss 	slow = npoll-1;
   1994  1.1  augustss 	shigh = slow + npoll;
   1995  1.1  augustss 	nslots = OHCI_NO_INTRS / npoll;
   1996  1.1  augustss 	for (best = i = slow, bestbw = ~0; i < shigh; i++) {
   1997  1.1  augustss 		bw = 0;
   1998  1.1  augustss 		for (j = 0; j < nslots; j++)
   1999  1.1  augustss 			bw += sc->sc_bws[i * nslots + j];
   2000  1.1  augustss 		if (bw < bestbw) {
   2001  1.1  augustss 			best = i;
   2002  1.1  augustss 			bestbw = bw;
   2003  1.1  augustss 		}
   2004  1.1  augustss 	}
   2005  1.1  augustss 	DPRINTFN(2, ("ohci_setintr: best=%d(%d..%d) bestbw=%d\n",
   2006  1.1  augustss 		     best, slow, shigh, bestbw));
   2007  1.1  augustss 
   2008  1.1  augustss 	s = splusb();
   2009  1.1  augustss 	hsed = sc->sc_eds[best];
   2010  1.1  augustss 	sed->next = hsed->next;
   2011  1.1  augustss 	sed->ed->ed_nexted = hsed->ed->ed_nexted;
   2012  1.1  augustss 	hsed->next = sed;
   2013  1.1  augustss 	hsed->ed->ed_nexted = sed->physaddr;
   2014  1.1  augustss 	splx(s);
   2015  1.1  augustss 
   2016  1.1  augustss 	for (j = 0; j < nslots; j++)
   2017  1.1  augustss 		++sc->sc_bws[best * nslots + j];
   2018  1.1  augustss 	opipe->u.intr.nslots = nslots;
   2019  1.1  augustss 	opipe->u.intr.pos = best;
   2020  1.1  augustss 
   2021  1.1  augustss 	DPRINTFN(5, ("ohci_setintr: returns %p\n", opipe));
   2022  1.1  augustss 	return (USBD_NORMAL_COMPLETION);
   2023  1.1  augustss }
   2024  1.1  augustss 
   2025