Home | History | Annotate | Line # | Download | only in usb
ugen.c revision 1.164
      1  1.164  riastrad /*	$NetBSD: ugen.c,v 1.164 2021/09/07 10:43:21 riastradh Exp $	*/
      2    1.1  augustss 
      3    1.1  augustss /*
      4   1.71   mycroft  * Copyright (c) 1998, 2004 The NetBSD Foundation, Inc.
      5    1.1  augustss  * All rights reserved.
      6    1.1  augustss  *
      7    1.1  augustss  * This code is derived from software contributed to The NetBSD Foundation
      8   1.38  augustss  * by Lennart Augustsson (lennart (at) augustsson.net) at
      9    1.1  augustss  * Carlstedt Research & Technology.
     10    1.1  augustss  *
     11   1.84       gdt  * Copyright (c) 2006 BBN Technologies Corp.  All rights reserved.
     12   1.84       gdt  * Effort sponsored in part by the Defense Advanced Research Projects
     13   1.84       gdt  * Agency (DARPA) and the Department of the Interior National Business
     14   1.84       gdt  * Center under agreement number NBCHC050166.
     15   1.84       gdt  *
     16    1.1  augustss  * Redistribution and use in source and binary forms, with or without
     17    1.1  augustss  * modification, are permitted provided that the following conditions
     18    1.1  augustss  * are met:
     19    1.1  augustss  * 1. Redistributions of source code must retain the above copyright
     20    1.1  augustss  *    notice, this list of conditions and the following disclaimer.
     21    1.1  augustss  * 2. Redistributions in binary form must reproduce the above copyright
     22    1.1  augustss  *    notice, this list of conditions and the following disclaimer in the
     23    1.1  augustss  *    documentation and/or other materials provided with the distribution.
     24    1.1  augustss  *
     25    1.1  augustss  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     26    1.1  augustss  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     27    1.1  augustss  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     28    1.1  augustss  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     29    1.1  augustss  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     30    1.1  augustss  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     31    1.1  augustss  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     32    1.1  augustss  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     33    1.1  augustss  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     34    1.1  augustss  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     35    1.1  augustss  * POSSIBILITY OF SUCH DAMAGE.
     36    1.1  augustss  */
     37    1.1  augustss 
     38   1.50     lukem 
     39   1.50     lukem #include <sys/cdefs.h>
     40  1.164  riastrad __KERNEL_RCSID(0, "$NetBSD: ugen.c,v 1.164 2021/09/07 10:43:21 riastradh Exp $");
     41   1.84       gdt 
     42  1.122  christos #ifdef _KERNEL_OPT
     43   1.89     pavel #include "opt_compat_netbsd.h"
     44  1.126      gson #include "opt_usb.h"
     45  1.122  christos #endif
     46    1.1  augustss 
     47    1.1  augustss #include <sys/param.h>
     48    1.1  augustss #include <sys/systm.h>
     49    1.1  augustss #include <sys/kernel.h>
     50  1.133     skrll #include <sys/kmem.h>
     51    1.1  augustss #include <sys/device.h>
     52    1.1  augustss #include <sys/ioctl.h>
     53   1.12  augustss #include <sys/conf.h>
     54    1.1  augustss #include <sys/tty.h>
     55    1.1  augustss #include <sys/file.h>
     56    1.1  augustss #include <sys/select.h>
     57    1.1  augustss #include <sys/proc.h>
     58    1.1  augustss #include <sys/vnode.h>
     59    1.1  augustss #include <sys/poll.h>
     60  1.142  pgoyette #include <sys/compat_stub.h>
     61  1.155  riastrad #include <sys/module.h>
     62  1.155  riastrad #include <sys/rbtree.h>
     63    1.1  augustss 
     64    1.1  augustss #include <dev/usb/usb.h>
     65    1.1  augustss #include <dev/usb/usbdi.h>
     66    1.1  augustss #include <dev/usb/usbdi_util.h>
     67    1.1  augustss 
     68  1.146       mrg #include "ioconf.h"
     69  1.146       mrg 
     70   1.25  augustss #ifdef UGEN_DEBUG
     71  1.111    dyoung #define DPRINTF(x)	if (ugendebug) printf x
     72  1.111    dyoung #define DPRINTFN(n,x)	if (ugendebug>(n)) printf x
     73    1.2  augustss int	ugendebug = 0;
     74    1.1  augustss #else
     75    1.1  augustss #define DPRINTF(x)
     76    1.1  augustss #define DPRINTFN(n,x)
     77    1.1  augustss #endif
     78    1.1  augustss 
     79   1.41  augustss #define	UGEN_CHUNK	128	/* chunk size for read */
     80   1.41  augustss #define	UGEN_IBSIZE	1020	/* buffer size */
     81   1.41  augustss #define	UGEN_BBSIZE	1024
     82   1.41  augustss 
     83  1.110  jakllsch #define UGEN_NISOREQS	4	/* number of outstanding xfer requests */
     84  1.110  jakllsch #define UGEN_NISORFRMS	8	/* number of transactions per req */
     85  1.110  jakllsch #define UGEN_NISOFRAMES	(UGEN_NISORFRMS * UGEN_NISOREQS)
     86   1.41  augustss 
     87   1.84       gdt #define UGEN_BULK_RA_WB_BUFSIZE	16384		/* default buffer size */
     88   1.84       gdt #define UGEN_BULK_RA_WB_BUFMAX	(1 << 20)	/* maximum allowed buffer */
     89   1.84       gdt 
     90  1.125      matt struct isoreq {
     91  1.125      matt 	struct ugen_endpoint *sce;
     92  1.133     skrll 	struct usbd_xfer *xfer;
     93  1.125      matt 	void *dmabuf;
     94  1.133     skrll 	uint16_t sizes[UGEN_NISORFRMS];
     95  1.125      matt };
     96  1.125      matt 
     97    1.1  augustss struct ugen_endpoint {
     98    1.1  augustss 	struct ugen_softc *sc;
     99    1.1  augustss 	usb_endpoint_descriptor_t *edesc;
    100  1.133     skrll 	struct usbd_interface *iface;
    101    1.1  augustss 	int state;
    102    1.8  augustss #define UGEN_SHORT_OK	0x04	/* short xfers are OK */
    103   1.84       gdt #define UGEN_BULK_RA	0x08	/* in bulk read-ahead mode */
    104   1.84       gdt #define UGEN_BULK_WB	0x10	/* in bulk write-behind mode */
    105   1.84       gdt #define UGEN_RA_WB_STOP	0x20	/* RA/WB xfer is stopped (buffer full/empty) */
    106  1.133     skrll 	struct usbd_pipe *pipeh;
    107    1.1  augustss 	struct clist q;
    108   1.41  augustss 	u_char *ibuf;		/* start of buffer (circular for isoc) */
    109   1.41  augustss 	u_char *fill;		/* location for input (isoc) */
    110   1.41  augustss 	u_char *limit;		/* end of circular buffer (isoc) */
    111   1.41  augustss 	u_char *cur;		/* current read location (isoc) */
    112  1.133     skrll 	uint32_t timeout;
    113  1.133     skrll 	uint32_t ra_wb_bufsize; /* requested size for RA/WB buffer */
    114  1.133     skrll 	uint32_t ra_wb_reqsize; /* requested xfer length for RA/WB */
    115  1.133     skrll 	uint32_t ra_wb_used;	 /* how much is in buffer */
    116  1.133     skrll 	uint32_t ra_wb_xferlen; /* current xfer length for RA/WB */
    117  1.133     skrll 	struct usbd_xfer *ra_wb_xfer;
    118  1.125      matt 	struct isoreq isoreqs[UGEN_NISOREQS];
    119  1.121  riastrad 	/* Keep these last; we don't overwrite them in ugen_set_config() */
    120  1.121  riastrad #define UGEN_ENDPOINT_NONZERO_CRUFT	offsetof(struct ugen_endpoint, rsel)
    121  1.121  riastrad 	struct selinfo rsel;
    122  1.121  riastrad 	kcondvar_t cv;
    123    1.1  augustss };
    124    1.1  augustss 
    125    1.1  augustss struct ugen_softc {
    126  1.111    dyoung 	device_t sc_dev;		/* base device */
    127  1.133     skrll 	struct usbd_device *sc_udev;
    128  1.155  riastrad 	struct rb_node sc_node;
    129  1.155  riastrad 	unsigned sc_unit;
    130    1.1  augustss 
    131  1.120       mrg 	kmutex_t		sc_lock;
    132  1.120       mrg 	kcondvar_t		sc_detach_cv;
    133  1.120       mrg 
    134   1.13  augustss 	char sc_is_open[USB_MAX_ENDPOINTS];
    135    1.1  augustss 	struct ugen_endpoint sc_endpoints[USB_MAX_ENDPOINTS][2];
    136   1.21  augustss #define OUT 0
    137   1.21  augustss #define IN  1
    138    1.1  augustss 
    139   1.12  augustss 	int sc_refcnt;
    140   1.83  christos 	char sc_buffer[UGEN_BBSIZE];
    141   1.12  augustss 	u_char sc_dying;
    142  1.157  riastrad 	u_char sc_attached;
    143    1.1  augustss };
    144    1.1  augustss 
    145  1.155  riastrad static struct {
    146  1.155  riastrad 	kmutex_t	lock;
    147  1.155  riastrad 	rb_tree_t	tree;
    148  1.155  riastrad } ugenif __cacheline_aligned;
    149  1.155  riastrad 
    150  1.155  riastrad static int
    151  1.155  riastrad compare_ugen(void *cookie, const void *vsca, const void *vscb)
    152  1.155  riastrad {
    153  1.155  riastrad 	const struct ugen_softc *sca = vsca;
    154  1.155  riastrad 	const struct ugen_softc *scb = vscb;
    155  1.155  riastrad 
    156  1.155  riastrad 	if (sca->sc_unit < scb->sc_unit)
    157  1.155  riastrad 		return -1;
    158  1.155  riastrad 	if (sca->sc_unit > scb->sc_unit)
    159  1.155  riastrad 		return +1;
    160  1.155  riastrad 	return 0;
    161  1.155  riastrad }
    162  1.155  riastrad 
    163  1.155  riastrad static int
    164  1.155  riastrad compare_ugen_key(void *cookie, const void *vsc, const void *vk)
    165  1.155  riastrad {
    166  1.155  riastrad 	const struct ugen_softc *sc = vsc;
    167  1.155  riastrad 	const unsigned *k = vk;
    168  1.155  riastrad 
    169  1.155  riastrad 	if (sc->sc_unit < *k)
    170  1.155  riastrad 		return -1;
    171  1.155  riastrad 	if (sc->sc_unit > *k)
    172  1.155  riastrad 		return +1;
    173  1.155  riastrad 	return 0;
    174  1.155  riastrad }
    175  1.155  riastrad 
    176  1.155  riastrad static const rb_tree_ops_t ugenif_tree_ops = {
    177  1.155  riastrad 	.rbto_compare_nodes = compare_ugen,
    178  1.155  riastrad 	.rbto_compare_key = compare_ugen_key,
    179  1.156  riastrad 	.rbto_node_offset = offsetof(struct ugen_softc, sc_node),
    180  1.155  riastrad };
    181  1.155  riastrad 
    182  1.155  riastrad static void
    183  1.155  riastrad ugenif_get_unit(struct ugen_softc *sc)
    184  1.155  riastrad {
    185  1.155  riastrad 	struct ugen_softc *sc0;
    186  1.155  riastrad 	unsigned i;
    187  1.155  riastrad 
    188  1.155  riastrad 	mutex_enter(&ugenif.lock);
    189  1.155  riastrad 	for (i = 0, sc0 = RB_TREE_MIN(&ugenif.tree);
    190  1.155  riastrad 	     sc0 != NULL && i == sc0->sc_unit;
    191  1.155  riastrad 	     i++, sc0 = RB_TREE_NEXT(&ugenif.tree, sc0))
    192  1.155  riastrad 		KASSERT(i < UINT_MAX);
    193  1.155  riastrad 	KASSERT(rb_tree_find_node(&ugenif.tree, &i) == NULL);
    194  1.155  riastrad 	sc->sc_unit = i;
    195  1.155  riastrad 	sc0 = rb_tree_insert_node(&ugenif.tree, sc);
    196  1.155  riastrad 	KASSERT(sc0 == sc);
    197  1.155  riastrad 	KASSERT(rb_tree_find_node(&ugenif.tree, &i) == sc);
    198  1.155  riastrad 	mutex_exit(&ugenif.lock);
    199  1.155  riastrad }
    200  1.155  riastrad 
    201  1.155  riastrad static void
    202  1.155  riastrad ugenif_put_unit(struct ugen_softc *sc)
    203  1.155  riastrad {
    204  1.155  riastrad 
    205  1.155  riastrad 	mutex_enter(&ugenif.lock);
    206  1.155  riastrad 	KASSERT(rb_tree_find_node(&ugenif.tree, &sc->sc_unit) == sc);
    207  1.155  riastrad 	rb_tree_remove_node(&ugenif.tree, sc);
    208  1.155  riastrad 	sc->sc_unit = -1;
    209  1.155  riastrad 	mutex_exit(&ugenif.lock);
    210  1.155  riastrad }
    211  1.155  riastrad 
    212  1.155  riastrad static struct ugen_softc *
    213  1.155  riastrad ugenif_acquire(unsigned unit)
    214  1.155  riastrad {
    215  1.155  riastrad 	struct ugen_softc *sc;
    216  1.155  riastrad 
    217  1.155  riastrad 	mutex_enter(&ugenif.lock);
    218  1.155  riastrad 	sc = rb_tree_find_node(&ugenif.tree, &unit);
    219  1.156  riastrad 	if (sc == NULL)
    220  1.156  riastrad 		goto out;
    221  1.156  riastrad 	mutex_enter(&sc->sc_lock);
    222  1.156  riastrad 	if (sc->sc_dying) {
    223  1.155  riastrad 		mutex_exit(&sc->sc_lock);
    224  1.156  riastrad 		sc = NULL;
    225  1.156  riastrad 		goto out;
    226  1.155  riastrad 	}
    227  1.156  riastrad 	KASSERT(sc->sc_refcnt < INT_MAX);
    228  1.156  riastrad 	sc->sc_refcnt++;
    229  1.156  riastrad 	mutex_exit(&sc->sc_lock);
    230  1.156  riastrad out:	mutex_exit(&ugenif.lock);
    231  1.155  riastrad 
    232  1.155  riastrad 	return sc;
    233  1.155  riastrad }
    234  1.155  riastrad 
    235  1.155  riastrad static void
    236  1.155  riastrad ugenif_release(struct ugen_softc *sc)
    237  1.155  riastrad {
    238  1.155  riastrad 
    239  1.155  riastrad 	mutex_enter(&sc->sc_lock);
    240  1.155  riastrad 	if (--sc->sc_refcnt < 0)
    241  1.155  riastrad 		cv_broadcast(&sc->sc_detach_cv);
    242  1.155  riastrad 	mutex_exit(&sc->sc_lock);
    243  1.155  riastrad }
    244  1.155  riastrad 
    245  1.147      maxv static dev_type_open(ugenopen);
    246  1.147      maxv static dev_type_close(ugenclose);
    247  1.147      maxv static dev_type_read(ugenread);
    248  1.147      maxv static dev_type_write(ugenwrite);
    249  1.147      maxv static dev_type_ioctl(ugenioctl);
    250  1.147      maxv static dev_type_poll(ugenpoll);
    251  1.147      maxv static dev_type_kqfilter(ugenkqfilter);
    252   1.60   gehenna 
    253   1.60   gehenna const struct cdevsw ugen_cdevsw = {
    254  1.123  dholland 	.d_open = ugenopen,
    255  1.123  dholland 	.d_close = ugenclose,
    256  1.123  dholland 	.d_read = ugenread,
    257  1.123  dholland 	.d_write = ugenwrite,
    258  1.123  dholland 	.d_ioctl = ugenioctl,
    259  1.123  dholland 	.d_stop = nostop,
    260  1.123  dholland 	.d_tty = notty,
    261  1.123  dholland 	.d_poll = ugenpoll,
    262  1.123  dholland 	.d_mmap = nommap,
    263  1.123  dholland 	.d_kqfilter = ugenkqfilter,
    264  1.124  dholland 	.d_discard = nodiscard,
    265  1.123  dholland 	.d_flag = D_OTHER,
    266   1.60   gehenna };
    267   1.14  augustss 
    268  1.133     skrll Static void ugenintr(struct usbd_xfer *, void *,
    269  1.133     skrll 		     usbd_status);
    270  1.133     skrll Static void ugen_isoc_rintr(struct usbd_xfer *, void *,
    271  1.133     skrll 			    usbd_status);
    272  1.133     skrll Static void ugen_bulkra_intr(struct usbd_xfer *, void *,
    273  1.133     skrll 			     usbd_status);
    274  1.133     skrll Static void ugen_bulkwb_intr(struct usbd_xfer *, void *,
    275  1.133     skrll 			     usbd_status);
    276   1.40  augustss Static int ugen_do_read(struct ugen_softc *, int, struct uio *, int);
    277   1.40  augustss Static int ugen_do_write(struct ugen_softc *, int, struct uio *, int);
    278   1.55  augustss Static int ugen_do_ioctl(struct ugen_softc *, int, u_long,
    279   1.92  christos 			 void *, int, struct lwp *);
    280  1.138        ws Static int ugen_set_config(struct ugen_softc *, int, int);
    281  1.133     skrll Static usb_config_descriptor_t *ugen_get_cdesc(struct ugen_softc *,
    282  1.133     skrll 					       int, int *);
    283   1.40  augustss Static usbd_status ugen_set_interface(struct ugen_softc *, int, int);
    284  1.133     skrll Static int ugen_get_alt_index(struct ugen_softc *, int);
    285  1.131     skrll Static void ugen_clear_endpoints(struct ugen_softc *);
    286    1.1  augustss 
    287   1.12  augustss #define UGENUNIT(n) ((minor(n) >> 4) & 0xf)
    288   1.12  augustss #define UGENENDPOINT(n) (minor(n) & 0xf)
    289   1.12  augustss #define UGENDEV(u, e) (makedev(0, ((u) << 4) | (e)))
    290    1.1  augustss 
    291  1.147      maxv static int	ugenif_match(device_t, cfdata_t, void *);
    292  1.147      maxv static void	ugenif_attach(device_t, device_t, void *);
    293  1.147      maxv static int	ugen_match(device_t, cfdata_t, void *);
    294  1.147      maxv static void	ugen_attach(device_t, device_t, void *);
    295  1.147      maxv static int	ugen_detach(device_t, int);
    296  1.147      maxv static int	ugen_activate(device_t, enum devact);
    297  1.146       mrg 
    298  1.138        ws CFATTACH_DECL_NEW(ugen, sizeof(struct ugen_softc), ugen_match,
    299  1.138        ws     ugen_attach, ugen_detach, ugen_activate);
    300  1.138        ws CFATTACH_DECL_NEW(ugenif, sizeof(struct ugen_softc), ugenif_match,
    301  1.138        ws     ugenif_attach, ugen_detach, ugen_activate);
    302    1.1  augustss 
    303  1.105     pooka /* toggle to control attach priority. -1 means "let autoconf decide" */
    304  1.105     pooka int ugen_override = -1;
    305  1.105     pooka 
    306  1.147      maxv static int
    307  1.111    dyoung ugen_match(device_t parent, cfdata_t match, void *aux)
    308    1.1  augustss {
    309  1.111    dyoung 	struct usb_attach_arg *uaa = aux;
    310  1.105     pooka 	int override;
    311  1.105     pooka 
    312  1.105     pooka 	if (ugen_override != -1)
    313  1.105     pooka 		override = ugen_override;
    314  1.105     pooka 	else
    315  1.105     pooka 		override = match->cf_flags & 1;
    316    1.1  augustss 
    317  1.105     pooka 	if (override)
    318  1.133     skrll 		return UMATCH_HIGHEST;
    319  1.133     skrll 	else if (uaa->uaa_usegeneric)
    320  1.133     skrll 		return UMATCH_GENERIC;
    321    1.1  augustss 	else
    322  1.133     skrll 		return UMATCH_NONE;
    323    1.1  augustss }
    324    1.1  augustss 
    325  1.147      maxv static int
    326  1.138        ws ugenif_match(device_t parent, cfdata_t match, void *aux)
    327  1.138        ws {
    328  1.139        ws 	/* Assume that they knew what they configured! (see ugenif(4)) */
    329  1.139        ws 	return UMATCH_HIGHEST;
    330  1.138        ws }
    331  1.138        ws 
    332  1.147      maxv static void
    333  1.111    dyoung ugen_attach(device_t parent, device_t self, void *aux)
    334    1.1  augustss {
    335  1.138        ws 	struct usb_attach_arg *uaa = aux;
    336  1.138        ws 	struct usbif_attach_arg uiaa;
    337  1.138        ws 
    338  1.151     skrll 	memset(&uiaa, 0, sizeof(uiaa));
    339  1.138        ws 	uiaa.uiaa_port = uaa->uaa_port;
    340  1.138        ws 	uiaa.uiaa_vendor = uaa->uaa_vendor;
    341  1.138        ws 	uiaa.uiaa_product = uaa->uaa_product;
    342  1.138        ws 	uiaa.uiaa_release = uaa->uaa_release;
    343  1.138        ws 	uiaa.uiaa_device = uaa->uaa_device;
    344  1.138        ws 	uiaa.uiaa_configno = -1;
    345  1.138        ws 	uiaa.uiaa_ifaceno = -1;
    346  1.138        ws 
    347  1.138        ws 	ugenif_attach(parent, self, &uiaa);
    348  1.138        ws }
    349  1.138        ws 
    350  1.147      maxv static void
    351  1.138        ws ugenif_attach(device_t parent, device_t self, void *aux)
    352  1.138        ws {
    353  1.111    dyoung 	struct ugen_softc *sc = device_private(self);
    354  1.138        ws 	struct usbif_attach_arg *uiaa = aux;
    355  1.133     skrll 	struct usbd_device *udev;
    356   1.72  augustss 	char *devinfop;
    357   1.28  augustss 	usbd_status err;
    358   1.97     rmind 	int i, dir, conf;
    359   1.59  augustss 
    360  1.103    plunky 	aprint_naive("\n");
    361  1.103    plunky 	aprint_normal("\n");
    362  1.103    plunky 
    363  1.133     skrll 	mutex_init(&sc->sc_lock, MUTEX_DEFAULT, IPL_SOFTUSB);
    364  1.120       mrg 	cv_init(&sc->sc_detach_cv, "ugendet");
    365  1.120       mrg 
    366  1.138        ws 	devinfop = usbd_devinfo_alloc(uiaa->uiaa_device, 0);
    367   1.99      cube 	aprint_normal_dev(self, "%s\n", devinfop);
    368   1.72  augustss 	usbd_devinfo_free(devinfop);
    369    1.1  augustss 
    370   1.99      cube 	sc->sc_dev = self;
    371  1.138        ws 	sc->sc_udev = udev = uiaa->uiaa_device;
    372   1.31  augustss 
    373  1.121  riastrad 	for (i = 0; i < USB_MAX_ENDPOINTS; i++) {
    374  1.121  riastrad 		for (dir = OUT; dir <= IN; dir++) {
    375  1.121  riastrad 			struct ugen_endpoint *sce;
    376  1.121  riastrad 
    377  1.121  riastrad 			sce = &sc->sc_endpoints[i][dir];
    378  1.121  riastrad 			selinit(&sce->rsel);
    379  1.121  riastrad 			cv_init(&sce->cv, "ugensce");
    380  1.121  riastrad 		}
    381  1.121  riastrad 	}
    382  1.121  riastrad 
    383  1.157  riastrad 	if (!pmf_device_register(self, NULL, NULL))
    384  1.157  riastrad 		aprint_error_dev(self, "couldn't establish power handler\n");
    385  1.157  riastrad 
    386  1.138        ws 	if (uiaa->uiaa_ifaceno < 0) {
    387  1.138        ws 		/*
    388  1.138        ws 		 * If we attach the whole device,
    389  1.138        ws 		 * set configuration index 0, the default one.
    390  1.138        ws 		 */
    391  1.138        ws 		err = usbd_set_config_index(udev, 0, 0);
    392  1.138        ws 		if (err) {
    393  1.138        ws 			aprint_error_dev(self,
    394  1.138        ws 			    "setting configuration index 0 failed\n");
    395  1.138        ws 			return;
    396  1.138        ws 		}
    397   1.31  augustss 	}
    398  1.138        ws 
    399  1.138        ws 	/* Get current configuration */
    400   1.31  augustss 	conf = usbd_get_config_descriptor(udev)->bConfigurationValue;
    401   1.31  augustss 
    402   1.31  augustss 	/* Set up all the local state for this configuration. */
    403  1.138        ws 	err = ugen_set_config(sc, conf, uiaa->uiaa_ifaceno < 0);
    404   1.28  augustss 	if (err) {
    405   1.99      cube 		aprint_error_dev(self, "setting configuration %d failed\n",
    406   1.99      cube 		    conf);
    407  1.111    dyoung 		return;
    408    1.1  augustss 	}
    409   1.30  augustss 
    410  1.155  riastrad 	ugenif_get_unit(sc);
    411  1.134   msaitoh 	usbd_add_drv_event(USB_EVENT_DRIVER_ATTACH, sc->sc_udev, sc->sc_dev);
    412  1.157  riastrad 	sc->sc_attached = 1;
    413    1.1  augustss }
    414    1.1  augustss 
    415  1.130     skrll Static void
    416  1.130     skrll ugen_clear_endpoints(struct ugen_softc *sc)
    417  1.130     skrll {
    418  1.130     skrll 
    419  1.130     skrll 	/* Clear out the old info, but leave the selinfo and cv initialised. */
    420  1.130     skrll 	for (int i = 0; i < USB_MAX_ENDPOINTS; i++) {
    421  1.130     skrll 		for (int dir = OUT; dir <= IN; dir++) {
    422  1.130     skrll 			struct ugen_endpoint *sce = &sc->sc_endpoints[i][dir];
    423  1.130     skrll 			memset(sce, 0, UGEN_ENDPOINT_NONZERO_CRUFT);
    424  1.130     skrll 		}
    425  1.130     skrll 	}
    426  1.130     skrll }
    427  1.130     skrll 
    428   1.37  augustss Static int
    429  1.138        ws ugen_set_config(struct ugen_softc *sc, int configno, int chkopen)
    430    1.1  augustss {
    431  1.133     skrll 	struct usbd_device *dev = sc->sc_udev;
    432  1.102  drochner 	usb_config_descriptor_t *cdesc;
    433  1.133     skrll 	struct usbd_interface *iface;
    434    1.1  augustss 	usb_endpoint_descriptor_t *ed;
    435    1.1  augustss 	struct ugen_endpoint *sce;
    436  1.133     skrll 	uint8_t niface, nendpt;
    437    1.1  augustss 	int ifaceno, endptno, endpt;
    438   1.28  augustss 	usbd_status err;
    439  1.130     skrll 	int dir;
    440    1.1  augustss 
    441    1.1  augustss 	DPRINTFN(1,("ugen_set_config: %s to configno %d, sc=%p\n",
    442  1.111    dyoung 		    device_xname(sc->sc_dev), configno, sc));
    443   1.53  augustss 
    444  1.159  riastrad 	KASSERT(KERNEL_LOCKED_P()); /* sc_is_open */
    445  1.159  riastrad 
    446  1.138        ws 	if (chkopen) {
    447  1.138        ws 		/*
    448  1.138        ws 		 * We start at 1, not 0, because we don't care whether the
    449  1.138        ws 		 * control endpoint is open or not. It is always present.
    450  1.138        ws 		 */
    451  1.138        ws 		for (endptno = 1; endptno < USB_MAX_ENDPOINTS; endptno++)
    452  1.138        ws 			if (sc->sc_is_open[endptno]) {
    453  1.138        ws 				DPRINTFN(1,
    454  1.138        ws 				     ("ugen_set_config: %s - endpoint %d is open\n",
    455  1.138        ws 				      device_xname(sc->sc_dev), endptno));
    456  1.138        ws 				return USBD_IN_USE;
    457  1.138        ws 			}
    458  1.161  riastrad 
    459  1.161  riastrad 		/* Prevent opening while we're setting the config.  */
    460  1.161  riastrad 		for (endptno = 1; endptno < USB_MAX_ENDPOINTS; endptno++) {
    461  1.161  riastrad 			KASSERT(!sc->sc_is_open[endptno]);
    462  1.161  riastrad 			sc->sc_is_open[endptno] = 1;
    463  1.161  riastrad 		}
    464  1.138        ws 	}
    465   1.53  augustss 
    466   1.31  augustss 	/* Avoid setting the current value. */
    467  1.102  drochner 	cdesc = usbd_get_config_descriptor(dev);
    468  1.102  drochner 	if (!cdesc || cdesc->bConfigurationValue != configno) {
    469   1.43  augustss 		err = usbd_set_config_no(dev, configno, 1);
    470   1.28  augustss 		if (err)
    471  1.161  riastrad 			goto out;
    472    1.7  augustss 	}
    473    1.1  augustss 
    474  1.138        ws 	ugen_clear_endpoints(sc);
    475  1.138        ws 
    476   1.28  augustss 	err = usbd_interface_count(dev, &niface);
    477   1.28  augustss 	if (err)
    478  1.161  riastrad 		goto out;
    479  1.120       mrg 
    480    1.1  augustss 	for (ifaceno = 0; ifaceno < niface; ifaceno++) {
    481    1.1  augustss 		DPRINTFN(1,("ugen_set_config: ifaceno %d\n", ifaceno));
    482   1.28  augustss 		err = usbd_device2interface_handle(dev, ifaceno, &iface);
    483   1.28  augustss 		if (err)
    484  1.161  riastrad 			goto out;
    485   1.28  augustss 		err = usbd_endpoint_count(iface, &nendpt);
    486   1.28  augustss 		if (err)
    487  1.161  riastrad 			goto out;
    488    1.1  augustss 		for (endptno = 0; endptno < nendpt; endptno++) {
    489    1.1  augustss 			ed = usbd_interface2endpoint_descriptor(iface,endptno);
    490   1.82  christos 			KASSERT(ed != NULL);
    491    1.1  augustss 			endpt = ed->bEndpointAddress;
    492   1.21  augustss 			dir = UE_GET_DIR(endpt) == UE_DIR_IN ? IN : OUT;
    493   1.21  augustss 			sce = &sc->sc_endpoints[UE_GET_ADDR(endpt)][dir];
    494  1.150  christos 			DPRINTFN(1,("ugen_set_config: endptno %d, endpt=0x%02x"
    495   1.55  augustss 				    "(%d,%d), sce=%p\n",
    496    1.1  augustss 				    endptno, endpt, UE_GET_ADDR(endpt),
    497   1.21  augustss 				    UE_GET_DIR(endpt), sce));
    498    1.1  augustss 			sce->sc = sc;
    499    1.1  augustss 			sce->edesc = ed;
    500    1.1  augustss 			sce->iface = iface;
    501    1.1  augustss 		}
    502    1.1  augustss 	}
    503  1.161  riastrad 	err = USBD_NORMAL_COMPLETION;
    504  1.161  riastrad 
    505  1.161  riastrad out:	if (chkopen) {
    506  1.161  riastrad 		/*
    507  1.161  riastrad 		 * Allow open again now that we're done trying to set
    508  1.161  riastrad 		 * the config.
    509  1.161  riastrad 		 */
    510  1.161  riastrad 		for (endptno = 1; endptno < USB_MAX_ENDPOINTS; endptno++) {
    511  1.161  riastrad 			KASSERT(sc->sc_is_open[endptno]);
    512  1.161  riastrad 			sc->sc_is_open[endptno] = 0;
    513  1.161  riastrad 		}
    514  1.161  riastrad 	}
    515  1.161  riastrad 	return err;
    516    1.1  augustss }
    517    1.1  augustss 
    518  1.147      maxv static int
    519   1.88  christos ugenopen(dev_t dev, int flag, int mode, struct lwp *l)
    520    1.1  augustss {
    521   1.24  augustss 	struct ugen_softc *sc;
    522    1.1  augustss 	int unit = UGENUNIT(dev);
    523    1.1  augustss 	int endpt = UGENENDPOINT(dev);
    524    1.1  augustss 	usb_endpoint_descriptor_t *edesc;
    525    1.1  augustss 	struct ugen_endpoint *sce;
    526    1.1  augustss 	int dir, isize;
    527   1.28  augustss 	usbd_status err;
    528  1.133     skrll 	struct usbd_xfer *xfer;
    529   1.41  augustss 	int i, j;
    530  1.155  riastrad 	int error;
    531  1.160  riastrad 	int opened;
    532    1.1  augustss 
    533  1.159  riastrad 	KASSERT(KERNEL_LOCKED_P()); /* sc_is_open */
    534  1.159  riastrad 
    535  1.155  riastrad 	if ((sc = ugenif_acquire(unit)) == NULL)
    536  1.111    dyoung 		return ENXIO;
    537   1.30  augustss 
    538   1.55  augustss 	DPRINTFN(5, ("ugenopen: flag=%d, mode=%d, unit=%d endpt=%d\n",
    539    1.9  augustss 		     flag, mode, unit, endpt));
    540    1.1  augustss 
    541   1.73  augustss 	/* The control endpoint allows multiple opens. */
    542    1.1  augustss 	if (endpt == USB_CONTROL_ENDPOINT) {
    543  1.160  riastrad 		opened = sc->sc_is_open[USB_CONTROL_ENDPOINT] = 1;
    544  1.155  riastrad 		error = 0;
    545  1.155  riastrad 		goto out;
    546   1.13  augustss 	}
    547   1.35  augustss 
    548  1.155  riastrad 	if (sc->sc_is_open[endpt]) {
    549  1.155  riastrad 		error = EBUSY;
    550  1.155  riastrad 		goto out;
    551  1.155  riastrad 	}
    552  1.160  riastrad 	opened = sc->sc_is_open[endpt] = 1;
    553   1.73  augustss 
    554   1.13  augustss 	/* Make sure there are pipes for all directions. */
    555   1.13  augustss 	for (dir = OUT; dir <= IN; dir++) {
    556   1.13  augustss 		if (flag & (dir == OUT ? FWRITE : FREAD)) {
    557   1.13  augustss 			sce = &sc->sc_endpoints[endpt][dir];
    558  1.155  riastrad 			if (sce->edesc == NULL) {
    559  1.155  riastrad 				error = ENXIO;
    560  1.155  riastrad 				goto out;
    561  1.155  riastrad 			}
    562    1.1  augustss 		}
    563   1.13  augustss 	}
    564   1.13  augustss 
    565   1.13  augustss 	/* Actually open the pipes. */
    566   1.13  augustss 	/* XXX Should back out properly if it fails. */
    567   1.13  augustss 	for (dir = OUT; dir <= IN; dir++) {
    568   1.13  augustss 		if (!(flag & (dir == OUT ? FWRITE : FREAD)))
    569   1.13  augustss 			continue;
    570    1.1  augustss 		sce = &sc->sc_endpoints[endpt][dir];
    571   1.13  augustss 		sce->state = 0;
    572   1.17  augustss 		sce->timeout = USBD_NO_TIMEOUT;
    573   1.55  augustss 		DPRINTFN(5, ("ugenopen: sc=%p, endpt=%d, dir=%d, sce=%p\n",
    574    1.3  augustss 			     sc, endpt, dir, sce));
    575    1.1  augustss 		edesc = sce->edesc;
    576    1.1  augustss 		switch (edesc->bmAttributes & UE_XFERTYPE) {
    577    1.1  augustss 		case UE_INTERRUPT:
    578   1.69  augustss 			if (dir == OUT) {
    579   1.69  augustss 				err = usbd_open_pipe(sce->iface,
    580   1.69  augustss 				    edesc->bEndpointAddress, 0, &sce->pipeh);
    581  1.155  riastrad 				if (err) {
    582  1.155  riastrad 					error = EIO;
    583  1.155  riastrad 					goto out;
    584  1.155  riastrad 				}
    585   1.69  augustss 				break;
    586   1.69  augustss 			}
    587    1.1  augustss 			isize = UGETW(edesc->wMaxPacketSize);
    588  1.155  riastrad 			if (isize == 0) {	/* shouldn't happen */
    589  1.155  riastrad 				error = EINVAL;
    590  1.155  riastrad 				goto out;
    591  1.155  riastrad 			}
    592  1.133     skrll 			sce->ibuf = kmem_alloc(isize, KM_SLEEP);
    593   1.55  augustss 			DPRINTFN(5, ("ugenopen: intr endpt=%d,isize=%d\n",
    594    1.1  augustss 				     endpt, isize));
    595  1.121  riastrad 			if (clalloc(&sce->q, UGEN_IBSIZE, 0) == -1) {
    596  1.133     skrll 				kmem_free(sce->ibuf, isize);
    597  1.121  riastrad 				sce->ibuf = NULL;
    598  1.155  riastrad 				error = ENOMEM;
    599  1.155  riastrad 				goto out;
    600  1.121  riastrad 			}
    601   1.55  augustss 			err = usbd_open_pipe_intr(sce->iface,
    602   1.55  augustss 				  edesc->bEndpointAddress,
    603   1.55  augustss 				  USBD_SHORT_XFER_OK, &sce->pipeh, sce,
    604   1.55  augustss 				  sce->ibuf, isize, ugenintr,
    605   1.32  augustss 				  USBD_DEFAULT_INTERVAL);
    606   1.28  augustss 			if (err) {
    607  1.121  riastrad 				clfree(&sce->q);
    608  1.133     skrll 				kmem_free(sce->ibuf, isize);
    609  1.121  riastrad 				sce->ibuf = NULL;
    610  1.155  riastrad 				error = EIO;
    611  1.155  riastrad 				goto out;
    612    1.1  augustss 			}
    613    1.1  augustss 			DPRINTFN(5, ("ugenopen: interrupt open done\n"));
    614    1.1  augustss 			break;
    615    1.1  augustss 		case UE_BULK:
    616   1.55  augustss 			err = usbd_open_pipe(sce->iface,
    617   1.28  augustss 				  edesc->bEndpointAddress, 0, &sce->pipeh);
    618  1.155  riastrad 			if (err) {
    619  1.155  riastrad 				error = EIO;
    620  1.155  riastrad 				goto out;
    621  1.155  riastrad 			}
    622   1.84       gdt 			sce->ra_wb_bufsize = UGEN_BULK_RA_WB_BUFSIZE;
    623  1.121  riastrad 			/*
    624   1.84       gdt 			 * Use request size for non-RA/WB transfers
    625   1.84       gdt 			 * as the default.
    626   1.84       gdt 			 */
    627   1.84       gdt 			sce->ra_wb_reqsize = UGEN_BBSIZE;
    628    1.1  augustss 			break;
    629   1.41  augustss 		case UE_ISOCHRONOUS:
    630  1.155  riastrad 			if (dir == OUT) {
    631  1.155  riastrad 				error = EINVAL;
    632  1.155  riastrad 				goto out;
    633  1.155  riastrad 			}
    634   1.41  augustss 			isize = UGETW(edesc->wMaxPacketSize);
    635  1.156  riastrad 			if (isize == 0) {	/* shouldn't happen */
    636  1.156  riastrad 				error = EINVAL;
    637  1.156  riastrad 				goto out;
    638  1.156  riastrad 			}
    639  1.133     skrll 			sce->ibuf = kmem_alloc(isize * UGEN_NISOFRAMES,
    640  1.133     skrll 				KM_SLEEP);
    641   1.41  augustss 			sce->cur = sce->fill = sce->ibuf;
    642   1.41  augustss 			sce->limit = sce->ibuf + isize * UGEN_NISOFRAMES;
    643   1.55  augustss 			DPRINTFN(5, ("ugenopen: isoc endpt=%d, isize=%d\n",
    644   1.41  augustss 				     endpt, isize));
    645   1.41  augustss 			err = usbd_open_pipe(sce->iface,
    646   1.41  augustss 				  edesc->bEndpointAddress, 0, &sce->pipeh);
    647   1.41  augustss 			if (err) {
    648  1.133     skrll 				kmem_free(sce->ibuf, isize * UGEN_NISOFRAMES);
    649  1.121  riastrad 				sce->ibuf = NULL;
    650  1.155  riastrad 				error = EIO;
    651  1.155  riastrad 				goto out;
    652   1.41  augustss 			}
    653  1.132     skrll 			for (i = 0; i < UGEN_NISOREQS; ++i) {
    654   1.41  augustss 				sce->isoreqs[i].sce = sce;
    655  1.133     skrll 				err = usbd_create_xfer(sce->pipeh,
    656  1.133     skrll 				    isize * UGEN_NISORFRMS, 0, UGEN_NISORFRMS,
    657  1.133     skrll 				    &xfer);
    658  1.133     skrll 				if (err)
    659   1.41  augustss 					goto bad;
    660   1.41  augustss 				sce->isoreqs[i].xfer = xfer;
    661  1.133     skrll 				sce->isoreqs[i].dmabuf = usbd_get_buffer(xfer);
    662  1.132     skrll 				for (j = 0; j < UGEN_NISORFRMS; ++j)
    663   1.41  augustss 					sce->isoreqs[i].sizes[j] = isize;
    664  1.133     skrll 				usbd_setup_isoc_xfer(xfer, &sce->isoreqs[i],
    665  1.133     skrll 				    sce->isoreqs[i].sizes, UGEN_NISORFRMS, 0,
    666  1.133     skrll 				    ugen_isoc_rintr);
    667   1.41  augustss 				(void)usbd_transfer(xfer);
    668   1.41  augustss 			}
    669   1.41  augustss 			DPRINTFN(5, ("ugenopen: isoc open done\n"));
    670   1.41  augustss 			break;
    671   1.41  augustss 		bad:
    672   1.41  augustss 			while (--i >= 0) /* implicit buffer free */
    673  1.133     skrll 				usbd_destroy_xfer(sce->isoreqs[i].xfer);
    674  1.121  riastrad 			usbd_close_pipe(sce->pipeh);
    675  1.121  riastrad 			sce->pipeh = NULL;
    676  1.133     skrll 			kmem_free(sce->ibuf, isize * UGEN_NISOFRAMES);
    677  1.121  riastrad 			sce->ibuf = NULL;
    678  1.155  riastrad 			error = ENOMEM;
    679  1.155  riastrad 			goto out;
    680    1.1  augustss 		case UE_CONTROL:
    681   1.57  augustss 			sce->timeout = USBD_DEFAULT_TIMEOUT;
    682  1.155  riastrad 			error = EINVAL;
    683  1.155  riastrad 			goto out;
    684    1.1  augustss 		}
    685    1.1  augustss 	}
    686  1.155  riastrad 	error = 0;
    687  1.160  riastrad out:	if (error && opened)
    688  1.160  riastrad 		sc->sc_is_open[endpt] = 0;
    689  1.160  riastrad 	ugenif_release(sc);
    690  1.155  riastrad 	return error;
    691    1.1  augustss }
    692    1.1  augustss 
    693  1.163  riastrad static void
    694  1.163  riastrad ugen_do_close(struct ugen_softc *sc, int flag, int endpt)
    695    1.1  augustss {
    696    1.1  augustss 	struct ugen_endpoint *sce;
    697    1.1  augustss 	int dir;
    698   1.41  augustss 	int i;
    699    1.1  augustss 
    700  1.159  riastrad 	KASSERT(KERNEL_LOCKED_P()); /* sc_is_open */
    701  1.159  riastrad 
    702  1.163  riastrad 	if (!sc->sc_is_open[endpt]) {
    703  1.163  riastrad 		KASSERT(sc->sc_endpoints[endpt][IN].pipeh == NULL);
    704  1.163  riastrad 		KASSERT(sc->sc_endpoints[endpt][OUT].pipeh == NULL);
    705  1.163  riastrad 		KASSERT(sc->sc_endpoints[endpt][IN].ibuf == NULL);
    706  1.163  riastrad 		KASSERT(sc->sc_endpoints[endpt][OUT].ibuf == NULL);
    707  1.163  riastrad 		return;
    708  1.163  riastrad 	}
    709    1.1  augustss 
    710    1.1  augustss 	if (endpt == USB_CONTROL_ENDPOINT) {
    711    1.9  augustss 		DPRINTFN(5, ("ugenclose: close control\n"));
    712  1.155  riastrad 		goto out;
    713    1.1  augustss 	}
    714    1.9  augustss 
    715    1.9  augustss 	for (dir = OUT; dir <= IN; dir++) {
    716   1.13  augustss 		if (!(flag & (dir == OUT ? FWRITE : FREAD)))
    717   1.13  augustss 			continue;
    718   1.13  augustss 		sce = &sc->sc_endpoints[endpt][dir];
    719  1.129     skrll 		if (sce->pipeh == NULL)
    720   1.13  augustss 			continue;
    721   1.55  augustss 		DPRINTFN(5, ("ugenclose: endpt=%d dir=%d sce=%p\n",
    722   1.13  augustss 			     endpt, dir, sce));
    723   1.59  augustss 
    724   1.13  augustss 		usbd_abort_pipe(sce->pipeh);
    725  1.133     skrll 
    726  1.133     skrll 		int isize = UGETW(sce->edesc->wMaxPacketSize);
    727  1.133     skrll 		int msize = 0;
    728   1.41  augustss 
    729   1.56  augustss 		switch (sce->edesc->bmAttributes & UE_XFERTYPE) {
    730   1.56  augustss 		case UE_INTERRUPT:
    731   1.56  augustss 			ndflush(&sce->q, sce->q.c_cc);
    732   1.56  augustss 			clfree(&sce->q);
    733  1.133     skrll 			msize = isize;
    734   1.56  augustss 			break;
    735   1.56  augustss 		case UE_ISOCHRONOUS:
    736   1.56  augustss 			for (i = 0; i < UGEN_NISOREQS; ++i)
    737  1.133     skrll 				usbd_destroy_xfer(sce->isoreqs[i].xfer);
    738  1.133     skrll 			msize = isize * UGEN_NISOFRAMES;
    739   1.84       gdt 			break;
    740   1.84       gdt 		case UE_BULK:
    741  1.133     skrll 			if (sce->state & (UGEN_BULK_RA | UGEN_BULK_WB)) {
    742  1.133     skrll 				usbd_destroy_xfer(sce->ra_wb_xfer);
    743  1.133     skrll 				msize = sce->ra_wb_bufsize;
    744  1.133     skrll 			}
    745   1.84       gdt 			break;
    746   1.56  augustss 		default:
    747   1.56  augustss 			break;
    748   1.41  augustss 		}
    749  1.133     skrll 		usbd_close_pipe(sce->pipeh);
    750  1.133     skrll 		sce->pipeh = NULL;
    751   1.28  augustss 		if (sce->ibuf != NULL) {
    752  1.133     skrll 			kmem_free(sce->ibuf, msize);
    753   1.30  augustss 			sce->ibuf = NULL;
    754    1.9  augustss 		}
    755    1.1  augustss 	}
    756    1.1  augustss 
    757  1.163  riastrad out:	sc->sc_is_open[endpt] = 0;
    758  1.163  riastrad }
    759  1.163  riastrad 
    760  1.163  riastrad static int
    761  1.163  riastrad ugenclose(dev_t dev, int flag, int mode, struct lwp *l)
    762  1.163  riastrad {
    763  1.163  riastrad 	int endpt = UGENENDPOINT(dev);
    764  1.163  riastrad 	struct ugen_softc *sc;
    765  1.163  riastrad 
    766  1.163  riastrad 	DPRINTFN(5, ("ugenclose: flag=%d, mode=%d, unit=%d, endpt=%d\n",
    767  1.163  riastrad 		     flag, mode, UGENUNIT(dev), endpt));
    768  1.163  riastrad 
    769  1.163  riastrad 	KASSERT(KERNEL_LOCKED_P()); /* ugen_do_close */
    770  1.163  riastrad 
    771  1.163  riastrad 	if ((sc = ugenif_acquire(UGENUNIT(dev))) == NULL)
    772  1.163  riastrad 		return ENXIO;
    773  1.163  riastrad 
    774  1.163  riastrad 	KASSERT(sc->sc_is_open[endpt]);
    775  1.163  riastrad 	ugen_do_close(sc, flag, endpt);
    776  1.163  riastrad 	KASSERT(!sc->sc_is_open[endpt]);
    777  1.163  riastrad 
    778  1.163  riastrad 	ugenif_release(sc);
    779  1.163  riastrad 
    780  1.163  riastrad 	return 0;
    781    1.1  augustss }
    782    1.1  augustss 
    783   1.37  augustss Static int
    784   1.40  augustss ugen_do_read(struct ugen_softc *sc, int endpt, struct uio *uio, int flag)
    785    1.1  augustss {
    786    1.1  augustss 	struct ugen_endpoint *sce = &sc->sc_endpoints[endpt][IN];
    787  1.133     skrll 	uint32_t n, tn;
    788  1.133     skrll 	struct usbd_xfer *xfer;
    789   1.28  augustss 	usbd_status err;
    790    1.1  augustss 	int error = 0;
    791    1.1  augustss 
    792  1.111    dyoung 	DPRINTFN(5, ("%s: ugenread: %d\n", device_xname(sc->sc_dev), endpt));
    793   1.26  augustss 
    794   1.26  augustss 	if (endpt == USB_CONTROL_ENDPOINT)
    795  1.133     skrll 		return ENODEV;
    796   1.26  augustss 
    797  1.154  riastrad 	KASSERT(sce->edesc);
    798  1.154  riastrad 	KASSERT(sce->pipeh);
    799    1.1  augustss 
    800    1.1  augustss 	switch (sce->edesc->bmAttributes & UE_XFERTYPE) {
    801    1.1  augustss 	case UE_INTERRUPT:
    802   1.47       wiz 		/* Block until activity occurred. */
    803  1.120       mrg 		mutex_enter(&sc->sc_lock);
    804    1.1  augustss 		while (sce->q.c_cc == 0) {
    805    1.1  augustss 			if (flag & IO_NDELAY) {
    806  1.120       mrg 				mutex_exit(&sc->sc_lock);
    807  1.133     skrll 				return EWOULDBLOCK;
    808    1.1  augustss 			}
    809   1.46      yamt 			DPRINTFN(5, ("ugenread: sleep on %p\n", sce));
    810  1.120       mrg 			/* "ugenri" */
    811  1.120       mrg 			error = cv_timedwait_sig(&sce->cv, &sc->sc_lock,
    812  1.120       mrg 			    mstohz(sce->timeout));
    813    1.1  augustss 			DPRINTFN(5, ("ugenread: woke, error=%d\n", error));
    814   1.12  augustss 			if (sc->sc_dying)
    815   1.12  augustss 				error = EIO;
    816  1.152  riastrad 			if (error)
    817   1.12  augustss 				break;
    818    1.1  augustss 		}
    819  1.120       mrg 		mutex_exit(&sc->sc_lock);
    820    1.1  augustss 
    821    1.1  augustss 		/* Transfer as many chunks as possible. */
    822   1.12  augustss 		while (sce->q.c_cc > 0 && uio->uio_resid > 0 && !error) {
    823  1.140  riastrad 			n = uimin(sce->q.c_cc, uio->uio_resid);
    824   1.83  christos 			if (n > sizeof(sc->sc_buffer))
    825   1.83  christos 				n = sizeof(sc->sc_buffer);
    826    1.1  augustss 
    827    1.1  augustss 			/* Remove a small chunk from the input queue. */
    828   1.83  christos 			q_to_b(&sce->q, sc->sc_buffer, n);
    829    1.1  augustss 			DPRINTFN(5, ("ugenread: got %d chars\n", n));
    830    1.1  augustss 
    831    1.1  augustss 			/* Copy the data to the user process. */
    832   1.83  christos 			error = uiomove(sc->sc_buffer, n, uio);
    833    1.1  augustss 			if (error)
    834    1.1  augustss 				break;
    835    1.1  augustss 		}
    836    1.1  augustss 		break;
    837    1.1  augustss 	case UE_BULK:
    838   1.84       gdt 		if (sce->state & UGEN_BULK_RA) {
    839   1.90       wiz 			DPRINTFN(5, ("ugenread: BULK_RA req: %zd used: %d\n",
    840   1.84       gdt 				     uio->uio_resid, sce->ra_wb_used));
    841   1.84       gdt 			xfer = sce->ra_wb_xfer;
    842   1.84       gdt 
    843  1.120       mrg 			mutex_enter(&sc->sc_lock);
    844   1.84       gdt 			if (sce->ra_wb_used == 0 && flag & IO_NDELAY) {
    845  1.120       mrg 				mutex_exit(&sc->sc_lock);
    846  1.133     skrll 				return EWOULDBLOCK;
    847   1.84       gdt 			}
    848   1.84       gdt 			while (uio->uio_resid > 0 && !error) {
    849   1.84       gdt 				while (sce->ra_wb_used == 0) {
    850   1.84       gdt 					DPRINTFN(5,
    851   1.84       gdt 						 ("ugenread: sleep on %p\n",
    852   1.84       gdt 						  sce));
    853  1.120       mrg 					/* "ugenrb" */
    854  1.120       mrg 					error = cv_timedwait_sig(&sce->cv,
    855  1.120       mrg 					    &sc->sc_lock, mstohz(sce->timeout));
    856   1.84       gdt 					DPRINTFN(5,
    857   1.84       gdt 						 ("ugenread: woke, error=%d\n",
    858   1.84       gdt 						  error));
    859   1.84       gdt 					if (sc->sc_dying)
    860   1.84       gdt 						error = EIO;
    861  1.152  riastrad 					if (error)
    862   1.84       gdt 						break;
    863   1.84       gdt 				}
    864   1.84       gdt 
    865   1.84       gdt 				/* Copy data to the process. */
    866   1.84       gdt 				while (uio->uio_resid > 0
    867   1.84       gdt 				       && sce->ra_wb_used > 0) {
    868  1.140  riastrad 					n = uimin(uio->uio_resid,
    869   1.84       gdt 						sce->ra_wb_used);
    870  1.140  riastrad 					n = uimin(n, sce->limit - sce->cur);
    871   1.84       gdt 					error = uiomove(sce->cur, n, uio);
    872   1.84       gdt 					if (error)
    873   1.84       gdt 						break;
    874   1.84       gdt 					sce->cur += n;
    875   1.84       gdt 					sce->ra_wb_used -= n;
    876   1.84       gdt 					if (sce->cur == sce->limit)
    877   1.84       gdt 						sce->cur = sce->ibuf;
    878   1.84       gdt 				}
    879   1.84       gdt 
    880  1.122  christos 				/*
    881   1.84       gdt 				 * If the transfers stopped because the
    882   1.84       gdt 				 * buffer was full, restart them.
    883   1.84       gdt 				 */
    884   1.84       gdt 				if (sce->state & UGEN_RA_WB_STOP &&
    885   1.84       gdt 				    sce->ra_wb_used < sce->limit - sce->ibuf) {
    886   1.84       gdt 					n = (sce->limit - sce->ibuf)
    887   1.84       gdt 					    - sce->ra_wb_used;
    888  1.133     skrll 					usbd_setup_xfer(xfer, sce, NULL,
    889  1.140  riastrad 					    uimin(n, sce->ra_wb_xferlen),
    890  1.133     skrll 					    0, USBD_NO_TIMEOUT,
    891   1.84       gdt 					    ugen_bulkra_intr);
    892   1.84       gdt 					sce->state &= ~UGEN_RA_WB_STOP;
    893   1.84       gdt 					err = usbd_transfer(xfer);
    894   1.84       gdt 					if (err != USBD_IN_PROGRESS)
    895   1.84       gdt 						/*
    896   1.84       gdt 						 * The transfer has not been
    897   1.84       gdt 						 * queued.  Setting STOP
    898   1.84       gdt 						 * will make us try
    899   1.84       gdt 						 * again at the next read.
    900   1.84       gdt 						 */
    901   1.84       gdt 						sce->state |= UGEN_RA_WB_STOP;
    902   1.84       gdt 				}
    903   1.84       gdt 			}
    904  1.120       mrg 			mutex_exit(&sc->sc_lock);
    905   1.84       gdt 			break;
    906   1.84       gdt 		}
    907  1.133     skrll 		error = usbd_create_xfer(sce->pipeh, UGEN_BBSIZE,
    908  1.137     skrll 		    0, 0, &xfer);
    909  1.133     skrll 		if (error)
    910  1.133     skrll 			return error;
    911  1.140  riastrad 		while ((n = uimin(UGEN_BBSIZE, uio->uio_resid)) != 0) {
    912   1.10  augustss 			DPRINTFN(1, ("ugenread: start transfer %d bytes\n",n));
    913   1.10  augustss 			tn = n;
    914  1.133     skrll 			err = usbd_bulk_transfer(xfer, sce->pipeh,
    915  1.133     skrll 			    sce->state & UGEN_SHORT_OK ? USBD_SHORT_XFER_OK : 0,
    916  1.133     skrll 			    sce->timeout, sc->sc_buffer, &tn);
    917   1.30  augustss 			if (err) {
    918   1.28  augustss 				if (err == USBD_INTERRUPTED)
    919    1.8  augustss 					error = EINTR;
    920   1.28  augustss 				else if (err == USBD_TIMEOUT)
    921   1.17  augustss 					error = ETIMEDOUT;
    922    1.8  augustss 				else
    923    1.8  augustss 					error = EIO;
    924    1.1  augustss 				break;
    925    1.1  augustss 			}
    926   1.10  augustss 			DPRINTFN(1, ("ugenread: got %d bytes\n", tn));
    927   1.83  christos 			error = uiomove(sc->sc_buffer, tn, uio);
    928    1.9  augustss 			if (error || tn < n)
    929    1.1  augustss 				break;
    930    1.1  augustss 		}
    931  1.133     skrll 		usbd_destroy_xfer(xfer);
    932    1.1  augustss 		break;
    933   1.41  augustss 	case UE_ISOCHRONOUS:
    934  1.120       mrg 		mutex_enter(&sc->sc_lock);
    935   1.41  augustss 		while (sce->cur == sce->fill) {
    936   1.41  augustss 			if (flag & IO_NDELAY) {
    937  1.120       mrg 				mutex_exit(&sc->sc_lock);
    938  1.133     skrll 				return EWOULDBLOCK;
    939   1.41  augustss 			}
    940  1.120       mrg 			/* "ugenri" */
    941   1.46      yamt 			DPRINTFN(5, ("ugenread: sleep on %p\n", sce));
    942  1.120       mrg 			error = cv_timedwait_sig(&sce->cv, &sc->sc_lock,
    943  1.120       mrg 			    mstohz(sce->timeout));
    944   1.41  augustss 			DPRINTFN(5, ("ugenread: woke, error=%d\n", error));
    945   1.41  augustss 			if (sc->sc_dying)
    946   1.41  augustss 				error = EIO;
    947  1.152  riastrad 			if (error)
    948   1.41  augustss 				break;
    949   1.41  augustss 		}
    950   1.41  augustss 
    951   1.41  augustss 		while (sce->cur != sce->fill && uio->uio_resid > 0 && !error) {
    952   1.41  augustss 			if(sce->fill > sce->cur)
    953  1.140  riastrad 				n = uimin(sce->fill - sce->cur, uio->uio_resid);
    954   1.41  augustss 			else
    955  1.140  riastrad 				n = uimin(sce->limit - sce->cur, uio->uio_resid);
    956   1.41  augustss 
    957   1.41  augustss 			DPRINTFN(5, ("ugenread: isoc got %d chars\n", n));
    958   1.41  augustss 
    959   1.41  augustss 			/* Copy the data to the user process. */
    960   1.41  augustss 			error = uiomove(sce->cur, n, uio);
    961   1.41  augustss 			if (error)
    962   1.41  augustss 				break;
    963   1.41  augustss 			sce->cur += n;
    964  1.120       mrg 			if (sce->cur >= sce->limit)
    965   1.41  augustss 				sce->cur = sce->ibuf;
    966   1.41  augustss 		}
    967  1.120       mrg 		mutex_exit(&sc->sc_lock);
    968   1.41  augustss 		break;
    969   1.41  augustss 
    970   1.59  augustss 
    971    1.1  augustss 	default:
    972  1.133     skrll 		return ENXIO;
    973    1.1  augustss 	}
    974  1.133     skrll 	return error;
    975    1.1  augustss }
    976    1.1  augustss 
    977  1.147      maxv static int
    978   1.40  augustss ugenread(dev_t dev, struct uio *uio, int flag)
    979    1.1  augustss {
    980    1.1  augustss 	int endpt = UGENENDPOINT(dev);
    981   1.24  augustss 	struct ugen_softc *sc;
    982   1.12  augustss 	int error;
    983   1.12  augustss 
    984  1.155  riastrad 	if ((sc = ugenif_acquire(UGENUNIT(dev))) == NULL)
    985  1.111    dyoung 		return ENXIO;
    986   1.12  augustss 	error = ugen_do_read(sc, endpt, uio, flag);
    987  1.155  riastrad 	ugenif_release(sc);
    988  1.120       mrg 
    989  1.133     skrll 	return error;
    990   1.12  augustss }
    991   1.12  augustss 
    992   1.37  augustss Static int
    993   1.87   xtraeme ugen_do_write(struct ugen_softc *sc, int endpt, struct uio *uio,
    994   1.88  christos 	int flag)
    995   1.12  augustss {
    996   1.10  augustss 	struct ugen_endpoint *sce = &sc->sc_endpoints[endpt][OUT];
    997  1.133     skrll 	uint32_t n;
    998    1.1  augustss 	int error = 0;
    999  1.133     skrll 	uint32_t tn;
   1000   1.84       gdt 	char *dbuf;
   1001  1.133     skrll 	struct usbd_xfer *xfer;
   1002   1.28  augustss 	usbd_status err;
   1003    1.1  augustss 
   1004  1.111    dyoung 	DPRINTFN(5, ("%s: ugenwrite: %d\n", device_xname(sc->sc_dev), endpt));
   1005   1.26  augustss 
   1006   1.26  augustss 	if (endpt == USB_CONTROL_ENDPOINT)
   1007  1.133     skrll 		return ENODEV;
   1008   1.26  augustss 
   1009  1.154  riastrad 	KASSERT(sce->edesc);
   1010  1.154  riastrad 	KASSERT(sce->pipeh);
   1011    1.1  augustss 
   1012    1.1  augustss 	switch (sce->edesc->bmAttributes & UE_XFERTYPE) {
   1013    1.1  augustss 	case UE_BULK:
   1014   1.84       gdt 		if (sce->state & UGEN_BULK_WB) {
   1015   1.90       wiz 			DPRINTFN(5, ("ugenwrite: BULK_WB req: %zd used: %d\n",
   1016   1.84       gdt 				     uio->uio_resid, sce->ra_wb_used));
   1017   1.84       gdt 			xfer = sce->ra_wb_xfer;
   1018   1.84       gdt 
   1019  1.120       mrg 			mutex_enter(&sc->sc_lock);
   1020   1.84       gdt 			if (sce->ra_wb_used == sce->limit - sce->ibuf &&
   1021   1.84       gdt 			    flag & IO_NDELAY) {
   1022  1.120       mrg 				mutex_exit(&sc->sc_lock);
   1023  1.133     skrll 				return EWOULDBLOCK;
   1024   1.84       gdt 			}
   1025   1.84       gdt 			while (uio->uio_resid > 0 && !error) {
   1026  1.122  christos 				while (sce->ra_wb_used ==
   1027   1.84       gdt 				       sce->limit - sce->ibuf) {
   1028   1.84       gdt 					DPRINTFN(5,
   1029   1.84       gdt 						 ("ugenwrite: sleep on %p\n",
   1030   1.84       gdt 						  sce));
   1031  1.120       mrg 					/* "ugenwb" */
   1032  1.120       mrg 					error = cv_timedwait_sig(&sce->cv,
   1033  1.120       mrg 					    &sc->sc_lock, mstohz(sce->timeout));
   1034   1.84       gdt 					DPRINTFN(5,
   1035   1.84       gdt 						 ("ugenwrite: woke, error=%d\n",
   1036   1.84       gdt 						  error));
   1037   1.84       gdt 					if (sc->sc_dying)
   1038   1.84       gdt 						error = EIO;
   1039  1.152  riastrad 					if (error)
   1040   1.84       gdt 						break;
   1041   1.84       gdt 				}
   1042   1.84       gdt 
   1043   1.84       gdt 				/* Copy data from the process. */
   1044   1.84       gdt 				while (uio->uio_resid > 0 &&
   1045   1.84       gdt 				    sce->ra_wb_used < sce->limit - sce->ibuf) {
   1046  1.140  riastrad 					n = uimin(uio->uio_resid,
   1047   1.84       gdt 						(sce->limit - sce->ibuf)
   1048   1.84       gdt 						 - sce->ra_wb_used);
   1049  1.140  riastrad 					n = uimin(n, sce->limit - sce->fill);
   1050   1.84       gdt 					error = uiomove(sce->fill, n, uio);
   1051   1.84       gdt 					if (error)
   1052   1.84       gdt 						break;
   1053   1.84       gdt 					sce->fill += n;
   1054   1.84       gdt 					sce->ra_wb_used += n;
   1055   1.84       gdt 					if (sce->fill == sce->limit)
   1056   1.84       gdt 						sce->fill = sce->ibuf;
   1057   1.84       gdt 				}
   1058   1.84       gdt 
   1059   1.84       gdt 				/*
   1060   1.84       gdt 				 * If the transfers stopped because the
   1061   1.84       gdt 				 * buffer was empty, restart them.
   1062   1.84       gdt 				 */
   1063   1.84       gdt 				if (sce->state & UGEN_RA_WB_STOP &&
   1064   1.84       gdt 				    sce->ra_wb_used > 0) {
   1065   1.84       gdt 					dbuf = (char *)usbd_get_buffer(xfer);
   1066  1.140  riastrad 					n = uimin(sce->ra_wb_used,
   1067   1.84       gdt 						sce->ra_wb_xferlen);
   1068  1.140  riastrad 					tn = uimin(n, sce->limit - sce->cur);
   1069   1.84       gdt 					memcpy(dbuf, sce->cur, tn);
   1070   1.84       gdt 					dbuf += tn;
   1071   1.84       gdt 					if (n - tn > 0)
   1072   1.84       gdt 						memcpy(dbuf, sce->ibuf,
   1073   1.84       gdt 						       n - tn);
   1074  1.133     skrll 					usbd_setup_xfer(xfer, sce, NULL, n,
   1075  1.133     skrll 					    0, USBD_NO_TIMEOUT,
   1076   1.84       gdt 					    ugen_bulkwb_intr);
   1077   1.84       gdt 					sce->state &= ~UGEN_RA_WB_STOP;
   1078   1.84       gdt 					err = usbd_transfer(xfer);
   1079   1.84       gdt 					if (err != USBD_IN_PROGRESS)
   1080   1.84       gdt 						/*
   1081   1.84       gdt 						 * The transfer has not been
   1082   1.84       gdt 						 * queued.  Setting STOP
   1083   1.84       gdt 						 * will make us try again
   1084   1.84       gdt 						 * at the next read.
   1085   1.84       gdt 						 */
   1086   1.84       gdt 						sce->state |= UGEN_RA_WB_STOP;
   1087   1.84       gdt 				}
   1088   1.84       gdt 			}
   1089  1.120       mrg 			mutex_exit(&sc->sc_lock);
   1090   1.84       gdt 			break;
   1091   1.84       gdt 		}
   1092  1.133     skrll 		error = usbd_create_xfer(sce->pipeh, UGEN_BBSIZE,
   1093  1.137     skrll 		    0, 0, &xfer);
   1094  1.133     skrll 		if (error)
   1095  1.133     skrll 			return error;
   1096  1.140  riastrad 		while ((n = uimin(UGEN_BBSIZE, uio->uio_resid)) != 0) {
   1097   1.83  christos 			error = uiomove(sc->sc_buffer, n, uio);
   1098    1.1  augustss 			if (error)
   1099    1.1  augustss 				break;
   1100    1.1  augustss 			DPRINTFN(1, ("ugenwrite: transfer %d bytes\n", n));
   1101  1.133     skrll 			err = usbd_bulk_transfer(xfer, sce->pipeh, 0, sce->timeout,
   1102  1.133     skrll 			    sc->sc_buffer, &n);
   1103   1.28  augustss 			if (err) {
   1104   1.28  augustss 				if (err == USBD_INTERRUPTED)
   1105    1.8  augustss 					error = EINTR;
   1106   1.36  augustss 				else if (err == USBD_TIMEOUT)
   1107   1.36  augustss 					error = ETIMEDOUT;
   1108    1.8  augustss 				else
   1109    1.8  augustss 					error = EIO;
   1110    1.1  augustss 				break;
   1111    1.1  augustss 			}
   1112    1.1  augustss 		}
   1113  1.133     skrll 		usbd_destroy_xfer(xfer);
   1114    1.1  augustss 		break;
   1115   1.69  augustss 	case UE_INTERRUPT:
   1116  1.133     skrll 		error = usbd_create_xfer(sce->pipeh,
   1117  1.133     skrll 		    UGETW(sce->edesc->wMaxPacketSize), 0, 0, &xfer);
   1118  1.133     skrll 		if (error)
   1119  1.133     skrll 			return error;
   1120  1.140  riastrad 		while ((n = uimin(UGETW(sce->edesc->wMaxPacketSize),
   1121   1.69  augustss 		    uio->uio_resid)) != 0) {
   1122   1.83  christos 			error = uiomove(sc->sc_buffer, n, uio);
   1123   1.69  augustss 			if (error)
   1124   1.69  augustss 				break;
   1125   1.69  augustss 			DPRINTFN(1, ("ugenwrite: transfer %d bytes\n", n));
   1126   1.69  augustss 			err = usbd_intr_transfer(xfer, sce->pipeh, 0,
   1127  1.133     skrll 			    sce->timeout, sc->sc_buffer, &n);
   1128   1.69  augustss 			if (err) {
   1129   1.69  augustss 				if (err == USBD_INTERRUPTED)
   1130   1.69  augustss 					error = EINTR;
   1131   1.69  augustss 				else if (err == USBD_TIMEOUT)
   1132   1.69  augustss 					error = ETIMEDOUT;
   1133   1.69  augustss 				else
   1134   1.69  augustss 					error = EIO;
   1135   1.69  augustss 				break;
   1136   1.69  augustss 			}
   1137   1.69  augustss 		}
   1138  1.133     skrll 		usbd_destroy_xfer(xfer);
   1139   1.69  augustss 		break;
   1140    1.1  augustss 	default:
   1141  1.133     skrll 		return ENXIO;
   1142    1.1  augustss 	}
   1143  1.133     skrll 	return error;
   1144    1.1  augustss }
   1145    1.1  augustss 
   1146  1.147      maxv static int
   1147   1.40  augustss ugenwrite(dev_t dev, struct uio *uio, int flag)
   1148   1.12  augustss {
   1149   1.12  augustss 	int endpt = UGENENDPOINT(dev);
   1150   1.24  augustss 	struct ugen_softc *sc;
   1151   1.12  augustss 	int error;
   1152   1.12  augustss 
   1153  1.155  riastrad 	if ((sc = ugenif_acquire(UGENUNIT(dev))) == NULL)
   1154  1.111    dyoung 		return ENXIO;
   1155   1.12  augustss 	error = ugen_do_write(sc, endpt, uio, flag);
   1156  1.155  riastrad 	ugenif_release(sc);
   1157  1.120       mrg 
   1158  1.133     skrll 	return error;
   1159   1.12  augustss }
   1160   1.12  augustss 
   1161  1.147      maxv static int
   1162  1.111    dyoung ugen_activate(device_t self, enum devact act)
   1163   1.12  augustss {
   1164   1.99      cube 	struct ugen_softc *sc = device_private(self);
   1165   1.18  augustss 
   1166   1.18  augustss 	switch (act) {
   1167   1.18  augustss 	case DVACT_DEACTIVATE:
   1168   1.18  augustss 		sc->sc_dying = 1;
   1169  1.106    dyoung 		return 0;
   1170  1.106    dyoung 	default:
   1171  1.106    dyoung 		return EOPNOTSUPP;
   1172   1.18  augustss 	}
   1173   1.12  augustss }
   1174   1.12  augustss 
   1175  1.147      maxv static int
   1176  1.111    dyoung ugen_detach(device_t self, int flags)
   1177   1.12  augustss {
   1178  1.111    dyoung 	struct ugen_softc *sc = device_private(self);
   1179   1.12  augustss 	struct ugen_endpoint *sce;
   1180   1.12  augustss 	int i, dir;
   1181   1.25  augustss 	int maj, mn;
   1182   1.12  augustss 
   1183   1.12  augustss 	DPRINTF(("ugen_detach: sc=%p flags=%d\n", sc, flags));
   1184   1.12  augustss 
   1185  1.162  riastrad 	KASSERT(KERNEL_LOCKED_P()); /* sc_is_open */
   1186  1.162  riastrad 
   1187  1.162  riastrad 	/*
   1188  1.162  riastrad 	 * Fail if we're not forced to detach and userland has any
   1189  1.162  riastrad 	 * endpoints open.
   1190  1.162  riastrad 	 */
   1191  1.162  riastrad 	if ((flags & DETACH_FORCE) == 0) {
   1192  1.162  riastrad 		for (i = 0; i < USB_MAX_ENDPOINTS; i++) {
   1193  1.162  riastrad 			if (sc->sc_is_open[i])
   1194  1.162  riastrad 				return EBUSY;
   1195  1.162  riastrad 		}
   1196  1.162  riastrad 	}
   1197  1.162  riastrad 
   1198  1.162  riastrad 	/* Prevent new users.  Prevent suspend/resume.  */
   1199   1.12  augustss 	sc->sc_dying = 1;
   1200   1.96       smb 	pmf_device_deregister(self);
   1201  1.157  riastrad 
   1202  1.162  riastrad 	/*
   1203  1.162  riastrad 	 * If we never finished attaching, skip nixing endpoints and
   1204  1.162  riastrad 	 * users because there aren't any.
   1205  1.162  riastrad 	 */
   1206  1.157  riastrad 	if (!sc->sc_attached)
   1207  1.157  riastrad 		goto out;
   1208  1.157  riastrad 
   1209  1.164  riastrad 	/* Abort all pipes.  */
   1210   1.12  augustss 	for (i = 0; i < USB_MAX_ENDPOINTS; i++) {
   1211   1.12  augustss 		for (dir = OUT; dir <= IN; dir++) {
   1212   1.12  augustss 			sce = &sc->sc_endpoints[i][dir];
   1213  1.129     skrll 			if (sce->pipeh)
   1214   1.12  augustss 				usbd_abort_pipe(sce->pipeh);
   1215   1.12  augustss 		}
   1216   1.12  augustss 	}
   1217   1.12  augustss 
   1218  1.120       mrg 	mutex_enter(&sc->sc_lock);
   1219   1.12  augustss 	if (--sc->sc_refcnt >= 0) {
   1220   1.12  augustss 		/* Wake everyone */
   1221  1.164  riastrad 		for (i = 0; i < USB_MAX_ENDPOINTS; i++) {
   1222  1.164  riastrad 			for (dir = OUT; dir <= IN; dir++)
   1223  1.164  riastrad 				cv_signal(&sc->sc_endpoints[i][dir].cv);
   1224  1.164  riastrad 		}
   1225   1.12  augustss 		/* Wait for processes to go away. */
   1226  1.144     skrll 		if (cv_timedwait(&sc->sc_detach_cv, &sc->sc_lock, hz * 60))
   1227  1.144     skrll 			aprint_error_dev(self, ": didn't detach\n");
   1228   1.12  augustss 	}
   1229  1.120       mrg 	mutex_exit(&sc->sc_lock);
   1230   1.12  augustss 
   1231   1.12  augustss 	/* locate the major number */
   1232   1.60   gehenna 	maj = cdevsw_lookup_major(&ugen_cdevsw);
   1233   1.12  augustss 
   1234  1.163  riastrad 	/*
   1235  1.163  riastrad 	 * Nuke the vnodes for any open instances (calls ugenclose, but
   1236  1.163  riastrad 	 * with no effect because we already set sc_dying).
   1237  1.163  riastrad 	 */
   1238  1.155  riastrad 	mn = sc->sc_unit * USB_MAX_ENDPOINTS;
   1239   1.12  augustss 	vdevgone(maj, mn, mn + USB_MAX_ENDPOINTS - 1, VCHR);
   1240   1.33  augustss 
   1241  1.163  riastrad 	/* Actually close any lingering pipes.  */
   1242  1.163  riastrad 	for (i = 0; i < USB_MAX_ENDPOINTS; i++)
   1243  1.163  riastrad 		ugen_do_close(sc, FREAD|FWRITE, i);
   1244  1.163  riastrad 
   1245  1.134   msaitoh 	usbd_add_drv_event(USB_EVENT_DRIVER_DETACH, sc->sc_udev, sc->sc_dev);
   1246  1.155  riastrad 	ugenif_put_unit(sc);
   1247   1.12  augustss 
   1248  1.157  riastrad out:	for (i = 0; i < USB_MAX_ENDPOINTS; i++) {
   1249   1.97     rmind 		for (dir = OUT; dir <= IN; dir++) {
   1250   1.97     rmind 			sce = &sc->sc_endpoints[i][dir];
   1251   1.97     rmind 			seldestroy(&sce->rsel);
   1252  1.120       mrg 			cv_destroy(&sce->cv);
   1253   1.97     rmind 		}
   1254   1.97     rmind 	}
   1255   1.97     rmind 
   1256  1.120       mrg 	cv_destroy(&sc->sc_detach_cv);
   1257  1.120       mrg 	mutex_destroy(&sc->sc_lock);
   1258  1.120       mrg 
   1259  1.133     skrll 	return 0;
   1260   1.12  augustss }
   1261    1.1  augustss 
   1262   1.37  augustss Static void
   1263  1.133     skrll ugenintr(struct usbd_xfer *xfer, void *addr, usbd_status status)
   1264    1.1  augustss {
   1265    1.1  augustss 	struct ugen_endpoint *sce = addr;
   1266  1.120       mrg 	struct ugen_softc *sc = sce->sc;
   1267  1.133     skrll 	uint32_t count;
   1268    1.1  augustss 	u_char *ibuf;
   1269    1.1  augustss 
   1270    1.1  augustss 	if (status == USBD_CANCELLED)
   1271    1.1  augustss 		return;
   1272    1.1  augustss 
   1273    1.1  augustss 	if (status != USBD_NORMAL_COMPLETION) {
   1274    1.1  augustss 		DPRINTF(("ugenintr: status=%d\n", status));
   1275   1.52  augustss 		if (status == USBD_STALLED)
   1276   1.52  augustss 		    usbd_clear_endpoint_stall_async(sce->pipeh);
   1277    1.1  augustss 		return;
   1278    1.1  augustss 	}
   1279    1.1  augustss 
   1280   1.34  augustss 	usbd_get_xfer_status(xfer, NULL, NULL, &count, NULL);
   1281    1.1  augustss 	ibuf = sce->ibuf;
   1282    1.1  augustss 
   1283   1.55  augustss 	DPRINTFN(5, ("ugenintr: xfer=%p status=%d count=%d\n",
   1284   1.28  augustss 		     xfer, status, count));
   1285    1.1  augustss 	DPRINTFN(5, ("          data = %02x %02x %02x\n",
   1286    1.8  augustss 		     ibuf[0], ibuf[1], ibuf[2]));
   1287    1.1  augustss 
   1288  1.152  riastrad 	mutex_enter(&sc->sc_lock);
   1289    1.8  augustss 	(void)b_to_q(ibuf, count, &sce->q);
   1290  1.152  riastrad 	cv_signal(&sce->cv);
   1291  1.120       mrg 	mutex_exit(&sc->sc_lock);
   1292   1.97     rmind 	selnotify(&sce->rsel, 0, 0);
   1293    1.1  augustss }
   1294    1.1  augustss 
   1295   1.41  augustss Static void
   1296  1.133     skrll ugen_isoc_rintr(struct usbd_xfer *xfer, void *addr,
   1297   1.42  augustss 		usbd_status status)
   1298   1.41  augustss {
   1299   1.41  augustss 	struct isoreq *req = addr;
   1300   1.41  augustss 	struct ugen_endpoint *sce = req->sce;
   1301  1.120       mrg 	struct ugen_softc *sc = sce->sc;
   1302  1.133     skrll 	uint32_t count, n;
   1303   1.48      yamt 	int i, isize;
   1304   1.41  augustss 
   1305   1.41  augustss 	/* Return if we are aborting. */
   1306   1.41  augustss 	if (status == USBD_CANCELLED)
   1307   1.41  augustss 		return;
   1308   1.41  augustss 
   1309   1.41  augustss 	usbd_get_xfer_status(xfer, NULL, NULL, &count, NULL);
   1310   1.66   mycroft 	DPRINTFN(5,("ugen_isoc_rintr: xfer %ld, count=%d\n",
   1311   1.66   mycroft 	    (long)(req - sce->isoreqs), count));
   1312   1.41  augustss 
   1313  1.152  riastrad 	mutex_enter(&sc->sc_lock);
   1314  1.152  riastrad 
   1315   1.41  augustss 	/* throw away oldest input if the buffer is full */
   1316  1.152  riastrad 	if (sce->fill < sce->cur && sce->cur <= sce->fill + count) {
   1317   1.41  augustss 		sce->cur += count;
   1318  1.152  riastrad 		if (sce->cur >= sce->limit)
   1319   1.41  augustss 			sce->cur = sce->ibuf + (sce->limit - sce->cur);
   1320   1.41  augustss 		DPRINTFN(5, ("ugen_isoc_rintr: throwing away %d bytes\n",
   1321   1.41  augustss 			     count));
   1322   1.41  augustss 	}
   1323   1.41  augustss 
   1324   1.48      yamt 	isize = UGETW(sce->edesc->wMaxPacketSize);
   1325   1.48      yamt 	for (i = 0; i < UGEN_NISORFRMS; i++) {
   1326  1.133     skrll 		uint32_t actlen = req->sizes[i];
   1327   1.74  christos 		char const *tbuf = (char const *)req->dmabuf + isize * i;
   1328   1.48      yamt 
   1329   1.48      yamt 		/* copy data to buffer */
   1330   1.48      yamt 		while (actlen > 0) {
   1331  1.140  riastrad 			n = uimin(actlen, sce->limit - sce->fill);
   1332   1.74  christos 			memcpy(sce->fill, tbuf, n);
   1333   1.48      yamt 
   1334   1.74  christos 			tbuf += n;
   1335   1.48      yamt 			actlen -= n;
   1336   1.48      yamt 			sce->fill += n;
   1337  1.152  riastrad 			if (sce->fill == sce->limit)
   1338   1.48      yamt 				sce->fill = sce->ibuf;
   1339   1.48      yamt 		}
   1340   1.48      yamt 
   1341   1.48      yamt 		/* setup size for next transfer */
   1342   1.48      yamt 		req->sizes[i] = isize;
   1343   1.41  augustss 	}
   1344   1.41  augustss 
   1345  1.133     skrll 	usbd_setup_isoc_xfer(xfer, req, req->sizes, UGEN_NISORFRMS, 0,
   1346  1.133     skrll 	    ugen_isoc_rintr);
   1347   1.41  augustss 	(void)usbd_transfer(xfer);
   1348   1.41  augustss 
   1349  1.152  riastrad 	cv_signal(&sce->cv);
   1350  1.120       mrg 	mutex_exit(&sc->sc_lock);
   1351   1.97     rmind 	selnotify(&sce->rsel, 0, 0);
   1352   1.41  augustss }
   1353   1.41  augustss 
   1354   1.84       gdt Static void
   1355  1.133     skrll ugen_bulkra_intr(struct usbd_xfer *xfer, void *addr,
   1356   1.84       gdt 		 usbd_status status)
   1357   1.84       gdt {
   1358   1.84       gdt 	struct ugen_endpoint *sce = addr;
   1359  1.120       mrg 	struct ugen_softc *sc = sce->sc;
   1360  1.133     skrll 	uint32_t count, n;
   1361   1.84       gdt 	char const *tbuf;
   1362   1.84       gdt 	usbd_status err;
   1363   1.84       gdt 
   1364   1.84       gdt 	/* Return if we are aborting. */
   1365   1.84       gdt 	if (status == USBD_CANCELLED)
   1366   1.84       gdt 		return;
   1367   1.84       gdt 
   1368   1.84       gdt 	if (status != USBD_NORMAL_COMPLETION) {
   1369   1.84       gdt 		DPRINTF(("ugen_bulkra_intr: status=%d\n", status));
   1370   1.84       gdt 		sce->state |= UGEN_RA_WB_STOP;
   1371   1.84       gdt 		if (status == USBD_STALLED)
   1372   1.84       gdt 		    usbd_clear_endpoint_stall_async(sce->pipeh);
   1373   1.84       gdt 		return;
   1374   1.84       gdt 	}
   1375   1.84       gdt 
   1376   1.84       gdt 	usbd_get_xfer_status(xfer, NULL, NULL, &count, NULL);
   1377   1.84       gdt 
   1378  1.152  riastrad 	mutex_enter(&sc->sc_lock);
   1379  1.152  riastrad 
   1380   1.84       gdt 	/* Keep track of how much is in the buffer. */
   1381   1.84       gdt 	sce->ra_wb_used += count;
   1382   1.84       gdt 
   1383   1.84       gdt 	/* Copy data to buffer. */
   1384   1.84       gdt 	tbuf = (char const *)usbd_get_buffer(sce->ra_wb_xfer);
   1385  1.140  riastrad 	n = uimin(count, sce->limit - sce->fill);
   1386   1.84       gdt 	memcpy(sce->fill, tbuf, n);
   1387   1.84       gdt 	tbuf += n;
   1388   1.84       gdt 	count -= n;
   1389   1.84       gdt 	sce->fill += n;
   1390   1.84       gdt 	if (sce->fill == sce->limit)
   1391   1.84       gdt 		sce->fill = sce->ibuf;
   1392   1.84       gdt 	if (count > 0) {
   1393   1.84       gdt 		memcpy(sce->fill, tbuf, count);
   1394   1.84       gdt 		sce->fill += count;
   1395   1.84       gdt 	}
   1396   1.84       gdt 
   1397   1.84       gdt 	/* Set up the next request if necessary. */
   1398   1.84       gdt 	n = (sce->limit - sce->ibuf) - sce->ra_wb_used;
   1399   1.84       gdt 	if (n > 0) {
   1400  1.140  riastrad 		usbd_setup_xfer(xfer, sce, NULL, uimin(n, sce->ra_wb_xferlen), 0,
   1401   1.84       gdt 		    USBD_NO_TIMEOUT, ugen_bulkra_intr);
   1402   1.84       gdt 		err = usbd_transfer(xfer);
   1403   1.84       gdt 		if (err != USBD_IN_PROGRESS) {
   1404   1.84       gdt 			printf("usbd_bulkra_intr: error=%d\n", err);
   1405   1.84       gdt 			/*
   1406   1.84       gdt 			 * The transfer has not been queued.  Setting STOP
   1407   1.84       gdt 			 * will make us try again at the next read.
   1408   1.84       gdt 			 */
   1409   1.84       gdt 			sce->state |= UGEN_RA_WB_STOP;
   1410   1.84       gdt 		}
   1411   1.84       gdt 	}
   1412   1.84       gdt 	else
   1413   1.84       gdt 		sce->state |= UGEN_RA_WB_STOP;
   1414   1.84       gdt 
   1415  1.152  riastrad 	cv_signal(&sce->cv);
   1416  1.120       mrg 	mutex_exit(&sc->sc_lock);
   1417   1.97     rmind 	selnotify(&sce->rsel, 0, 0);
   1418   1.84       gdt }
   1419   1.84       gdt 
   1420   1.84       gdt Static void
   1421  1.133     skrll ugen_bulkwb_intr(struct usbd_xfer *xfer, void *addr,
   1422   1.84       gdt 		 usbd_status status)
   1423   1.84       gdt {
   1424   1.84       gdt 	struct ugen_endpoint *sce = addr;
   1425  1.120       mrg 	struct ugen_softc *sc = sce->sc;
   1426  1.133     skrll 	uint32_t count, n;
   1427   1.84       gdt 	char *tbuf;
   1428   1.84       gdt 	usbd_status err;
   1429   1.84       gdt 
   1430   1.84       gdt 	/* Return if we are aborting. */
   1431   1.84       gdt 	if (status == USBD_CANCELLED)
   1432   1.84       gdt 		return;
   1433   1.84       gdt 
   1434   1.84       gdt 	if (status != USBD_NORMAL_COMPLETION) {
   1435   1.84       gdt 		DPRINTF(("ugen_bulkwb_intr: status=%d\n", status));
   1436   1.84       gdt 		sce->state |= UGEN_RA_WB_STOP;
   1437   1.84       gdt 		if (status == USBD_STALLED)
   1438   1.84       gdt 		    usbd_clear_endpoint_stall_async(sce->pipeh);
   1439   1.84       gdt 		return;
   1440   1.84       gdt 	}
   1441   1.84       gdt 
   1442   1.84       gdt 	usbd_get_xfer_status(xfer, NULL, NULL, &count, NULL);
   1443   1.84       gdt 
   1444  1.152  riastrad 	mutex_enter(&sc->sc_lock);
   1445  1.152  riastrad 
   1446   1.84       gdt 	/* Keep track of how much is in the buffer. */
   1447   1.84       gdt 	sce->ra_wb_used -= count;
   1448   1.84       gdt 
   1449   1.84       gdt 	/* Update buffer pointers. */
   1450   1.84       gdt 	sce->cur += count;
   1451   1.84       gdt 	if (sce->cur >= sce->limit)
   1452  1.122  christos 		sce->cur = sce->ibuf + (sce->cur - sce->limit);
   1453   1.84       gdt 
   1454   1.84       gdt 	/* Set up next request if necessary. */
   1455   1.84       gdt 	if (sce->ra_wb_used > 0) {
   1456   1.84       gdt 		/* copy data from buffer */
   1457   1.84       gdt 		tbuf = (char *)usbd_get_buffer(sce->ra_wb_xfer);
   1458  1.140  riastrad 		count = uimin(sce->ra_wb_used, sce->ra_wb_xferlen);
   1459  1.140  riastrad 		n = uimin(count, sce->limit - sce->cur);
   1460   1.84       gdt 		memcpy(tbuf, sce->cur, n);
   1461   1.84       gdt 		tbuf += n;
   1462   1.84       gdt 		if (count - n > 0)
   1463   1.84       gdt 			memcpy(tbuf, sce->ibuf, count - n);
   1464   1.84       gdt 
   1465  1.133     skrll 		usbd_setup_xfer(xfer, sce, NULL, count, 0, USBD_NO_TIMEOUT,
   1466  1.133     skrll 		    ugen_bulkwb_intr);
   1467   1.84       gdt 		err = usbd_transfer(xfer);
   1468   1.84       gdt 		if (err != USBD_IN_PROGRESS) {
   1469   1.84       gdt 			printf("usbd_bulkwb_intr: error=%d\n", err);
   1470   1.84       gdt 			/*
   1471   1.84       gdt 			 * The transfer has not been queued.  Setting STOP
   1472   1.84       gdt 			 * will make us try again at the next write.
   1473   1.84       gdt 			 */
   1474   1.84       gdt 			sce->state |= UGEN_RA_WB_STOP;
   1475   1.84       gdt 		}
   1476   1.84       gdt 	}
   1477   1.84       gdt 	else
   1478   1.84       gdt 		sce->state |= UGEN_RA_WB_STOP;
   1479   1.84       gdt 
   1480  1.152  riastrad 	cv_signal(&sce->cv);
   1481  1.120       mrg 	mutex_exit(&sc->sc_lock);
   1482   1.97     rmind 	selnotify(&sce->rsel, 0, 0);
   1483   1.84       gdt }
   1484   1.84       gdt 
   1485   1.37  augustss Static usbd_status
   1486   1.40  augustss ugen_set_interface(struct ugen_softc *sc, int ifaceidx, int altno)
   1487    1.1  augustss {
   1488  1.133     skrll 	struct usbd_interface *iface;
   1489    1.1  augustss 	usb_endpoint_descriptor_t *ed;
   1490   1.28  augustss 	usbd_status err;
   1491    1.1  augustss 	struct ugen_endpoint *sce;
   1492  1.133     skrll 	uint8_t niface, nendpt, endptno, endpt;
   1493   1.21  augustss 	int dir;
   1494    1.1  augustss 
   1495    1.1  augustss 	DPRINTFN(15, ("ugen_set_interface %d %d\n", ifaceidx, altno));
   1496    1.1  augustss 
   1497   1.28  augustss 	err = usbd_interface_count(sc->sc_udev, &niface);
   1498   1.28  augustss 	if (err)
   1499  1.133     skrll 		return err;
   1500    1.1  augustss 	if (ifaceidx < 0 || ifaceidx >= niface)
   1501  1.133     skrll 		return USBD_INVAL;
   1502   1.59  augustss 
   1503   1.28  augustss 	err = usbd_device2interface_handle(sc->sc_udev, ifaceidx, &iface);
   1504   1.28  augustss 	if (err)
   1505  1.133     skrll 		return err;
   1506   1.28  augustss 	err = usbd_endpoint_count(iface, &nendpt);
   1507   1.28  augustss 	if (err)
   1508  1.133     skrll 		return err;
   1509    1.1  augustss 
   1510    1.1  augustss 	/* change setting */
   1511   1.28  augustss 	err = usbd_set_interface(iface, altno);
   1512   1.28  augustss 	if (err)
   1513  1.133     skrll 		return err;
   1514   1.28  augustss 
   1515   1.28  augustss 	err = usbd_endpoint_count(iface, &nendpt);
   1516   1.28  augustss 	if (err)
   1517  1.133     skrll 		return err;
   1518  1.130     skrll 
   1519  1.130     skrll 	ugen_clear_endpoints(sc);
   1520  1.130     skrll 
   1521    1.1  augustss 	for (endptno = 0; endptno < nendpt; endptno++) {
   1522    1.1  augustss 		ed = usbd_interface2endpoint_descriptor(iface,endptno);
   1523   1.81  christos 		KASSERT(ed != NULL);
   1524    1.1  augustss 		endpt = ed->bEndpointAddress;
   1525   1.21  augustss 		dir = UE_GET_DIR(endpt) == UE_DIR_IN ? IN : OUT;
   1526   1.21  augustss 		sce = &sc->sc_endpoints[UE_GET_ADDR(endpt)][dir];
   1527    1.1  augustss 		sce->sc = sc;
   1528    1.1  augustss 		sce->edesc = ed;
   1529    1.1  augustss 		sce->iface = iface;
   1530    1.1  augustss 	}
   1531  1.133     skrll 	return 0;
   1532    1.1  augustss }
   1533    1.1  augustss 
   1534    1.1  augustss /* Retrieve a complete descriptor for a certain device and index. */
   1535   1.37  augustss Static usb_config_descriptor_t *
   1536   1.40  augustss ugen_get_cdesc(struct ugen_softc *sc, int index, int *lenp)
   1537    1.1  augustss {
   1538    1.1  augustss 	usb_config_descriptor_t *cdesc, *tdesc, cdescr;
   1539    1.1  augustss 	int len;
   1540   1.28  augustss 	usbd_status err;
   1541    1.1  augustss 
   1542    1.1  augustss 	if (index == USB_CURRENT_CONFIG_INDEX) {
   1543    1.1  augustss 		tdesc = usbd_get_config_descriptor(sc->sc_udev);
   1544  1.148    bouyer 		if (tdesc == NULL)
   1545  1.148    bouyer 			return NULL;
   1546    1.1  augustss 		len = UGETW(tdesc->wTotalLength);
   1547    1.1  augustss 		if (lenp)
   1548    1.1  augustss 			*lenp = len;
   1549  1.133     skrll 		cdesc = kmem_alloc(len, KM_SLEEP);
   1550    1.1  augustss 		memcpy(cdesc, tdesc, len);
   1551    1.1  augustss 		DPRINTFN(5,("ugen_get_cdesc: current, len=%d\n", len));
   1552    1.1  augustss 	} else {
   1553   1.28  augustss 		err = usbd_get_config_desc(sc->sc_udev, index, &cdescr);
   1554   1.28  augustss 		if (err)
   1555  1.133     skrll 			return 0;
   1556    1.1  augustss 		len = UGETW(cdescr.wTotalLength);
   1557    1.1  augustss 		DPRINTFN(5,("ugen_get_cdesc: index=%d, len=%d\n", index, len));
   1558    1.1  augustss 		if (lenp)
   1559    1.1  augustss 			*lenp = len;
   1560  1.133     skrll 		cdesc = kmem_alloc(len, KM_SLEEP);
   1561   1.56  augustss 		err = usbd_get_config_desc_full(sc->sc_udev, index, cdesc, len);
   1562   1.28  augustss 		if (err) {
   1563  1.133     skrll 			kmem_free(cdesc, len);
   1564  1.133     skrll 			return 0;
   1565    1.1  augustss 		}
   1566    1.1  augustss 	}
   1567  1.133     skrll 	return cdesc;
   1568    1.1  augustss }
   1569    1.1  augustss 
   1570   1.37  augustss Static int
   1571   1.40  augustss ugen_get_alt_index(struct ugen_softc *sc, int ifaceidx)
   1572    1.1  augustss {
   1573  1.133     skrll 	struct usbd_interface *iface;
   1574   1.28  augustss 	usbd_status err;
   1575    1.1  augustss 
   1576   1.28  augustss 	err = usbd_device2interface_handle(sc->sc_udev, ifaceidx, &iface);
   1577   1.28  augustss 	if (err)
   1578  1.133     skrll 		return -1;
   1579  1.133     skrll 	return usbd_get_interface_altindex(iface);
   1580    1.1  augustss }
   1581    1.1  augustss 
   1582   1.37  augustss Static int
   1583   1.40  augustss ugen_do_ioctl(struct ugen_softc *sc, int endpt, u_long cmd,
   1584   1.92  christos 	      void *addr, int flag, struct lwp *l)
   1585    1.1  augustss {
   1586    1.8  augustss 	struct ugen_endpoint *sce;
   1587   1.28  augustss 	usbd_status err;
   1588  1.133     skrll 	struct usbd_interface *iface;
   1589    1.1  augustss 	struct usb_config_desc *cd;
   1590    1.1  augustss 	usb_config_descriptor_t *cdesc;
   1591    1.1  augustss 	struct usb_interface_desc *id;
   1592    1.1  augustss 	usb_interface_descriptor_t *idesc;
   1593    1.1  augustss 	struct usb_endpoint_desc *ed;
   1594    1.1  augustss 	usb_endpoint_descriptor_t *edesc;
   1595    1.1  augustss 	struct usb_alt_interface *ai;
   1596    1.2  augustss 	struct usb_string_desc *si;
   1597  1.133     skrll 	uint8_t conf, alt;
   1598  1.133     skrll 	int cdesclen;
   1599  1.133     skrll 	int error;
   1600  1.141      manu 	int dir;
   1601    1.1  augustss 
   1602  1.159  riastrad 	KASSERT(KERNEL_LOCKED_P()); /* ugen_set_config */
   1603  1.159  riastrad 
   1604    1.1  augustss 	DPRINTFN(5, ("ugenioctl: cmd=%08lx\n", cmd));
   1605    1.1  augustss 
   1606    1.2  augustss 	switch (cmd) {
   1607    1.2  augustss 	case FIONBIO:
   1608    1.2  augustss 		/* All handled in the upper FS layer. */
   1609  1.133     skrll 		return 0;
   1610    1.8  augustss 	case USB_SET_SHORT_XFER:
   1611   1.13  augustss 		if (endpt == USB_CONTROL_ENDPOINT)
   1612  1.133     skrll 			return EINVAL;
   1613   1.51  augustss 		/* This flag only affects read */
   1614    1.8  augustss 		sce = &sc->sc_endpoints[endpt][IN];
   1615   1.51  augustss 		if (sce == NULL || sce->pipeh == NULL)
   1616  1.133     skrll 			return EINVAL;
   1617    1.8  augustss 		if (*(int *)addr)
   1618    1.8  augustss 			sce->state |= UGEN_SHORT_OK;
   1619    1.8  augustss 		else
   1620    1.8  augustss 			sce->state &= ~UGEN_SHORT_OK;
   1621  1.133     skrll 		return 0;
   1622   1.17  augustss 	case USB_SET_TIMEOUT:
   1623  1.141      manu 		for (dir = OUT; dir <= IN; dir++) {
   1624  1.141      manu 			sce = &sc->sc_endpoints[endpt][dir];
   1625  1.141      manu 			if (sce == NULL)
   1626  1.141      manu 				return EINVAL;
   1627  1.141      manu 
   1628  1.141      manu 			sce->timeout = *(int *)addr;
   1629  1.141      manu 		}
   1630  1.133     skrll 		return 0;
   1631   1.84       gdt 	case USB_SET_BULK_RA:
   1632   1.84       gdt 		if (endpt == USB_CONTROL_ENDPOINT)
   1633  1.133     skrll 			return EINVAL;
   1634   1.84       gdt 		sce = &sc->sc_endpoints[endpt][IN];
   1635   1.84       gdt 		if (sce == NULL || sce->pipeh == NULL)
   1636  1.133     skrll 			return EINVAL;
   1637   1.84       gdt 		edesc = sce->edesc;
   1638   1.84       gdt 		if ((edesc->bmAttributes & UE_XFERTYPE) != UE_BULK)
   1639  1.133     skrll 			return EINVAL;
   1640   1.84       gdt 
   1641   1.84       gdt 		if (*(int *)addr) {
   1642   1.84       gdt 			/* Only turn RA on if it's currently off. */
   1643   1.84       gdt 			if (sce->state & UGEN_BULK_RA)
   1644  1.133     skrll 				return 0;
   1645   1.84       gdt 
   1646   1.84       gdt 			if (sce->ra_wb_bufsize == 0 || sce->ra_wb_reqsize == 0)
   1647   1.84       gdt 				/* shouldn't happen */
   1648  1.133     skrll 				return EINVAL;
   1649  1.133     skrll 			error = usbd_create_xfer(sce->pipeh,
   1650  1.133     skrll 			    sce->ra_wb_reqsize, 0, 0, &sce->ra_wb_xfer);
   1651  1.133     skrll 			if (error)
   1652  1.133     skrll 				return error;
   1653   1.84       gdt 			sce->ra_wb_xferlen = sce->ra_wb_reqsize;
   1654  1.133     skrll 			sce->ibuf = kmem_alloc(sce->ra_wb_bufsize, KM_SLEEP);
   1655   1.84       gdt 			sce->fill = sce->cur = sce->ibuf;
   1656   1.84       gdt 			sce->limit = sce->ibuf + sce->ra_wb_bufsize;
   1657   1.84       gdt 			sce->ra_wb_used = 0;
   1658   1.84       gdt 			sce->state |= UGEN_BULK_RA;
   1659   1.84       gdt 			sce->state &= ~UGEN_RA_WB_STOP;
   1660   1.84       gdt 			/* Now start reading. */
   1661  1.133     skrll 			usbd_setup_xfer(sce->ra_wb_xfer, sce, NULL,
   1662  1.140  riastrad 			    uimin(sce->ra_wb_xferlen, sce->ra_wb_bufsize),
   1663  1.133     skrll 			     0, USBD_NO_TIMEOUT, ugen_bulkra_intr);
   1664   1.84       gdt 			err = usbd_transfer(sce->ra_wb_xfer);
   1665   1.84       gdt 			if (err != USBD_IN_PROGRESS) {
   1666   1.84       gdt 				sce->state &= ~UGEN_BULK_RA;
   1667  1.133     skrll 				kmem_free(sce->ibuf, sce->ra_wb_bufsize);
   1668   1.84       gdt 				sce->ibuf = NULL;
   1669  1.133     skrll 				usbd_destroy_xfer(sce->ra_wb_xfer);
   1670  1.133     skrll 				return EIO;
   1671   1.84       gdt 			}
   1672   1.84       gdt 		} else {
   1673   1.84       gdt 			/* Only turn RA off if it's currently on. */
   1674   1.84       gdt 			if (!(sce->state & UGEN_BULK_RA))
   1675  1.133     skrll 				return 0;
   1676   1.84       gdt 
   1677   1.84       gdt 			sce->state &= ~UGEN_BULK_RA;
   1678   1.84       gdt 			usbd_abort_pipe(sce->pipeh);
   1679  1.133     skrll 			usbd_destroy_xfer(sce->ra_wb_xfer);
   1680   1.84       gdt 			/*
   1681   1.84       gdt 			 * XXX Discard whatever's in the buffer, but we
   1682   1.84       gdt 			 * should keep it around and drain the buffer
   1683   1.84       gdt 			 * instead.
   1684   1.84       gdt 			 */
   1685  1.133     skrll 			kmem_free(sce->ibuf, sce->ra_wb_bufsize);
   1686   1.84       gdt 			sce->ibuf = NULL;
   1687   1.84       gdt 		}
   1688  1.133     skrll 		return 0;
   1689   1.84       gdt 	case USB_SET_BULK_WB:
   1690   1.84       gdt 		if (endpt == USB_CONTROL_ENDPOINT)
   1691  1.133     skrll 			return EINVAL;
   1692   1.84       gdt 		sce = &sc->sc_endpoints[endpt][OUT];
   1693   1.84       gdt 		if (sce == NULL || sce->pipeh == NULL)
   1694  1.133     skrll 			return EINVAL;
   1695   1.84       gdt 		edesc = sce->edesc;
   1696   1.84       gdt 		if ((edesc->bmAttributes & UE_XFERTYPE) != UE_BULK)
   1697  1.133     skrll 			return EINVAL;
   1698   1.84       gdt 
   1699   1.84       gdt 		if (*(int *)addr) {
   1700   1.84       gdt 			/* Only turn WB on if it's currently off. */
   1701   1.84       gdt 			if (sce->state & UGEN_BULK_WB)
   1702  1.133     skrll 				return 0;
   1703   1.84       gdt 
   1704   1.84       gdt 			if (sce->ra_wb_bufsize == 0 || sce->ra_wb_reqsize == 0)
   1705   1.84       gdt 				/* shouldn't happen */
   1706  1.133     skrll 				return EINVAL;
   1707  1.133     skrll 			error = usbd_create_xfer(sce->pipeh, sce->ra_wb_reqsize,
   1708  1.133     skrll 			    0, 0, &sce->ra_wb_xfer);
   1709   1.84       gdt 			sce->ra_wb_xferlen = sce->ra_wb_reqsize;
   1710  1.133     skrll 			sce->ibuf = kmem_alloc(sce->ra_wb_bufsize, KM_SLEEP);
   1711   1.84       gdt 			sce->fill = sce->cur = sce->ibuf;
   1712   1.84       gdt 			sce->limit = sce->ibuf + sce->ra_wb_bufsize;
   1713   1.84       gdt 			sce->ra_wb_used = 0;
   1714   1.84       gdt 			sce->state |= UGEN_BULK_WB | UGEN_RA_WB_STOP;
   1715   1.84       gdt 		} else {
   1716   1.84       gdt 			/* Only turn WB off if it's currently on. */
   1717   1.84       gdt 			if (!(sce->state & UGEN_BULK_WB))
   1718  1.133     skrll 				return 0;
   1719   1.84       gdt 
   1720   1.84       gdt 			sce->state &= ~UGEN_BULK_WB;
   1721   1.84       gdt 			/*
   1722   1.84       gdt 			 * XXX Discard whatever's in the buffer, but we
   1723  1.122  christos 			 * should keep it around and keep writing to
   1724   1.84       gdt 			 * drain the buffer instead.
   1725   1.84       gdt 			 */
   1726   1.84       gdt 			usbd_abort_pipe(sce->pipeh);
   1727  1.133     skrll 			usbd_destroy_xfer(sce->ra_wb_xfer);
   1728  1.133     skrll 			kmem_free(sce->ibuf, sce->ra_wb_bufsize);
   1729   1.84       gdt 			sce->ibuf = NULL;
   1730   1.84       gdt 		}
   1731  1.133     skrll 		return 0;
   1732   1.84       gdt 	case USB_SET_BULK_RA_OPT:
   1733   1.84       gdt 	case USB_SET_BULK_WB_OPT:
   1734   1.84       gdt 	{
   1735   1.84       gdt 		struct usb_bulk_ra_wb_opt *opt;
   1736   1.84       gdt 
   1737   1.84       gdt 		if (endpt == USB_CONTROL_ENDPOINT)
   1738  1.133     skrll 			return EINVAL;
   1739   1.84       gdt 		opt = (struct usb_bulk_ra_wb_opt *)addr;
   1740   1.84       gdt 		if (cmd == USB_SET_BULK_RA_OPT)
   1741   1.84       gdt 			sce = &sc->sc_endpoints[endpt][IN];
   1742   1.84       gdt 		else
   1743   1.84       gdt 			sce = &sc->sc_endpoints[endpt][OUT];
   1744   1.84       gdt 		if (sce == NULL || sce->pipeh == NULL)
   1745  1.133     skrll 			return EINVAL;
   1746   1.84       gdt 		if (opt->ra_wb_buffer_size < 1 ||
   1747   1.84       gdt 		    opt->ra_wb_buffer_size > UGEN_BULK_RA_WB_BUFMAX ||
   1748   1.84       gdt 		    opt->ra_wb_request_size < 1 ||
   1749   1.84       gdt 		    opt->ra_wb_request_size > opt->ra_wb_buffer_size)
   1750  1.133     skrll 			return EINVAL;
   1751  1.122  christos 		/*
   1752   1.84       gdt 		 * XXX These changes do not take effect until the
   1753   1.84       gdt 		 * next time RA/WB mode is enabled but they ought to
   1754   1.84       gdt 		 * take effect immediately.
   1755   1.84       gdt 		 */
   1756   1.84       gdt 		sce->ra_wb_bufsize = opt->ra_wb_buffer_size;
   1757   1.84       gdt 		sce->ra_wb_reqsize = opt->ra_wb_request_size;
   1758  1.133     skrll 		return 0;
   1759   1.84       gdt 	}
   1760    1.2  augustss 	default:
   1761    1.2  augustss 		break;
   1762    1.2  augustss 	}
   1763    1.2  augustss 
   1764    1.1  augustss 	if (endpt != USB_CONTROL_ENDPOINT)
   1765  1.133     skrll 		return EINVAL;
   1766    1.1  augustss 
   1767    1.1  augustss 	switch (cmd) {
   1768   1.30  augustss #ifdef UGEN_DEBUG
   1769    1.8  augustss 	case USB_SETDEBUG:
   1770    1.8  augustss 		ugendebug = *(int *)addr;
   1771    1.8  augustss 		break;
   1772    1.8  augustss #endif
   1773    1.1  augustss 	case USB_GET_CONFIG:
   1774   1.28  augustss 		err = usbd_get_config(sc->sc_udev, &conf);
   1775   1.28  augustss 		if (err)
   1776  1.133     skrll 			return EIO;
   1777    1.1  augustss 		*(int *)addr = conf;
   1778    1.1  augustss 		break;
   1779    1.1  augustss 	case USB_SET_CONFIG:
   1780    1.2  augustss 		if (!(flag & FWRITE))
   1781  1.133     skrll 			return EPERM;
   1782  1.138        ws 		err = ugen_set_config(sc, *(int *)addr, 1);
   1783   1.53  augustss 		switch (err) {
   1784   1.53  augustss 		case USBD_NORMAL_COMPLETION:
   1785   1.53  augustss 			break;
   1786   1.53  augustss 		case USBD_IN_USE:
   1787  1.133     skrll 			return EBUSY;
   1788   1.53  augustss 		default:
   1789  1.133     skrll 			return EIO;
   1790   1.53  augustss 		}
   1791    1.1  augustss 		break;
   1792    1.1  augustss 	case USB_GET_ALTINTERFACE:
   1793    1.1  augustss 		ai = (struct usb_alt_interface *)addr;
   1794   1.55  augustss 		err = usbd_device2interface_handle(sc->sc_udev,
   1795   1.58  christos 			  ai->uai_interface_index, &iface);
   1796   1.28  augustss 		if (err)
   1797  1.133     skrll 			return EINVAL;
   1798    1.1  augustss 		idesc = usbd_get_interface_descriptor(iface);
   1799   1.28  augustss 		if (idesc == NULL)
   1800  1.133     skrll 			return EIO;
   1801   1.58  christos 		ai->uai_alt_no = idesc->bAlternateSetting;
   1802    1.1  augustss 		break;
   1803    1.1  augustss 	case USB_SET_ALTINTERFACE:
   1804    1.2  augustss 		if (!(flag & FWRITE))
   1805  1.133     skrll 			return EPERM;
   1806    1.1  augustss 		ai = (struct usb_alt_interface *)addr;
   1807   1.55  augustss 		err = usbd_device2interface_handle(sc->sc_udev,
   1808   1.58  christos 			  ai->uai_interface_index, &iface);
   1809   1.28  augustss 		if (err)
   1810  1.133     skrll 			return EINVAL;
   1811   1.58  christos 		err = ugen_set_interface(sc, ai->uai_interface_index,
   1812   1.58  christos 		    ai->uai_alt_no);
   1813   1.28  augustss 		if (err)
   1814  1.133     skrll 			return EINVAL;
   1815    1.1  augustss 		break;
   1816    1.1  augustss 	case USB_GET_NO_ALT:
   1817    1.1  augustss 		ai = (struct usb_alt_interface *)addr;
   1818  1.133     skrll 		cdesc = ugen_get_cdesc(sc, ai->uai_config_index, &cdesclen);
   1819   1.28  augustss 		if (cdesc == NULL)
   1820  1.133     skrll 			return EINVAL;
   1821   1.58  christos 		idesc = usbd_find_idesc(cdesc, ai->uai_interface_index, 0);
   1822   1.28  augustss 		if (idesc == NULL) {
   1823  1.133     skrll 			kmem_free(cdesc, cdesclen);
   1824  1.133     skrll 			return EINVAL;
   1825   1.12  augustss 		}
   1826   1.58  christos 		ai->uai_alt_no = usbd_get_no_alts(cdesc,
   1827   1.58  christos 		    idesc->bInterfaceNumber);
   1828  1.133     skrll 		kmem_free(cdesc, cdesclen);
   1829    1.1  augustss 		break;
   1830    1.1  augustss 	case USB_GET_DEVICE_DESC:
   1831    1.1  augustss 		*(usb_device_descriptor_t *)addr =
   1832    1.1  augustss 			*usbd_get_device_descriptor(sc->sc_udev);
   1833    1.1  augustss 		break;
   1834    1.1  augustss 	case USB_GET_CONFIG_DESC:
   1835    1.1  augustss 		cd = (struct usb_config_desc *)addr;
   1836  1.133     skrll 		cdesc = ugen_get_cdesc(sc, cd->ucd_config_index, &cdesclen);
   1837   1.28  augustss 		if (cdesc == NULL)
   1838  1.133     skrll 			return EINVAL;
   1839   1.58  christos 		cd->ucd_desc = *cdesc;
   1840  1.133     skrll 		kmem_free(cdesc, cdesclen);
   1841    1.1  augustss 		break;
   1842    1.1  augustss 	case USB_GET_INTERFACE_DESC:
   1843    1.1  augustss 		id = (struct usb_interface_desc *)addr;
   1844  1.133     skrll 		cdesc = ugen_get_cdesc(sc, id->uid_config_index, &cdesclen);
   1845   1.28  augustss 		if (cdesc == NULL)
   1846  1.133     skrll 			return EINVAL;
   1847   1.58  christos 		if (id->uid_config_index == USB_CURRENT_CONFIG_INDEX &&
   1848   1.58  christos 		    id->uid_alt_index == USB_CURRENT_ALT_INDEX)
   1849   1.58  christos 			alt = ugen_get_alt_index(sc, id->uid_interface_index);
   1850    1.1  augustss 		else
   1851   1.58  christos 			alt = id->uid_alt_index;
   1852   1.58  christos 		idesc = usbd_find_idesc(cdesc, id->uid_interface_index, alt);
   1853   1.28  augustss 		if (idesc == NULL) {
   1854  1.133     skrll 			kmem_free(cdesc, cdesclen);
   1855  1.133     skrll 			return EINVAL;
   1856    1.1  augustss 		}
   1857   1.58  christos 		id->uid_desc = *idesc;
   1858  1.133     skrll 		kmem_free(cdesc, cdesclen);
   1859    1.1  augustss 		break;
   1860    1.1  augustss 	case USB_GET_ENDPOINT_DESC:
   1861    1.1  augustss 		ed = (struct usb_endpoint_desc *)addr;
   1862  1.133     skrll 		cdesc = ugen_get_cdesc(sc, ed->ued_config_index, &cdesclen);
   1863   1.28  augustss 		if (cdesc == NULL)
   1864  1.133     skrll 			return EINVAL;
   1865   1.58  christos 		if (ed->ued_config_index == USB_CURRENT_CONFIG_INDEX &&
   1866   1.58  christos 		    ed->ued_alt_index == USB_CURRENT_ALT_INDEX)
   1867   1.58  christos 			alt = ugen_get_alt_index(sc, ed->ued_interface_index);
   1868    1.1  augustss 		else
   1869   1.58  christos 			alt = ed->ued_alt_index;
   1870   1.58  christos 		edesc = usbd_find_edesc(cdesc, ed->ued_interface_index,
   1871   1.58  christos 					alt, ed->ued_endpoint_index);
   1872   1.28  augustss 		if (edesc == NULL) {
   1873  1.133     skrll 			kmem_free(cdesc, cdesclen);
   1874  1.133     skrll 			return EINVAL;
   1875    1.1  augustss 		}
   1876   1.58  christos 		ed->ued_desc = *edesc;
   1877  1.133     skrll 		kmem_free(cdesc, cdesclen);
   1878    1.1  augustss 		break;
   1879    1.1  augustss 	case USB_GET_FULL_DESC:
   1880    1.1  augustss 	{
   1881    1.1  augustss 		int len;
   1882    1.1  augustss 		struct iovec iov;
   1883    1.1  augustss 		struct uio uio;
   1884    1.1  augustss 		struct usb_full_desc *fd = (struct usb_full_desc *)addr;
   1885    1.1  augustss 
   1886  1.133     skrll 		cdesc = ugen_get_cdesc(sc, fd->ufd_config_index, &cdesclen);
   1887  1.104     pooka 		if (cdesc == NULL)
   1888  1.133     skrll 			return EINVAL;
   1889  1.133     skrll 		len = cdesclen;
   1890   1.58  christos 		if (len > fd->ufd_size)
   1891   1.58  christos 			len = fd->ufd_size;
   1892   1.92  christos 		iov.iov_base = (void *)fd->ufd_data;
   1893    1.1  augustss 		iov.iov_len = len;
   1894    1.1  augustss 		uio.uio_iov = &iov;
   1895    1.1  augustss 		uio.uio_iovcnt = 1;
   1896    1.1  augustss 		uio.uio_resid = len;
   1897    1.1  augustss 		uio.uio_offset = 0;
   1898    1.1  augustss 		uio.uio_rw = UIO_READ;
   1899   1.79      yamt 		uio.uio_vmspace = l->l_proc->p_vmspace;
   1900   1.30  augustss 		error = uiomove((void *)cdesc, len, &uio);
   1901  1.133     skrll 		kmem_free(cdesc, cdesclen);
   1902  1.133     skrll 		return error;
   1903    1.1  augustss 	}
   1904   1.68   mycroft 	case USB_GET_STRING_DESC: {
   1905   1.68   mycroft 		int len;
   1906    1.2  augustss 		si = (struct usb_string_desc *)addr;
   1907   1.58  christos 		err = usbd_get_string_desc(sc->sc_udev, si->usd_string_index,
   1908   1.68   mycroft 			  si->usd_language_id, &si->usd_desc, &len);
   1909   1.28  augustss 		if (err)
   1910  1.133     skrll 			return EINVAL;
   1911    1.2  augustss 		break;
   1912   1.68   mycroft 	}
   1913    1.1  augustss 	case USB_DO_REQUEST:
   1914    1.1  augustss 	{
   1915    1.1  augustss 		struct usb_ctl_request *ur = (void *)addr;
   1916   1.58  christos 		int len = UGETW(ur->ucr_request.wLength);
   1917    1.1  augustss 		struct iovec iov;
   1918    1.1  augustss 		struct uio uio;
   1919    1.1  augustss 		void *ptr = 0;
   1920   1.74  christos 		usbd_status xerr;
   1921  1.133     skrll 
   1922  1.133     skrll 		error = 0;
   1923    1.1  augustss 
   1924    1.2  augustss 		if (!(flag & FWRITE))
   1925  1.133     skrll 			return EPERM;
   1926    1.1  augustss 		/* Avoid requests that would damage the bus integrity. */
   1927   1.58  christos 		if ((ur->ucr_request.bmRequestType == UT_WRITE_DEVICE &&
   1928   1.58  christos 		     ur->ucr_request.bRequest == UR_SET_ADDRESS) ||
   1929   1.58  christos 		    (ur->ucr_request.bmRequestType == UT_WRITE_DEVICE &&
   1930   1.58  christos 		     ur->ucr_request.bRequest == UR_SET_CONFIG) ||
   1931   1.58  christos 		    (ur->ucr_request.bmRequestType == UT_WRITE_INTERFACE &&
   1932   1.58  christos 		     ur->ucr_request.bRequest == UR_SET_INTERFACE))
   1933  1.133     skrll 			return EINVAL;
   1934    1.1  augustss 
   1935    1.1  augustss 		if (len < 0 || len > 32767)
   1936  1.133     skrll 			return EINVAL;
   1937    1.1  augustss 		if (len != 0) {
   1938   1.92  christos 			iov.iov_base = (void *)ur->ucr_data;
   1939    1.1  augustss 			iov.iov_len = len;
   1940    1.1  augustss 			uio.uio_iov = &iov;
   1941    1.1  augustss 			uio.uio_iovcnt = 1;
   1942    1.1  augustss 			uio.uio_resid = len;
   1943    1.1  augustss 			uio.uio_offset = 0;
   1944    1.1  augustss 			uio.uio_rw =
   1945   1.58  christos 				ur->ucr_request.bmRequestType & UT_READ ?
   1946    1.1  augustss 				UIO_READ : UIO_WRITE;
   1947   1.79      yamt 			uio.uio_vmspace = l->l_proc->p_vmspace;
   1948  1.133     skrll 			ptr = kmem_alloc(len, KM_SLEEP);
   1949    1.1  augustss 			if (uio.uio_rw == UIO_WRITE) {
   1950    1.1  augustss 				error = uiomove(ptr, len, &uio);
   1951    1.1  augustss 				if (error)
   1952    1.1  augustss 					goto ret;
   1953    1.1  augustss 			}
   1954    1.1  augustss 		}
   1955   1.57  augustss 		sce = &sc->sc_endpoints[endpt][IN];
   1956   1.74  christos 		xerr = usbd_do_request_flags(sc->sc_udev, &ur->ucr_request,
   1957   1.58  christos 			  ptr, ur->ucr_flags, &ur->ucr_actlen, sce->timeout);
   1958   1.74  christos 		if (xerr) {
   1959    1.1  augustss 			error = EIO;
   1960    1.1  augustss 			goto ret;
   1961    1.1  augustss 		}
   1962    1.1  augustss 		if (len != 0) {
   1963    1.1  augustss 			if (uio.uio_rw == UIO_READ) {
   1964  1.140  riastrad 				size_t alen = uimin(len, ur->ucr_actlen);
   1965  1.133     skrll 				error = uiomove(ptr, alen, &uio);
   1966    1.1  augustss 				if (error)
   1967    1.1  augustss 					goto ret;
   1968    1.1  augustss 			}
   1969    1.1  augustss 		}
   1970    1.1  augustss 	ret:
   1971    1.1  augustss 		if (ptr)
   1972  1.133     skrll 			kmem_free(ptr, len);
   1973  1.133     skrll 		return error;
   1974    1.1  augustss 	}
   1975    1.2  augustss 	case USB_GET_DEVICEINFO:
   1976    1.2  augustss 		usbd_fill_deviceinfo(sc->sc_udev,
   1977   1.91  drochner 				     (struct usb_device_info *)addr, 0);
   1978    1.2  augustss 		break;
   1979   1.89     pavel 	case USB_GET_DEVICEINFO_OLD:
   1980  1.142  pgoyette 	{
   1981  1.142  pgoyette 		int ret;
   1982  1.145  pgoyette 		MODULE_HOOK_CALL(usb_subr_fill_30_hook,
   1983  1.142  pgoyette 		    (sc->sc_udev, (struct usb_device_info_old *)addr, 0,
   1984  1.142  pgoyette 		      usbd_devinfo_vp, usbd_printBCD),
   1985  1.142  pgoyette 		    enosys(), ret);
   1986  1.142  pgoyette 		if (ret == 0)
   1987  1.142  pgoyette 			return 0;
   1988  1.142  pgoyette 		return EINVAL;
   1989  1.142  pgoyette 	}
   1990    1.1  augustss 	default:
   1991  1.133     skrll 		return EINVAL;
   1992    1.1  augustss 	}
   1993  1.133     skrll 	return 0;
   1994    1.1  augustss }
   1995    1.1  augustss 
   1996  1.147      maxv static int
   1997   1.92  christos ugenioctl(dev_t dev, u_long cmd, void *addr, int flag, struct lwp *l)
   1998   1.12  augustss {
   1999   1.12  augustss 	int endpt = UGENENDPOINT(dev);
   2000   1.24  augustss 	struct ugen_softc *sc;
   2001   1.12  augustss 	int error;
   2002   1.12  augustss 
   2003  1.155  riastrad 	if ((sc = ugenif_acquire(UGENUNIT(dev))) == 0)
   2004  1.111    dyoung 		return ENXIO;
   2005  1.155  riastrad 	error = ugen_do_ioctl(sc, endpt, cmd, addr, flag, l);
   2006  1.155  riastrad 	ugenif_release(sc);
   2007   1.30  augustss 
   2008  1.133     skrll 	return error;
   2009   1.12  augustss }
   2010   1.12  augustss 
   2011  1.147      maxv static int
   2012   1.78  christos ugenpoll(dev_t dev, int events, struct lwp *l)
   2013    1.1  augustss {
   2014   1.24  augustss 	struct ugen_softc *sc;
   2015   1.84       gdt 	struct ugen_endpoint *sce_in, *sce_out;
   2016    1.1  augustss 	int revents = 0;
   2017    1.1  augustss 
   2018  1.155  riastrad 	if ((sc = ugenif_acquire(UGENUNIT(dev))) == NULL)
   2019  1.133     skrll 		return POLLHUP;
   2020    1.1  augustss 
   2021  1.155  riastrad 	if (UGENENDPOINT(dev) == USB_CONTROL_ENDPOINT) {
   2022  1.155  riastrad 		revents |= POLLERR;
   2023  1.155  riastrad 		goto out;
   2024  1.155  riastrad 	}
   2025  1.113  jakllsch 
   2026   1.84       gdt 	sce_in = &sc->sc_endpoints[UGENENDPOINT(dev)][IN];
   2027   1.84       gdt 	sce_out = &sc->sc_endpoints[UGENENDPOINT(dev)][OUT];
   2028  1.154  riastrad 	KASSERT(sce_in->edesc || sce_out->edesc);
   2029  1.154  riastrad 	KASSERT(sce_in->pipeh || sce_out->pipeh);
   2030  1.120       mrg 
   2031  1.120       mrg 	mutex_enter(&sc->sc_lock);
   2032   1.84       gdt 	if (sce_in && sce_in->pipeh && (events & (POLLIN | POLLRDNORM)))
   2033   1.84       gdt 		switch (sce_in->edesc->bmAttributes & UE_XFERTYPE) {
   2034   1.84       gdt 		case UE_INTERRUPT:
   2035   1.84       gdt 			if (sce_in->q.c_cc > 0)
   2036   1.41  augustss 				revents |= events & (POLLIN | POLLRDNORM);
   2037   1.41  augustss 			else
   2038   1.84       gdt 				selrecord(l, &sce_in->rsel);
   2039   1.84       gdt 			break;
   2040   1.84       gdt 		case UE_ISOCHRONOUS:
   2041   1.84       gdt 			if (sce_in->cur != sce_in->fill)
   2042    1.1  augustss 				revents |= events & (POLLIN | POLLRDNORM);
   2043    1.1  augustss 			else
   2044   1.84       gdt 				selrecord(l, &sce_in->rsel);
   2045   1.84       gdt 			break;
   2046   1.84       gdt 		case UE_BULK:
   2047   1.84       gdt 			if (sce_in->state & UGEN_BULK_RA) {
   2048   1.84       gdt 				if (sce_in->ra_wb_used > 0)
   2049   1.84       gdt 					revents |= events &
   2050   1.84       gdt 					    (POLLIN | POLLRDNORM);
   2051   1.84       gdt 				else
   2052   1.84       gdt 					selrecord(l, &sce_in->rsel);
   2053   1.84       gdt 				break;
   2054   1.84       gdt 			}
   2055   1.84       gdt 			/*
   2056   1.84       gdt 			 * We have no easy way of determining if a read will
   2057   1.84       gdt 			 * yield any data or a write will happen.
   2058   1.84       gdt 			 * Pretend they will.
   2059   1.84       gdt 			 */
   2060  1.155  riastrad 			revents |= events & (POLLIN | POLLRDNORM);
   2061  1.155  riastrad 			break;
   2062   1.84       gdt 		default:
   2063   1.84       gdt 			break;
   2064    1.1  augustss 		}
   2065   1.84       gdt 	if (sce_out && sce_out->pipeh && (events & (POLLOUT | POLLWRNORM)))
   2066   1.84       gdt 		switch (sce_out->edesc->bmAttributes & UE_XFERTYPE) {
   2067   1.84       gdt 		case UE_INTERRUPT:
   2068   1.84       gdt 		case UE_ISOCHRONOUS:
   2069   1.84       gdt 			/* XXX unimplemented */
   2070   1.84       gdt 			break;
   2071   1.84       gdt 		case UE_BULK:
   2072   1.84       gdt 			if (sce_out->state & UGEN_BULK_WB) {
   2073   1.84       gdt 				if (sce_out->ra_wb_used <
   2074   1.84       gdt 				    sce_out->limit - sce_out->ibuf)
   2075   1.84       gdt 					revents |= events &
   2076   1.84       gdt 					    (POLLOUT | POLLWRNORM);
   2077   1.84       gdt 				else
   2078   1.84       gdt 					selrecord(l, &sce_out->rsel);
   2079   1.84       gdt 				break;
   2080   1.84       gdt 			}
   2081   1.84       gdt 			/*
   2082   1.84       gdt 			 * We have no easy way of determining if a read will
   2083   1.84       gdt 			 * yield any data or a write will happen.
   2084   1.84       gdt 			 * Pretend they will.
   2085   1.84       gdt 			 */
   2086   1.84       gdt 			 revents |= events & (POLLOUT | POLLWRNORM);
   2087   1.84       gdt 			 break;
   2088   1.84       gdt 		default:
   2089   1.84       gdt 			break;
   2090   1.84       gdt 		}
   2091   1.84       gdt 
   2092  1.120       mrg 	mutex_exit(&sc->sc_lock);
   2093   1.84       gdt 
   2094  1.155  riastrad out:	ugenif_release(sc);
   2095  1.133     skrll 	return revents;
   2096   1.62  jdolecek }
   2097   1.62  jdolecek 
   2098   1.62  jdolecek static void
   2099   1.62  jdolecek filt_ugenrdetach(struct knote *kn)
   2100   1.62  jdolecek {
   2101   1.62  jdolecek 	struct ugen_endpoint *sce = kn->kn_hook;
   2102  1.120       mrg 	struct ugen_softc *sc = sce->sc;
   2103   1.62  jdolecek 
   2104  1.120       mrg 	mutex_enter(&sc->sc_lock);
   2105  1.158   thorpej 	selremove_knote(&sce->rsel, kn);
   2106  1.120       mrg 	mutex_exit(&sc->sc_lock);
   2107   1.62  jdolecek }
   2108   1.62  jdolecek 
   2109   1.62  jdolecek static int
   2110   1.88  christos filt_ugenread_intr(struct knote *kn, long hint)
   2111   1.62  jdolecek {
   2112   1.62  jdolecek 	struct ugen_endpoint *sce = kn->kn_hook;
   2113  1.135       mrg 	struct ugen_softc *sc = sce->sc;
   2114  1.153  riastrad 	int ret;
   2115  1.135       mrg 
   2116  1.153  riastrad 	mutex_enter(&sc->sc_lock);
   2117  1.153  riastrad 	if (sc->sc_dying) {
   2118  1.153  riastrad 		ret = 0;
   2119  1.153  riastrad 	} else {
   2120  1.153  riastrad 		kn->kn_data = sce->q.c_cc;
   2121  1.153  riastrad 		ret = kn->kn_data > 0;
   2122  1.153  riastrad 	}
   2123  1.153  riastrad 	mutex_exit(&sc->sc_lock);
   2124   1.62  jdolecek 
   2125  1.153  riastrad 	return ret;
   2126   1.62  jdolecek }
   2127   1.62  jdolecek 
   2128   1.62  jdolecek static int
   2129   1.88  christos filt_ugenread_isoc(struct knote *kn, long hint)
   2130   1.62  jdolecek {
   2131   1.62  jdolecek 	struct ugen_endpoint *sce = kn->kn_hook;
   2132  1.135       mrg 	struct ugen_softc *sc = sce->sc;
   2133  1.153  riastrad 	int ret;
   2134  1.135       mrg 
   2135  1.153  riastrad 	mutex_enter(&sc->sc_lock);
   2136  1.153  riastrad 	if (sc->sc_dying) {
   2137  1.153  riastrad 		ret = 0;
   2138  1.153  riastrad 	} else if (sce->cur == sce->fill) {
   2139  1.153  riastrad 		ret = 0;
   2140  1.153  riastrad 	} else if (sce->cur < sce->fill) {
   2141   1.62  jdolecek 		kn->kn_data = sce->fill - sce->cur;
   2142  1.153  riastrad 		ret = 1;
   2143  1.153  riastrad 	} else {
   2144   1.62  jdolecek 		kn->kn_data = (sce->limit - sce->cur) +
   2145   1.62  jdolecek 		    (sce->fill - sce->ibuf);
   2146  1.153  riastrad 		ret = 1;
   2147  1.153  riastrad 	}
   2148  1.153  riastrad 	mutex_exit(&sc->sc_lock);
   2149   1.62  jdolecek 
   2150  1.153  riastrad 	return ret;
   2151   1.62  jdolecek }
   2152   1.62  jdolecek 
   2153   1.84       gdt static int
   2154   1.84       gdt filt_ugenread_bulk(struct knote *kn, long hint)
   2155   1.84       gdt {
   2156   1.84       gdt 	struct ugen_endpoint *sce = kn->kn_hook;
   2157  1.135       mrg 	struct ugen_softc *sc = sce->sc;
   2158  1.153  riastrad 	int ret;
   2159  1.135       mrg 
   2160  1.153  riastrad 	mutex_enter(&sc->sc_lock);
   2161  1.153  riastrad 	if (sc->sc_dying) {
   2162  1.153  riastrad 		ret = 0;
   2163  1.153  riastrad 	} else if (!(sce->state & UGEN_BULK_RA)) {
   2164   1.84       gdt 		/*
   2165   1.84       gdt 		 * We have no easy way of determining if a read will
   2166   1.84       gdt 		 * yield any data or a write will happen.
   2167   1.84       gdt 		 * So, emulate "seltrue".
   2168   1.84       gdt 		 */
   2169  1.153  riastrad 		ret = filt_seltrue(kn, hint);
   2170  1.153  riastrad 	} else if (sce->ra_wb_used == 0) {
   2171  1.153  riastrad 		ret = 0;
   2172  1.153  riastrad 	} else {
   2173  1.153  riastrad 		kn->kn_data = sce->ra_wb_used;
   2174  1.153  riastrad 		ret = 1;
   2175  1.153  riastrad 	}
   2176  1.153  riastrad 	mutex_exit(&sc->sc_lock);
   2177   1.84       gdt 
   2178  1.153  riastrad 	return ret;
   2179   1.84       gdt }
   2180   1.84       gdt 
   2181   1.84       gdt static int
   2182   1.84       gdt filt_ugenwrite_bulk(struct knote *kn, long hint)
   2183   1.84       gdt {
   2184   1.84       gdt 	struct ugen_endpoint *sce = kn->kn_hook;
   2185  1.135       mrg 	struct ugen_softc *sc = sce->sc;
   2186  1.153  riastrad 	int ret;
   2187  1.135       mrg 
   2188  1.153  riastrad 	mutex_enter(&sc->sc_lock);
   2189  1.153  riastrad 	if (sc->sc_dying) {
   2190  1.153  riastrad 		ret = 0;
   2191  1.153  riastrad 	} else if (!(sce->state & UGEN_BULK_WB)) {
   2192   1.84       gdt 		/*
   2193   1.84       gdt 		 * We have no easy way of determining if a read will
   2194   1.84       gdt 		 * yield any data or a write will happen.
   2195   1.84       gdt 		 * So, emulate "seltrue".
   2196   1.84       gdt 		 */
   2197  1.153  riastrad 		ret = filt_seltrue(kn, hint);
   2198  1.153  riastrad 	} else if (sce->ra_wb_used == sce->limit - sce->ibuf) {
   2199  1.153  riastrad 		ret = 0;
   2200  1.153  riastrad 	} else {
   2201  1.153  riastrad 		kn->kn_data = (sce->limit - sce->ibuf) - sce->ra_wb_used;
   2202  1.153  riastrad 		ret = 1;
   2203  1.153  riastrad 	}
   2204  1.153  riastrad 	mutex_exit(&sc->sc_lock);
   2205   1.84       gdt 
   2206  1.153  riastrad 	return ret;
   2207   1.84       gdt }
   2208   1.84       gdt 
   2209  1.136      maya static const struct filterops ugenread_intr_filtops = {
   2210  1.136      maya 	.f_isfd = 1,
   2211  1.136      maya 	.f_attach = NULL,
   2212  1.136      maya 	.f_detach = filt_ugenrdetach,
   2213  1.136      maya 	.f_event = filt_ugenread_intr,
   2214  1.136      maya };
   2215   1.62  jdolecek 
   2216  1.136      maya static const struct filterops ugenread_isoc_filtops = {
   2217  1.136      maya 	.f_isfd = 1,
   2218  1.136      maya 	.f_attach = NULL,
   2219  1.136      maya 	.f_detach = filt_ugenrdetach,
   2220  1.136      maya 	.f_event = filt_ugenread_isoc,
   2221  1.136      maya };
   2222   1.62  jdolecek 
   2223  1.136      maya static const struct filterops ugenread_bulk_filtops = {
   2224  1.136      maya 	.f_isfd = 1,
   2225  1.136      maya 	.f_attach = NULL,
   2226  1.136      maya 	.f_detach = filt_ugenrdetach,
   2227  1.136      maya 	.f_event = filt_ugenread_bulk,
   2228  1.136      maya };
   2229   1.84       gdt 
   2230  1.136      maya static const struct filterops ugenwrite_bulk_filtops = {
   2231  1.136      maya 	.f_isfd = 1,
   2232  1.136      maya 	.f_attach = NULL,
   2233  1.136      maya 	.f_detach = filt_ugenrdetach,
   2234  1.136      maya 	.f_event = filt_ugenwrite_bulk,
   2235  1.136      maya };
   2236   1.62  jdolecek 
   2237  1.147      maxv static int
   2238   1.62  jdolecek ugenkqfilter(dev_t dev, struct knote *kn)
   2239   1.62  jdolecek {
   2240   1.62  jdolecek 	struct ugen_softc *sc;
   2241   1.62  jdolecek 	struct ugen_endpoint *sce;
   2242  1.158   thorpej 	struct selinfo *sip;
   2243  1.155  riastrad 	int error;
   2244   1.62  jdolecek 
   2245  1.155  riastrad 	if ((sc = ugenif_acquire(UGENUNIT(dev))) == NULL)
   2246  1.133     skrll 		return ENXIO;
   2247   1.62  jdolecek 
   2248  1.155  riastrad 	if (UGENENDPOINT(dev) == USB_CONTROL_ENDPOINT) {
   2249  1.155  riastrad 		error = ENODEV;
   2250  1.155  riastrad 		goto out;
   2251  1.155  riastrad 	}
   2252  1.113  jakllsch 
   2253   1.62  jdolecek 	switch (kn->kn_filter) {
   2254   1.62  jdolecek 	case EVFILT_READ:
   2255   1.84       gdt 		sce = &sc->sc_endpoints[UGENENDPOINT(dev)][IN];
   2256  1.155  riastrad 		if (sce == NULL) {
   2257  1.155  riastrad 			error = EINVAL;
   2258  1.155  riastrad 			goto out;
   2259  1.155  riastrad 		}
   2260   1.84       gdt 
   2261  1.158   thorpej 		sip = &sce->rsel;
   2262   1.62  jdolecek 		switch (sce->edesc->bmAttributes & UE_XFERTYPE) {
   2263   1.62  jdolecek 		case UE_INTERRUPT:
   2264   1.62  jdolecek 			kn->kn_fop = &ugenread_intr_filtops;
   2265   1.62  jdolecek 			break;
   2266   1.62  jdolecek 		case UE_ISOCHRONOUS:
   2267   1.62  jdolecek 			kn->kn_fop = &ugenread_isoc_filtops;
   2268   1.62  jdolecek 			break;
   2269   1.62  jdolecek 		case UE_BULK:
   2270   1.84       gdt 			kn->kn_fop = &ugenread_bulk_filtops;
   2271   1.84       gdt 			break;
   2272   1.62  jdolecek 		default:
   2273  1.155  riastrad 			error = EINVAL;
   2274  1.155  riastrad 			goto out;
   2275   1.62  jdolecek 		}
   2276   1.62  jdolecek 		break;
   2277   1.62  jdolecek 
   2278   1.62  jdolecek 	case EVFILT_WRITE:
   2279   1.84       gdt 		sce = &sc->sc_endpoints[UGENENDPOINT(dev)][OUT];
   2280  1.155  riastrad 		if (sce == NULL) {
   2281  1.155  riastrad 			error = EINVAL;
   2282  1.155  riastrad 			goto out;
   2283  1.155  riastrad 		}
   2284   1.84       gdt 
   2285  1.158   thorpej 		sip = &sce->rsel;
   2286   1.62  jdolecek 		switch (sce->edesc->bmAttributes & UE_XFERTYPE) {
   2287   1.62  jdolecek 		case UE_INTERRUPT:
   2288   1.62  jdolecek 		case UE_ISOCHRONOUS:
   2289   1.62  jdolecek 			/* XXX poll doesn't support this */
   2290  1.155  riastrad 			error = EINVAL;
   2291  1.155  riastrad 			goto out;
   2292   1.62  jdolecek 
   2293   1.62  jdolecek 		case UE_BULK:
   2294   1.84       gdt 			kn->kn_fop = &ugenwrite_bulk_filtops;
   2295   1.62  jdolecek 			break;
   2296   1.62  jdolecek 		default:
   2297  1.155  riastrad 			error = EINVAL;
   2298  1.155  riastrad 			goto out;
   2299   1.62  jdolecek 		}
   2300   1.62  jdolecek 		break;
   2301   1.62  jdolecek 
   2302   1.62  jdolecek 	default:
   2303  1.155  riastrad 		error = EINVAL;
   2304  1.155  riastrad 		goto out;
   2305   1.62  jdolecek 	}
   2306   1.62  jdolecek 
   2307   1.62  jdolecek 	kn->kn_hook = sce;
   2308   1.62  jdolecek 
   2309  1.120       mrg 	mutex_enter(&sc->sc_lock);
   2310  1.158   thorpej 	selrecord_knote(sip, kn);
   2311  1.120       mrg 	mutex_exit(&sc->sc_lock);
   2312   1.62  jdolecek 
   2313  1.155  riastrad 	error = 0;
   2314  1.155  riastrad 
   2315  1.155  riastrad out:	ugenif_release(sc);
   2316  1.155  riastrad 	return error;
   2317  1.155  riastrad }
   2318  1.155  riastrad 
   2319  1.155  riastrad MODULE(MODULE_CLASS_DRIVER, ugen, NULL);
   2320  1.155  riastrad 
   2321  1.155  riastrad static int
   2322  1.155  riastrad ugen_modcmd(modcmd_t cmd, void *aux)
   2323  1.155  riastrad {
   2324  1.155  riastrad 
   2325  1.155  riastrad 	switch (cmd) {
   2326  1.155  riastrad 	case MODULE_CMD_INIT:
   2327  1.155  riastrad 		mutex_init(&ugenif.lock, MUTEX_DEFAULT, IPL_NONE);
   2328  1.155  riastrad 		rb_tree_init(&ugenif.tree, &ugenif_tree_ops);
   2329  1.155  riastrad 		return 0;
   2330  1.155  riastrad 	default:
   2331  1.155  riastrad 		return ENOTTY;
   2332  1.155  riastrad 	}
   2333    1.1  augustss }
   2334