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