Home | History | Annotate | Line # | Download | only in usb
ugen.c revision 1.168
      1  1.168   thorpej /*	$NetBSD: ugen.c,v 1.168 2021/09/26 01:16:09 thorpej 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.168   thorpej __KERNEL_RCSID(0, "$NetBSD: ugen.c,v 1.168 2021/09/26 01:16:09 thorpej 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.167  riastrad 			while (--i >= 0) { /* implicit buffer free */
    673  1.133     skrll 				usbd_destroy_xfer(sce->isoreqs[i].xfer);
    674  1.167  riastrad 				sce->isoreqs[i].xfer = NULL;
    675  1.167  riastrad 			}
    676  1.121  riastrad 			usbd_close_pipe(sce->pipeh);
    677  1.121  riastrad 			sce->pipeh = NULL;
    678  1.133     skrll 			kmem_free(sce->ibuf, isize * UGEN_NISOFRAMES);
    679  1.121  riastrad 			sce->ibuf = NULL;
    680  1.155  riastrad 			error = ENOMEM;
    681  1.155  riastrad 			goto out;
    682    1.1  augustss 		case UE_CONTROL:
    683   1.57  augustss 			sce->timeout = USBD_DEFAULT_TIMEOUT;
    684  1.155  riastrad 			error = EINVAL;
    685  1.155  riastrad 			goto out;
    686    1.1  augustss 		}
    687    1.1  augustss 	}
    688  1.155  riastrad 	error = 0;
    689  1.160  riastrad out:	if (error && opened)
    690  1.160  riastrad 		sc->sc_is_open[endpt] = 0;
    691  1.160  riastrad 	ugenif_release(sc);
    692  1.155  riastrad 	return error;
    693    1.1  augustss }
    694    1.1  augustss 
    695  1.163  riastrad static void
    696  1.163  riastrad ugen_do_close(struct ugen_softc *sc, int flag, int endpt)
    697    1.1  augustss {
    698    1.1  augustss 	struct ugen_endpoint *sce;
    699    1.1  augustss 	int dir;
    700   1.41  augustss 	int i;
    701    1.1  augustss 
    702  1.159  riastrad 	KASSERT(KERNEL_LOCKED_P()); /* sc_is_open */
    703  1.159  riastrad 
    704  1.167  riastrad 	if (!sc->sc_is_open[endpt])
    705  1.167  riastrad 		goto out;
    706    1.1  augustss 
    707    1.1  augustss 	if (endpt == USB_CONTROL_ENDPOINT) {
    708    1.9  augustss 		DPRINTFN(5, ("ugenclose: close control\n"));
    709  1.155  riastrad 		goto out;
    710    1.1  augustss 	}
    711    1.9  augustss 
    712    1.9  augustss 	for (dir = OUT; dir <= IN; dir++) {
    713   1.13  augustss 		if (!(flag & (dir == OUT ? FWRITE : FREAD)))
    714   1.13  augustss 			continue;
    715   1.13  augustss 		sce = &sc->sc_endpoints[endpt][dir];
    716  1.129     skrll 		if (sce->pipeh == NULL)
    717   1.13  augustss 			continue;
    718   1.55  augustss 		DPRINTFN(5, ("ugenclose: endpt=%d dir=%d sce=%p\n",
    719   1.13  augustss 			     endpt, dir, sce));
    720   1.59  augustss 
    721   1.13  augustss 		usbd_abort_pipe(sce->pipeh);
    722  1.133     skrll 
    723  1.133     skrll 		int isize = UGETW(sce->edesc->wMaxPacketSize);
    724  1.133     skrll 		int msize = 0;
    725   1.41  augustss 
    726   1.56  augustss 		switch (sce->edesc->bmAttributes & UE_XFERTYPE) {
    727   1.56  augustss 		case UE_INTERRUPT:
    728   1.56  augustss 			ndflush(&sce->q, sce->q.c_cc);
    729   1.56  augustss 			clfree(&sce->q);
    730  1.133     skrll 			msize = isize;
    731   1.56  augustss 			break;
    732   1.56  augustss 		case UE_ISOCHRONOUS:
    733  1.167  riastrad 			for (i = 0; i < UGEN_NISOREQS; ++i) {
    734  1.133     skrll 				usbd_destroy_xfer(sce->isoreqs[i].xfer);
    735  1.167  riastrad 				sce->isoreqs[i].xfer = NULL;
    736  1.167  riastrad 			}
    737  1.133     skrll 			msize = isize * UGEN_NISOFRAMES;
    738   1.84       gdt 			break;
    739   1.84       gdt 		case UE_BULK:
    740  1.133     skrll 			if (sce->state & (UGEN_BULK_RA | UGEN_BULK_WB)) {
    741  1.133     skrll 				usbd_destroy_xfer(sce->ra_wb_xfer);
    742  1.167  riastrad 				sce->ra_wb_xfer = NULL;
    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.167  riastrad 	for (dir = OUT; dir <= IN; dir++) {
    759  1.167  riastrad 		sce = &sc->sc_endpoints[endpt][dir];
    760  1.167  riastrad 		KASSERT(sce->pipeh == NULL);
    761  1.167  riastrad 		KASSERT(sce->ibuf == NULL);
    762  1.167  riastrad 		KASSERT(sce->ra_wb_xfer == NULL);
    763  1.167  riastrad 		for (i = 0; i < UGEN_NISOREQS; i++)
    764  1.167  riastrad 			KASSERT(sce->isoreqs[i].xfer == NULL);
    765  1.167  riastrad 	}
    766  1.163  riastrad }
    767  1.163  riastrad 
    768  1.163  riastrad static int
    769  1.163  riastrad ugenclose(dev_t dev, int flag, int mode, struct lwp *l)
    770  1.163  riastrad {
    771  1.163  riastrad 	int endpt = UGENENDPOINT(dev);
    772  1.163  riastrad 	struct ugen_softc *sc;
    773  1.163  riastrad 
    774  1.163  riastrad 	DPRINTFN(5, ("ugenclose: flag=%d, mode=%d, unit=%d, endpt=%d\n",
    775  1.163  riastrad 		     flag, mode, UGENUNIT(dev), endpt));
    776  1.163  riastrad 
    777  1.163  riastrad 	KASSERT(KERNEL_LOCKED_P()); /* ugen_do_close */
    778  1.163  riastrad 
    779  1.163  riastrad 	if ((sc = ugenif_acquire(UGENUNIT(dev))) == NULL)
    780  1.163  riastrad 		return ENXIO;
    781  1.163  riastrad 
    782  1.163  riastrad 	KASSERT(sc->sc_is_open[endpt]);
    783  1.163  riastrad 	ugen_do_close(sc, flag, endpt);
    784  1.163  riastrad 	KASSERT(!sc->sc_is_open[endpt]);
    785  1.163  riastrad 
    786  1.163  riastrad 	ugenif_release(sc);
    787  1.163  riastrad 
    788  1.163  riastrad 	return 0;
    789    1.1  augustss }
    790    1.1  augustss 
    791   1.37  augustss Static int
    792   1.40  augustss ugen_do_read(struct ugen_softc *sc, int endpt, struct uio *uio, int flag)
    793    1.1  augustss {
    794    1.1  augustss 	struct ugen_endpoint *sce = &sc->sc_endpoints[endpt][IN];
    795  1.133     skrll 	uint32_t n, tn;
    796  1.133     skrll 	struct usbd_xfer *xfer;
    797   1.28  augustss 	usbd_status err;
    798    1.1  augustss 	int error = 0;
    799    1.1  augustss 
    800  1.111    dyoung 	DPRINTFN(5, ("%s: ugenread: %d\n", device_xname(sc->sc_dev), endpt));
    801   1.26  augustss 
    802   1.26  augustss 	if (endpt == USB_CONTROL_ENDPOINT)
    803  1.133     skrll 		return ENODEV;
    804   1.26  augustss 
    805  1.154  riastrad 	KASSERT(sce->edesc);
    806  1.154  riastrad 	KASSERT(sce->pipeh);
    807    1.1  augustss 
    808    1.1  augustss 	switch (sce->edesc->bmAttributes & UE_XFERTYPE) {
    809    1.1  augustss 	case UE_INTERRUPT:
    810   1.47       wiz 		/* Block until activity occurred. */
    811  1.120       mrg 		mutex_enter(&sc->sc_lock);
    812    1.1  augustss 		while (sce->q.c_cc == 0) {
    813    1.1  augustss 			if (flag & IO_NDELAY) {
    814  1.120       mrg 				mutex_exit(&sc->sc_lock);
    815  1.133     skrll 				return EWOULDBLOCK;
    816    1.1  augustss 			}
    817   1.46      yamt 			DPRINTFN(5, ("ugenread: sleep on %p\n", sce));
    818  1.120       mrg 			/* "ugenri" */
    819  1.120       mrg 			error = cv_timedwait_sig(&sce->cv, &sc->sc_lock,
    820  1.120       mrg 			    mstohz(sce->timeout));
    821    1.1  augustss 			DPRINTFN(5, ("ugenread: woke, error=%d\n", error));
    822   1.12  augustss 			if (sc->sc_dying)
    823   1.12  augustss 				error = EIO;
    824  1.152  riastrad 			if (error)
    825   1.12  augustss 				break;
    826    1.1  augustss 		}
    827  1.120       mrg 		mutex_exit(&sc->sc_lock);
    828    1.1  augustss 
    829    1.1  augustss 		/* Transfer as many chunks as possible. */
    830   1.12  augustss 		while (sce->q.c_cc > 0 && uio->uio_resid > 0 && !error) {
    831  1.140  riastrad 			n = uimin(sce->q.c_cc, uio->uio_resid);
    832   1.83  christos 			if (n > sizeof(sc->sc_buffer))
    833   1.83  christos 				n = sizeof(sc->sc_buffer);
    834    1.1  augustss 
    835    1.1  augustss 			/* Remove a small chunk from the input queue. */
    836   1.83  christos 			q_to_b(&sce->q, sc->sc_buffer, n);
    837    1.1  augustss 			DPRINTFN(5, ("ugenread: got %d chars\n", n));
    838    1.1  augustss 
    839    1.1  augustss 			/* Copy the data to the user process. */
    840   1.83  christos 			error = uiomove(sc->sc_buffer, n, uio);
    841    1.1  augustss 			if (error)
    842    1.1  augustss 				break;
    843    1.1  augustss 		}
    844    1.1  augustss 		break;
    845    1.1  augustss 	case UE_BULK:
    846   1.84       gdt 		if (sce->state & UGEN_BULK_RA) {
    847   1.90       wiz 			DPRINTFN(5, ("ugenread: BULK_RA req: %zd used: %d\n",
    848   1.84       gdt 				     uio->uio_resid, sce->ra_wb_used));
    849   1.84       gdt 			xfer = sce->ra_wb_xfer;
    850   1.84       gdt 
    851  1.120       mrg 			mutex_enter(&sc->sc_lock);
    852   1.84       gdt 			if (sce->ra_wb_used == 0 && flag & IO_NDELAY) {
    853  1.120       mrg 				mutex_exit(&sc->sc_lock);
    854  1.133     skrll 				return EWOULDBLOCK;
    855   1.84       gdt 			}
    856   1.84       gdt 			while (uio->uio_resid > 0 && !error) {
    857   1.84       gdt 				while (sce->ra_wb_used == 0) {
    858   1.84       gdt 					DPRINTFN(5,
    859   1.84       gdt 						 ("ugenread: sleep on %p\n",
    860   1.84       gdt 						  sce));
    861  1.120       mrg 					/* "ugenrb" */
    862  1.120       mrg 					error = cv_timedwait_sig(&sce->cv,
    863  1.120       mrg 					    &sc->sc_lock, mstohz(sce->timeout));
    864   1.84       gdt 					DPRINTFN(5,
    865   1.84       gdt 						 ("ugenread: woke, error=%d\n",
    866   1.84       gdt 						  error));
    867   1.84       gdt 					if (sc->sc_dying)
    868   1.84       gdt 						error = EIO;
    869  1.152  riastrad 					if (error)
    870   1.84       gdt 						break;
    871   1.84       gdt 				}
    872   1.84       gdt 
    873   1.84       gdt 				/* Copy data to the process. */
    874   1.84       gdt 				while (uio->uio_resid > 0
    875   1.84       gdt 				       && sce->ra_wb_used > 0) {
    876  1.140  riastrad 					n = uimin(uio->uio_resid,
    877   1.84       gdt 						sce->ra_wb_used);
    878  1.140  riastrad 					n = uimin(n, sce->limit - sce->cur);
    879   1.84       gdt 					error = uiomove(sce->cur, n, uio);
    880   1.84       gdt 					if (error)
    881   1.84       gdt 						break;
    882   1.84       gdt 					sce->cur += n;
    883   1.84       gdt 					sce->ra_wb_used -= n;
    884   1.84       gdt 					if (sce->cur == sce->limit)
    885   1.84       gdt 						sce->cur = sce->ibuf;
    886   1.84       gdt 				}
    887   1.84       gdt 
    888  1.122  christos 				/*
    889   1.84       gdt 				 * If the transfers stopped because the
    890   1.84       gdt 				 * buffer was full, restart them.
    891   1.84       gdt 				 */
    892   1.84       gdt 				if (sce->state & UGEN_RA_WB_STOP &&
    893   1.84       gdt 				    sce->ra_wb_used < sce->limit - sce->ibuf) {
    894   1.84       gdt 					n = (sce->limit - sce->ibuf)
    895   1.84       gdt 					    - sce->ra_wb_used;
    896  1.133     skrll 					usbd_setup_xfer(xfer, sce, NULL,
    897  1.140  riastrad 					    uimin(n, sce->ra_wb_xferlen),
    898  1.133     skrll 					    0, USBD_NO_TIMEOUT,
    899   1.84       gdt 					    ugen_bulkra_intr);
    900   1.84       gdt 					sce->state &= ~UGEN_RA_WB_STOP;
    901   1.84       gdt 					err = usbd_transfer(xfer);
    902   1.84       gdt 					if (err != USBD_IN_PROGRESS)
    903   1.84       gdt 						/*
    904   1.84       gdt 						 * The transfer has not been
    905   1.84       gdt 						 * queued.  Setting STOP
    906   1.84       gdt 						 * will make us try
    907   1.84       gdt 						 * again at the next read.
    908   1.84       gdt 						 */
    909   1.84       gdt 						sce->state |= UGEN_RA_WB_STOP;
    910   1.84       gdt 				}
    911   1.84       gdt 			}
    912  1.120       mrg 			mutex_exit(&sc->sc_lock);
    913   1.84       gdt 			break;
    914   1.84       gdt 		}
    915  1.133     skrll 		error = usbd_create_xfer(sce->pipeh, UGEN_BBSIZE,
    916  1.137     skrll 		    0, 0, &xfer);
    917  1.133     skrll 		if (error)
    918  1.133     skrll 			return error;
    919  1.140  riastrad 		while ((n = uimin(UGEN_BBSIZE, uio->uio_resid)) != 0) {
    920   1.10  augustss 			DPRINTFN(1, ("ugenread: start transfer %d bytes\n",n));
    921   1.10  augustss 			tn = n;
    922  1.133     skrll 			err = usbd_bulk_transfer(xfer, sce->pipeh,
    923  1.133     skrll 			    sce->state & UGEN_SHORT_OK ? USBD_SHORT_XFER_OK : 0,
    924  1.133     skrll 			    sce->timeout, sc->sc_buffer, &tn);
    925   1.30  augustss 			if (err) {
    926   1.28  augustss 				if (err == USBD_INTERRUPTED)
    927    1.8  augustss 					error = EINTR;
    928   1.28  augustss 				else if (err == USBD_TIMEOUT)
    929   1.17  augustss 					error = ETIMEDOUT;
    930    1.8  augustss 				else
    931    1.8  augustss 					error = EIO;
    932    1.1  augustss 				break;
    933    1.1  augustss 			}
    934   1.10  augustss 			DPRINTFN(1, ("ugenread: got %d bytes\n", tn));
    935   1.83  christos 			error = uiomove(sc->sc_buffer, tn, uio);
    936    1.9  augustss 			if (error || tn < n)
    937    1.1  augustss 				break;
    938    1.1  augustss 		}
    939  1.133     skrll 		usbd_destroy_xfer(xfer);
    940    1.1  augustss 		break;
    941   1.41  augustss 	case UE_ISOCHRONOUS:
    942  1.120       mrg 		mutex_enter(&sc->sc_lock);
    943   1.41  augustss 		while (sce->cur == sce->fill) {
    944   1.41  augustss 			if (flag & IO_NDELAY) {
    945  1.120       mrg 				mutex_exit(&sc->sc_lock);
    946  1.133     skrll 				return EWOULDBLOCK;
    947   1.41  augustss 			}
    948  1.120       mrg 			/* "ugenri" */
    949   1.46      yamt 			DPRINTFN(5, ("ugenread: sleep on %p\n", sce));
    950  1.120       mrg 			error = cv_timedwait_sig(&sce->cv, &sc->sc_lock,
    951  1.120       mrg 			    mstohz(sce->timeout));
    952   1.41  augustss 			DPRINTFN(5, ("ugenread: woke, error=%d\n", error));
    953   1.41  augustss 			if (sc->sc_dying)
    954   1.41  augustss 				error = EIO;
    955  1.152  riastrad 			if (error)
    956   1.41  augustss 				break;
    957   1.41  augustss 		}
    958   1.41  augustss 
    959   1.41  augustss 		while (sce->cur != sce->fill && uio->uio_resid > 0 && !error) {
    960   1.41  augustss 			if(sce->fill > sce->cur)
    961  1.140  riastrad 				n = uimin(sce->fill - sce->cur, uio->uio_resid);
    962   1.41  augustss 			else
    963  1.140  riastrad 				n = uimin(sce->limit - sce->cur, uio->uio_resid);
    964   1.41  augustss 
    965   1.41  augustss 			DPRINTFN(5, ("ugenread: isoc got %d chars\n", n));
    966   1.41  augustss 
    967   1.41  augustss 			/* Copy the data to the user process. */
    968   1.41  augustss 			error = uiomove(sce->cur, n, uio);
    969   1.41  augustss 			if (error)
    970   1.41  augustss 				break;
    971   1.41  augustss 			sce->cur += n;
    972  1.120       mrg 			if (sce->cur >= sce->limit)
    973   1.41  augustss 				sce->cur = sce->ibuf;
    974   1.41  augustss 		}
    975  1.120       mrg 		mutex_exit(&sc->sc_lock);
    976   1.41  augustss 		break;
    977   1.41  augustss 
    978   1.59  augustss 
    979    1.1  augustss 	default:
    980  1.133     skrll 		return ENXIO;
    981    1.1  augustss 	}
    982  1.133     skrll 	return error;
    983    1.1  augustss }
    984    1.1  augustss 
    985  1.147      maxv static int
    986   1.40  augustss ugenread(dev_t dev, struct uio *uio, int flag)
    987    1.1  augustss {
    988    1.1  augustss 	int endpt = UGENENDPOINT(dev);
    989   1.24  augustss 	struct ugen_softc *sc;
    990   1.12  augustss 	int error;
    991   1.12  augustss 
    992  1.155  riastrad 	if ((sc = ugenif_acquire(UGENUNIT(dev))) == NULL)
    993  1.111    dyoung 		return ENXIO;
    994   1.12  augustss 	error = ugen_do_read(sc, endpt, uio, flag);
    995  1.155  riastrad 	ugenif_release(sc);
    996  1.120       mrg 
    997  1.133     skrll 	return error;
    998   1.12  augustss }
    999   1.12  augustss 
   1000   1.37  augustss Static int
   1001   1.87   xtraeme ugen_do_write(struct ugen_softc *sc, int endpt, struct uio *uio,
   1002   1.88  christos 	int flag)
   1003   1.12  augustss {
   1004   1.10  augustss 	struct ugen_endpoint *sce = &sc->sc_endpoints[endpt][OUT];
   1005  1.133     skrll 	uint32_t n;
   1006    1.1  augustss 	int error = 0;
   1007  1.133     skrll 	uint32_t tn;
   1008   1.84       gdt 	char *dbuf;
   1009  1.133     skrll 	struct usbd_xfer *xfer;
   1010   1.28  augustss 	usbd_status err;
   1011    1.1  augustss 
   1012  1.111    dyoung 	DPRINTFN(5, ("%s: ugenwrite: %d\n", device_xname(sc->sc_dev), endpt));
   1013   1.26  augustss 
   1014   1.26  augustss 	if (endpt == USB_CONTROL_ENDPOINT)
   1015  1.133     skrll 		return ENODEV;
   1016   1.26  augustss 
   1017  1.154  riastrad 	KASSERT(sce->edesc);
   1018  1.154  riastrad 	KASSERT(sce->pipeh);
   1019    1.1  augustss 
   1020    1.1  augustss 	switch (sce->edesc->bmAttributes & UE_XFERTYPE) {
   1021    1.1  augustss 	case UE_BULK:
   1022   1.84       gdt 		if (sce->state & UGEN_BULK_WB) {
   1023   1.90       wiz 			DPRINTFN(5, ("ugenwrite: BULK_WB req: %zd used: %d\n",
   1024   1.84       gdt 				     uio->uio_resid, sce->ra_wb_used));
   1025   1.84       gdt 			xfer = sce->ra_wb_xfer;
   1026   1.84       gdt 
   1027  1.120       mrg 			mutex_enter(&sc->sc_lock);
   1028   1.84       gdt 			if (sce->ra_wb_used == sce->limit - sce->ibuf &&
   1029   1.84       gdt 			    flag & IO_NDELAY) {
   1030  1.120       mrg 				mutex_exit(&sc->sc_lock);
   1031  1.133     skrll 				return EWOULDBLOCK;
   1032   1.84       gdt 			}
   1033   1.84       gdt 			while (uio->uio_resid > 0 && !error) {
   1034  1.122  christos 				while (sce->ra_wb_used ==
   1035   1.84       gdt 				       sce->limit - sce->ibuf) {
   1036   1.84       gdt 					DPRINTFN(5,
   1037   1.84       gdt 						 ("ugenwrite: sleep on %p\n",
   1038   1.84       gdt 						  sce));
   1039  1.120       mrg 					/* "ugenwb" */
   1040  1.120       mrg 					error = cv_timedwait_sig(&sce->cv,
   1041  1.120       mrg 					    &sc->sc_lock, mstohz(sce->timeout));
   1042   1.84       gdt 					DPRINTFN(5,
   1043   1.84       gdt 						 ("ugenwrite: woke, error=%d\n",
   1044   1.84       gdt 						  error));
   1045   1.84       gdt 					if (sc->sc_dying)
   1046   1.84       gdt 						error = EIO;
   1047  1.152  riastrad 					if (error)
   1048   1.84       gdt 						break;
   1049   1.84       gdt 				}
   1050   1.84       gdt 
   1051   1.84       gdt 				/* Copy data from the process. */
   1052   1.84       gdt 				while (uio->uio_resid > 0 &&
   1053   1.84       gdt 				    sce->ra_wb_used < sce->limit - sce->ibuf) {
   1054  1.140  riastrad 					n = uimin(uio->uio_resid,
   1055   1.84       gdt 						(sce->limit - sce->ibuf)
   1056   1.84       gdt 						 - sce->ra_wb_used);
   1057  1.140  riastrad 					n = uimin(n, sce->limit - sce->fill);
   1058   1.84       gdt 					error = uiomove(sce->fill, n, uio);
   1059   1.84       gdt 					if (error)
   1060   1.84       gdt 						break;
   1061   1.84       gdt 					sce->fill += n;
   1062   1.84       gdt 					sce->ra_wb_used += n;
   1063   1.84       gdt 					if (sce->fill == sce->limit)
   1064   1.84       gdt 						sce->fill = sce->ibuf;
   1065   1.84       gdt 				}
   1066   1.84       gdt 
   1067   1.84       gdt 				/*
   1068   1.84       gdt 				 * If the transfers stopped because the
   1069   1.84       gdt 				 * buffer was empty, restart them.
   1070   1.84       gdt 				 */
   1071   1.84       gdt 				if (sce->state & UGEN_RA_WB_STOP &&
   1072   1.84       gdt 				    sce->ra_wb_used > 0) {
   1073   1.84       gdt 					dbuf = (char *)usbd_get_buffer(xfer);
   1074  1.140  riastrad 					n = uimin(sce->ra_wb_used,
   1075   1.84       gdt 						sce->ra_wb_xferlen);
   1076  1.140  riastrad 					tn = uimin(n, sce->limit - sce->cur);
   1077   1.84       gdt 					memcpy(dbuf, sce->cur, tn);
   1078   1.84       gdt 					dbuf += tn;
   1079   1.84       gdt 					if (n - tn > 0)
   1080   1.84       gdt 						memcpy(dbuf, sce->ibuf,
   1081   1.84       gdt 						       n - tn);
   1082  1.133     skrll 					usbd_setup_xfer(xfer, sce, NULL, n,
   1083  1.133     skrll 					    0, USBD_NO_TIMEOUT,
   1084   1.84       gdt 					    ugen_bulkwb_intr);
   1085   1.84       gdt 					sce->state &= ~UGEN_RA_WB_STOP;
   1086   1.84       gdt 					err = usbd_transfer(xfer);
   1087   1.84       gdt 					if (err != USBD_IN_PROGRESS)
   1088   1.84       gdt 						/*
   1089   1.84       gdt 						 * The transfer has not been
   1090   1.84       gdt 						 * queued.  Setting STOP
   1091   1.84       gdt 						 * will make us try again
   1092   1.84       gdt 						 * at the next read.
   1093   1.84       gdt 						 */
   1094   1.84       gdt 						sce->state |= UGEN_RA_WB_STOP;
   1095   1.84       gdt 				}
   1096   1.84       gdt 			}
   1097  1.120       mrg 			mutex_exit(&sc->sc_lock);
   1098   1.84       gdt 			break;
   1099   1.84       gdt 		}
   1100  1.133     skrll 		error = usbd_create_xfer(sce->pipeh, UGEN_BBSIZE,
   1101  1.137     skrll 		    0, 0, &xfer);
   1102  1.133     skrll 		if (error)
   1103  1.133     skrll 			return error;
   1104  1.140  riastrad 		while ((n = uimin(UGEN_BBSIZE, uio->uio_resid)) != 0) {
   1105   1.83  christos 			error = uiomove(sc->sc_buffer, n, uio);
   1106    1.1  augustss 			if (error)
   1107    1.1  augustss 				break;
   1108    1.1  augustss 			DPRINTFN(1, ("ugenwrite: transfer %d bytes\n", n));
   1109  1.133     skrll 			err = usbd_bulk_transfer(xfer, sce->pipeh, 0, sce->timeout,
   1110  1.133     skrll 			    sc->sc_buffer, &n);
   1111   1.28  augustss 			if (err) {
   1112   1.28  augustss 				if (err == USBD_INTERRUPTED)
   1113    1.8  augustss 					error = EINTR;
   1114   1.36  augustss 				else if (err == USBD_TIMEOUT)
   1115   1.36  augustss 					error = ETIMEDOUT;
   1116    1.8  augustss 				else
   1117    1.8  augustss 					error = EIO;
   1118    1.1  augustss 				break;
   1119    1.1  augustss 			}
   1120    1.1  augustss 		}
   1121  1.133     skrll 		usbd_destroy_xfer(xfer);
   1122    1.1  augustss 		break;
   1123   1.69  augustss 	case UE_INTERRUPT:
   1124  1.133     skrll 		error = usbd_create_xfer(sce->pipeh,
   1125  1.133     skrll 		    UGETW(sce->edesc->wMaxPacketSize), 0, 0, &xfer);
   1126  1.133     skrll 		if (error)
   1127  1.133     skrll 			return error;
   1128  1.140  riastrad 		while ((n = uimin(UGETW(sce->edesc->wMaxPacketSize),
   1129   1.69  augustss 		    uio->uio_resid)) != 0) {
   1130   1.83  christos 			error = uiomove(sc->sc_buffer, n, uio);
   1131   1.69  augustss 			if (error)
   1132   1.69  augustss 				break;
   1133   1.69  augustss 			DPRINTFN(1, ("ugenwrite: transfer %d bytes\n", n));
   1134   1.69  augustss 			err = usbd_intr_transfer(xfer, sce->pipeh, 0,
   1135  1.133     skrll 			    sce->timeout, sc->sc_buffer, &n);
   1136   1.69  augustss 			if (err) {
   1137   1.69  augustss 				if (err == USBD_INTERRUPTED)
   1138   1.69  augustss 					error = EINTR;
   1139   1.69  augustss 				else if (err == USBD_TIMEOUT)
   1140   1.69  augustss 					error = ETIMEDOUT;
   1141   1.69  augustss 				else
   1142   1.69  augustss 					error = EIO;
   1143   1.69  augustss 				break;
   1144   1.69  augustss 			}
   1145   1.69  augustss 		}
   1146  1.133     skrll 		usbd_destroy_xfer(xfer);
   1147   1.69  augustss 		break;
   1148    1.1  augustss 	default:
   1149  1.133     skrll 		return ENXIO;
   1150    1.1  augustss 	}
   1151  1.133     skrll 	return error;
   1152    1.1  augustss }
   1153    1.1  augustss 
   1154  1.147      maxv static int
   1155   1.40  augustss ugenwrite(dev_t dev, struct uio *uio, int flag)
   1156   1.12  augustss {
   1157   1.12  augustss 	int endpt = UGENENDPOINT(dev);
   1158   1.24  augustss 	struct ugen_softc *sc;
   1159   1.12  augustss 	int error;
   1160   1.12  augustss 
   1161  1.155  riastrad 	if ((sc = ugenif_acquire(UGENUNIT(dev))) == NULL)
   1162  1.111    dyoung 		return ENXIO;
   1163   1.12  augustss 	error = ugen_do_write(sc, endpt, uio, flag);
   1164  1.155  riastrad 	ugenif_release(sc);
   1165  1.120       mrg 
   1166  1.133     skrll 	return error;
   1167   1.12  augustss }
   1168   1.12  augustss 
   1169  1.147      maxv static int
   1170  1.111    dyoung ugen_activate(device_t self, enum devact act)
   1171   1.12  augustss {
   1172   1.99      cube 	struct ugen_softc *sc = device_private(self);
   1173   1.18  augustss 
   1174   1.18  augustss 	switch (act) {
   1175   1.18  augustss 	case DVACT_DEACTIVATE:
   1176   1.18  augustss 		sc->sc_dying = 1;
   1177  1.106    dyoung 		return 0;
   1178  1.106    dyoung 	default:
   1179  1.106    dyoung 		return EOPNOTSUPP;
   1180   1.18  augustss 	}
   1181   1.12  augustss }
   1182   1.12  augustss 
   1183  1.147      maxv static int
   1184  1.111    dyoung ugen_detach(device_t self, int flags)
   1185   1.12  augustss {
   1186  1.111    dyoung 	struct ugen_softc *sc = device_private(self);
   1187   1.12  augustss 	struct ugen_endpoint *sce;
   1188   1.12  augustss 	int i, dir;
   1189   1.25  augustss 	int maj, mn;
   1190   1.12  augustss 
   1191   1.12  augustss 	DPRINTF(("ugen_detach: sc=%p flags=%d\n", sc, flags));
   1192   1.12  augustss 
   1193  1.162  riastrad 	KASSERT(KERNEL_LOCKED_P()); /* sc_is_open */
   1194  1.162  riastrad 
   1195  1.162  riastrad 	/*
   1196  1.162  riastrad 	 * Fail if we're not forced to detach and userland has any
   1197  1.162  riastrad 	 * endpoints open.
   1198  1.162  riastrad 	 */
   1199  1.162  riastrad 	if ((flags & DETACH_FORCE) == 0) {
   1200  1.162  riastrad 		for (i = 0; i < USB_MAX_ENDPOINTS; i++) {
   1201  1.162  riastrad 			if (sc->sc_is_open[i])
   1202  1.162  riastrad 				return EBUSY;
   1203  1.162  riastrad 		}
   1204  1.162  riastrad 	}
   1205  1.162  riastrad 
   1206  1.162  riastrad 	/* Prevent new users.  Prevent suspend/resume.  */
   1207   1.12  augustss 	sc->sc_dying = 1;
   1208   1.96       smb 	pmf_device_deregister(self);
   1209  1.157  riastrad 
   1210  1.162  riastrad 	/*
   1211  1.162  riastrad 	 * If we never finished attaching, skip nixing endpoints and
   1212  1.162  riastrad 	 * users because there aren't any.
   1213  1.162  riastrad 	 */
   1214  1.157  riastrad 	if (!sc->sc_attached)
   1215  1.157  riastrad 		goto out;
   1216  1.157  riastrad 
   1217  1.164  riastrad 	/* Abort all pipes.  */
   1218   1.12  augustss 	for (i = 0; i < USB_MAX_ENDPOINTS; i++) {
   1219   1.12  augustss 		for (dir = OUT; dir <= IN; dir++) {
   1220   1.12  augustss 			sce = &sc->sc_endpoints[i][dir];
   1221  1.129     skrll 			if (sce->pipeh)
   1222   1.12  augustss 				usbd_abort_pipe(sce->pipeh);
   1223   1.12  augustss 		}
   1224   1.12  augustss 	}
   1225   1.12  augustss 
   1226  1.166  riastrad 	/*
   1227  1.166  riastrad 	 * Wait for users to drain.  Before this point there can be no
   1228  1.166  riastrad 	 * more I/O operations started because we set sc_dying; after
   1229  1.166  riastrad 	 * this, there can be no more I/O operations in progress, so it
   1230  1.166  riastrad 	 * will be safe to free things.
   1231  1.166  riastrad 	 */
   1232  1.120       mrg 	mutex_enter(&sc->sc_lock);
   1233   1.12  augustss 	if (--sc->sc_refcnt >= 0) {
   1234   1.12  augustss 		/* Wake everyone */
   1235  1.164  riastrad 		for (i = 0; i < USB_MAX_ENDPOINTS; i++) {
   1236  1.164  riastrad 			for (dir = OUT; dir <= IN; dir++)
   1237  1.165  riastrad 				cv_broadcast(&sc->sc_endpoints[i][dir].cv);
   1238  1.164  riastrad 		}
   1239   1.12  augustss 		/* Wait for processes to go away. */
   1240  1.166  riastrad 		do {
   1241  1.166  riastrad 			cv_wait(&sc->sc_detach_cv, &sc->sc_lock);
   1242  1.166  riastrad 		} while (sc->sc_refcnt >= 0);
   1243   1.12  augustss 	}
   1244  1.120       mrg 	mutex_exit(&sc->sc_lock);
   1245   1.12  augustss 
   1246   1.12  augustss 	/* locate the major number */
   1247   1.60   gehenna 	maj = cdevsw_lookup_major(&ugen_cdevsw);
   1248   1.12  augustss 
   1249  1.163  riastrad 	/*
   1250  1.163  riastrad 	 * Nuke the vnodes for any open instances (calls ugenclose, but
   1251  1.163  riastrad 	 * with no effect because we already set sc_dying).
   1252  1.163  riastrad 	 */
   1253  1.155  riastrad 	mn = sc->sc_unit * USB_MAX_ENDPOINTS;
   1254   1.12  augustss 	vdevgone(maj, mn, mn + USB_MAX_ENDPOINTS - 1, VCHR);
   1255   1.33  augustss 
   1256  1.163  riastrad 	/* Actually close any lingering pipes.  */
   1257  1.163  riastrad 	for (i = 0; i < USB_MAX_ENDPOINTS; i++)
   1258  1.163  riastrad 		ugen_do_close(sc, FREAD|FWRITE, i);
   1259  1.163  riastrad 
   1260  1.134   msaitoh 	usbd_add_drv_event(USB_EVENT_DRIVER_DETACH, sc->sc_udev, sc->sc_dev);
   1261  1.155  riastrad 	ugenif_put_unit(sc);
   1262   1.12  augustss 
   1263  1.157  riastrad out:	for (i = 0; i < USB_MAX_ENDPOINTS; i++) {
   1264   1.97     rmind 		for (dir = OUT; dir <= IN; dir++) {
   1265   1.97     rmind 			sce = &sc->sc_endpoints[i][dir];
   1266   1.97     rmind 			seldestroy(&sce->rsel);
   1267  1.120       mrg 			cv_destroy(&sce->cv);
   1268   1.97     rmind 		}
   1269   1.97     rmind 	}
   1270   1.97     rmind 
   1271  1.120       mrg 	cv_destroy(&sc->sc_detach_cv);
   1272  1.120       mrg 	mutex_destroy(&sc->sc_lock);
   1273  1.120       mrg 
   1274  1.133     skrll 	return 0;
   1275   1.12  augustss }
   1276    1.1  augustss 
   1277   1.37  augustss Static void
   1278  1.133     skrll ugenintr(struct usbd_xfer *xfer, void *addr, usbd_status status)
   1279    1.1  augustss {
   1280    1.1  augustss 	struct ugen_endpoint *sce = addr;
   1281  1.120       mrg 	struct ugen_softc *sc = sce->sc;
   1282  1.133     skrll 	uint32_t count;
   1283    1.1  augustss 	u_char *ibuf;
   1284    1.1  augustss 
   1285    1.1  augustss 	if (status == USBD_CANCELLED)
   1286    1.1  augustss 		return;
   1287    1.1  augustss 
   1288    1.1  augustss 	if (status != USBD_NORMAL_COMPLETION) {
   1289    1.1  augustss 		DPRINTF(("ugenintr: status=%d\n", status));
   1290   1.52  augustss 		if (status == USBD_STALLED)
   1291   1.52  augustss 		    usbd_clear_endpoint_stall_async(sce->pipeh);
   1292    1.1  augustss 		return;
   1293    1.1  augustss 	}
   1294    1.1  augustss 
   1295   1.34  augustss 	usbd_get_xfer_status(xfer, NULL, NULL, &count, NULL);
   1296    1.1  augustss 	ibuf = sce->ibuf;
   1297    1.1  augustss 
   1298   1.55  augustss 	DPRINTFN(5, ("ugenintr: xfer=%p status=%d count=%d\n",
   1299   1.28  augustss 		     xfer, status, count));
   1300    1.1  augustss 	DPRINTFN(5, ("          data = %02x %02x %02x\n",
   1301    1.8  augustss 		     ibuf[0], ibuf[1], ibuf[2]));
   1302    1.1  augustss 
   1303  1.152  riastrad 	mutex_enter(&sc->sc_lock);
   1304    1.8  augustss 	(void)b_to_q(ibuf, count, &sce->q);
   1305  1.152  riastrad 	cv_signal(&sce->cv);
   1306  1.120       mrg 	mutex_exit(&sc->sc_lock);
   1307   1.97     rmind 	selnotify(&sce->rsel, 0, 0);
   1308    1.1  augustss }
   1309    1.1  augustss 
   1310   1.41  augustss Static void
   1311  1.133     skrll ugen_isoc_rintr(struct usbd_xfer *xfer, void *addr,
   1312   1.42  augustss 		usbd_status status)
   1313   1.41  augustss {
   1314   1.41  augustss 	struct isoreq *req = addr;
   1315   1.41  augustss 	struct ugen_endpoint *sce = req->sce;
   1316  1.120       mrg 	struct ugen_softc *sc = sce->sc;
   1317  1.133     skrll 	uint32_t count, n;
   1318   1.48      yamt 	int i, isize;
   1319   1.41  augustss 
   1320   1.41  augustss 	/* Return if we are aborting. */
   1321   1.41  augustss 	if (status == USBD_CANCELLED)
   1322   1.41  augustss 		return;
   1323   1.41  augustss 
   1324   1.41  augustss 	usbd_get_xfer_status(xfer, NULL, NULL, &count, NULL);
   1325   1.66   mycroft 	DPRINTFN(5,("ugen_isoc_rintr: xfer %ld, count=%d\n",
   1326   1.66   mycroft 	    (long)(req - sce->isoreqs), count));
   1327   1.41  augustss 
   1328  1.152  riastrad 	mutex_enter(&sc->sc_lock);
   1329  1.152  riastrad 
   1330   1.41  augustss 	/* throw away oldest input if the buffer is full */
   1331  1.152  riastrad 	if (sce->fill < sce->cur && sce->cur <= sce->fill + count) {
   1332   1.41  augustss 		sce->cur += count;
   1333  1.152  riastrad 		if (sce->cur >= sce->limit)
   1334   1.41  augustss 			sce->cur = sce->ibuf + (sce->limit - sce->cur);
   1335   1.41  augustss 		DPRINTFN(5, ("ugen_isoc_rintr: throwing away %d bytes\n",
   1336   1.41  augustss 			     count));
   1337   1.41  augustss 	}
   1338   1.41  augustss 
   1339   1.48      yamt 	isize = UGETW(sce->edesc->wMaxPacketSize);
   1340   1.48      yamt 	for (i = 0; i < UGEN_NISORFRMS; i++) {
   1341  1.133     skrll 		uint32_t actlen = req->sizes[i];
   1342   1.74  christos 		char const *tbuf = (char const *)req->dmabuf + isize * i;
   1343   1.48      yamt 
   1344   1.48      yamt 		/* copy data to buffer */
   1345   1.48      yamt 		while (actlen > 0) {
   1346  1.140  riastrad 			n = uimin(actlen, sce->limit - sce->fill);
   1347   1.74  christos 			memcpy(sce->fill, tbuf, n);
   1348   1.48      yamt 
   1349   1.74  christos 			tbuf += n;
   1350   1.48      yamt 			actlen -= n;
   1351   1.48      yamt 			sce->fill += n;
   1352  1.152  riastrad 			if (sce->fill == sce->limit)
   1353   1.48      yamt 				sce->fill = sce->ibuf;
   1354   1.48      yamt 		}
   1355   1.48      yamt 
   1356   1.48      yamt 		/* setup size for next transfer */
   1357   1.48      yamt 		req->sizes[i] = isize;
   1358   1.41  augustss 	}
   1359   1.41  augustss 
   1360  1.133     skrll 	usbd_setup_isoc_xfer(xfer, req, req->sizes, UGEN_NISORFRMS, 0,
   1361  1.133     skrll 	    ugen_isoc_rintr);
   1362   1.41  augustss 	(void)usbd_transfer(xfer);
   1363   1.41  augustss 
   1364  1.152  riastrad 	cv_signal(&sce->cv);
   1365  1.120       mrg 	mutex_exit(&sc->sc_lock);
   1366   1.97     rmind 	selnotify(&sce->rsel, 0, 0);
   1367   1.41  augustss }
   1368   1.41  augustss 
   1369   1.84       gdt Static void
   1370  1.133     skrll ugen_bulkra_intr(struct usbd_xfer *xfer, void *addr,
   1371   1.84       gdt 		 usbd_status status)
   1372   1.84       gdt {
   1373   1.84       gdt 	struct ugen_endpoint *sce = addr;
   1374  1.120       mrg 	struct ugen_softc *sc = sce->sc;
   1375  1.133     skrll 	uint32_t count, n;
   1376   1.84       gdt 	char const *tbuf;
   1377   1.84       gdt 	usbd_status err;
   1378   1.84       gdt 
   1379   1.84       gdt 	/* Return if we are aborting. */
   1380   1.84       gdt 	if (status == USBD_CANCELLED)
   1381   1.84       gdt 		return;
   1382   1.84       gdt 
   1383   1.84       gdt 	if (status != USBD_NORMAL_COMPLETION) {
   1384   1.84       gdt 		DPRINTF(("ugen_bulkra_intr: status=%d\n", status));
   1385   1.84       gdt 		sce->state |= UGEN_RA_WB_STOP;
   1386   1.84       gdt 		if (status == USBD_STALLED)
   1387   1.84       gdt 		    usbd_clear_endpoint_stall_async(sce->pipeh);
   1388   1.84       gdt 		return;
   1389   1.84       gdt 	}
   1390   1.84       gdt 
   1391   1.84       gdt 	usbd_get_xfer_status(xfer, NULL, NULL, &count, NULL);
   1392   1.84       gdt 
   1393  1.152  riastrad 	mutex_enter(&sc->sc_lock);
   1394  1.152  riastrad 
   1395   1.84       gdt 	/* Keep track of how much is in the buffer. */
   1396   1.84       gdt 	sce->ra_wb_used += count;
   1397   1.84       gdt 
   1398   1.84       gdt 	/* Copy data to buffer. */
   1399   1.84       gdt 	tbuf = (char const *)usbd_get_buffer(sce->ra_wb_xfer);
   1400  1.140  riastrad 	n = uimin(count, sce->limit - sce->fill);
   1401   1.84       gdt 	memcpy(sce->fill, tbuf, n);
   1402   1.84       gdt 	tbuf += n;
   1403   1.84       gdt 	count -= n;
   1404   1.84       gdt 	sce->fill += n;
   1405   1.84       gdt 	if (sce->fill == sce->limit)
   1406   1.84       gdt 		sce->fill = sce->ibuf;
   1407   1.84       gdt 	if (count > 0) {
   1408   1.84       gdt 		memcpy(sce->fill, tbuf, count);
   1409   1.84       gdt 		sce->fill += count;
   1410   1.84       gdt 	}
   1411   1.84       gdt 
   1412   1.84       gdt 	/* Set up the next request if necessary. */
   1413   1.84       gdt 	n = (sce->limit - sce->ibuf) - sce->ra_wb_used;
   1414   1.84       gdt 	if (n > 0) {
   1415  1.140  riastrad 		usbd_setup_xfer(xfer, sce, NULL, uimin(n, sce->ra_wb_xferlen), 0,
   1416   1.84       gdt 		    USBD_NO_TIMEOUT, ugen_bulkra_intr);
   1417   1.84       gdt 		err = usbd_transfer(xfer);
   1418   1.84       gdt 		if (err != USBD_IN_PROGRESS) {
   1419   1.84       gdt 			printf("usbd_bulkra_intr: error=%d\n", err);
   1420   1.84       gdt 			/*
   1421   1.84       gdt 			 * The transfer has not been queued.  Setting STOP
   1422   1.84       gdt 			 * will make us try again at the next read.
   1423   1.84       gdt 			 */
   1424   1.84       gdt 			sce->state |= UGEN_RA_WB_STOP;
   1425   1.84       gdt 		}
   1426   1.84       gdt 	}
   1427   1.84       gdt 	else
   1428   1.84       gdt 		sce->state |= UGEN_RA_WB_STOP;
   1429   1.84       gdt 
   1430  1.152  riastrad 	cv_signal(&sce->cv);
   1431  1.120       mrg 	mutex_exit(&sc->sc_lock);
   1432   1.97     rmind 	selnotify(&sce->rsel, 0, 0);
   1433   1.84       gdt }
   1434   1.84       gdt 
   1435   1.84       gdt Static void
   1436  1.133     skrll ugen_bulkwb_intr(struct usbd_xfer *xfer, void *addr,
   1437   1.84       gdt 		 usbd_status status)
   1438   1.84       gdt {
   1439   1.84       gdt 	struct ugen_endpoint *sce = addr;
   1440  1.120       mrg 	struct ugen_softc *sc = sce->sc;
   1441  1.133     skrll 	uint32_t count, n;
   1442   1.84       gdt 	char *tbuf;
   1443   1.84       gdt 	usbd_status err;
   1444   1.84       gdt 
   1445   1.84       gdt 	/* Return if we are aborting. */
   1446   1.84       gdt 	if (status == USBD_CANCELLED)
   1447   1.84       gdt 		return;
   1448   1.84       gdt 
   1449   1.84       gdt 	if (status != USBD_NORMAL_COMPLETION) {
   1450   1.84       gdt 		DPRINTF(("ugen_bulkwb_intr: status=%d\n", status));
   1451   1.84       gdt 		sce->state |= UGEN_RA_WB_STOP;
   1452   1.84       gdt 		if (status == USBD_STALLED)
   1453   1.84       gdt 		    usbd_clear_endpoint_stall_async(sce->pipeh);
   1454   1.84       gdt 		return;
   1455   1.84       gdt 	}
   1456   1.84       gdt 
   1457   1.84       gdt 	usbd_get_xfer_status(xfer, NULL, NULL, &count, NULL);
   1458   1.84       gdt 
   1459  1.152  riastrad 	mutex_enter(&sc->sc_lock);
   1460  1.152  riastrad 
   1461   1.84       gdt 	/* Keep track of how much is in the buffer. */
   1462   1.84       gdt 	sce->ra_wb_used -= count;
   1463   1.84       gdt 
   1464   1.84       gdt 	/* Update buffer pointers. */
   1465   1.84       gdt 	sce->cur += count;
   1466   1.84       gdt 	if (sce->cur >= sce->limit)
   1467  1.122  christos 		sce->cur = sce->ibuf + (sce->cur - sce->limit);
   1468   1.84       gdt 
   1469   1.84       gdt 	/* Set up next request if necessary. */
   1470   1.84       gdt 	if (sce->ra_wb_used > 0) {
   1471   1.84       gdt 		/* copy data from buffer */
   1472   1.84       gdt 		tbuf = (char *)usbd_get_buffer(sce->ra_wb_xfer);
   1473  1.140  riastrad 		count = uimin(sce->ra_wb_used, sce->ra_wb_xferlen);
   1474  1.140  riastrad 		n = uimin(count, sce->limit - sce->cur);
   1475   1.84       gdt 		memcpy(tbuf, sce->cur, n);
   1476   1.84       gdt 		tbuf += n;
   1477   1.84       gdt 		if (count - n > 0)
   1478   1.84       gdt 			memcpy(tbuf, sce->ibuf, count - n);
   1479   1.84       gdt 
   1480  1.133     skrll 		usbd_setup_xfer(xfer, sce, NULL, count, 0, USBD_NO_TIMEOUT,
   1481  1.133     skrll 		    ugen_bulkwb_intr);
   1482   1.84       gdt 		err = usbd_transfer(xfer);
   1483   1.84       gdt 		if (err != USBD_IN_PROGRESS) {
   1484   1.84       gdt 			printf("usbd_bulkwb_intr: error=%d\n", err);
   1485   1.84       gdt 			/*
   1486   1.84       gdt 			 * The transfer has not been queued.  Setting STOP
   1487   1.84       gdt 			 * will make us try again at the next write.
   1488   1.84       gdt 			 */
   1489   1.84       gdt 			sce->state |= UGEN_RA_WB_STOP;
   1490   1.84       gdt 		}
   1491   1.84       gdt 	}
   1492   1.84       gdt 	else
   1493   1.84       gdt 		sce->state |= UGEN_RA_WB_STOP;
   1494   1.84       gdt 
   1495  1.152  riastrad 	cv_signal(&sce->cv);
   1496  1.120       mrg 	mutex_exit(&sc->sc_lock);
   1497   1.97     rmind 	selnotify(&sce->rsel, 0, 0);
   1498   1.84       gdt }
   1499   1.84       gdt 
   1500   1.37  augustss Static usbd_status
   1501   1.40  augustss ugen_set_interface(struct ugen_softc *sc, int ifaceidx, int altno)
   1502    1.1  augustss {
   1503  1.133     skrll 	struct usbd_interface *iface;
   1504    1.1  augustss 	usb_endpoint_descriptor_t *ed;
   1505   1.28  augustss 	usbd_status err;
   1506    1.1  augustss 	struct ugen_endpoint *sce;
   1507  1.133     skrll 	uint8_t niface, nendpt, endptno, endpt;
   1508   1.21  augustss 	int dir;
   1509    1.1  augustss 
   1510    1.1  augustss 	DPRINTFN(15, ("ugen_set_interface %d %d\n", ifaceidx, altno));
   1511    1.1  augustss 
   1512   1.28  augustss 	err = usbd_interface_count(sc->sc_udev, &niface);
   1513   1.28  augustss 	if (err)
   1514  1.133     skrll 		return err;
   1515    1.1  augustss 	if (ifaceidx < 0 || ifaceidx >= niface)
   1516  1.133     skrll 		return USBD_INVAL;
   1517   1.59  augustss 
   1518   1.28  augustss 	err = usbd_device2interface_handle(sc->sc_udev, ifaceidx, &iface);
   1519   1.28  augustss 	if (err)
   1520  1.133     skrll 		return err;
   1521   1.28  augustss 	err = usbd_endpoint_count(iface, &nendpt);
   1522   1.28  augustss 	if (err)
   1523  1.133     skrll 		return err;
   1524    1.1  augustss 
   1525    1.1  augustss 	/* change setting */
   1526   1.28  augustss 	err = usbd_set_interface(iface, altno);
   1527   1.28  augustss 	if (err)
   1528  1.133     skrll 		return err;
   1529   1.28  augustss 
   1530   1.28  augustss 	err = usbd_endpoint_count(iface, &nendpt);
   1531   1.28  augustss 	if (err)
   1532  1.133     skrll 		return err;
   1533  1.130     skrll 
   1534  1.130     skrll 	ugen_clear_endpoints(sc);
   1535  1.130     skrll 
   1536    1.1  augustss 	for (endptno = 0; endptno < nendpt; endptno++) {
   1537    1.1  augustss 		ed = usbd_interface2endpoint_descriptor(iface,endptno);
   1538   1.81  christos 		KASSERT(ed != NULL);
   1539    1.1  augustss 		endpt = ed->bEndpointAddress;
   1540   1.21  augustss 		dir = UE_GET_DIR(endpt) == UE_DIR_IN ? IN : OUT;
   1541   1.21  augustss 		sce = &sc->sc_endpoints[UE_GET_ADDR(endpt)][dir];
   1542    1.1  augustss 		sce->sc = sc;
   1543    1.1  augustss 		sce->edesc = ed;
   1544    1.1  augustss 		sce->iface = iface;
   1545    1.1  augustss 	}
   1546  1.133     skrll 	return 0;
   1547    1.1  augustss }
   1548    1.1  augustss 
   1549    1.1  augustss /* Retrieve a complete descriptor for a certain device and index. */
   1550   1.37  augustss Static usb_config_descriptor_t *
   1551   1.40  augustss ugen_get_cdesc(struct ugen_softc *sc, int index, int *lenp)
   1552    1.1  augustss {
   1553    1.1  augustss 	usb_config_descriptor_t *cdesc, *tdesc, cdescr;
   1554    1.1  augustss 	int len;
   1555   1.28  augustss 	usbd_status err;
   1556    1.1  augustss 
   1557    1.1  augustss 	if (index == USB_CURRENT_CONFIG_INDEX) {
   1558    1.1  augustss 		tdesc = usbd_get_config_descriptor(sc->sc_udev);
   1559  1.148    bouyer 		if (tdesc == NULL)
   1560  1.148    bouyer 			return NULL;
   1561    1.1  augustss 		len = UGETW(tdesc->wTotalLength);
   1562    1.1  augustss 		if (lenp)
   1563    1.1  augustss 			*lenp = len;
   1564  1.133     skrll 		cdesc = kmem_alloc(len, KM_SLEEP);
   1565    1.1  augustss 		memcpy(cdesc, tdesc, len);
   1566    1.1  augustss 		DPRINTFN(5,("ugen_get_cdesc: current, len=%d\n", len));
   1567    1.1  augustss 	} else {
   1568   1.28  augustss 		err = usbd_get_config_desc(sc->sc_udev, index, &cdescr);
   1569   1.28  augustss 		if (err)
   1570  1.133     skrll 			return 0;
   1571    1.1  augustss 		len = UGETW(cdescr.wTotalLength);
   1572    1.1  augustss 		DPRINTFN(5,("ugen_get_cdesc: index=%d, len=%d\n", index, len));
   1573    1.1  augustss 		if (lenp)
   1574    1.1  augustss 			*lenp = len;
   1575  1.133     skrll 		cdesc = kmem_alloc(len, KM_SLEEP);
   1576   1.56  augustss 		err = usbd_get_config_desc_full(sc->sc_udev, index, cdesc, len);
   1577   1.28  augustss 		if (err) {
   1578  1.133     skrll 			kmem_free(cdesc, len);
   1579  1.133     skrll 			return 0;
   1580    1.1  augustss 		}
   1581    1.1  augustss 	}
   1582  1.133     skrll 	return cdesc;
   1583    1.1  augustss }
   1584    1.1  augustss 
   1585   1.37  augustss Static int
   1586   1.40  augustss ugen_get_alt_index(struct ugen_softc *sc, int ifaceidx)
   1587    1.1  augustss {
   1588  1.133     skrll 	struct usbd_interface *iface;
   1589   1.28  augustss 	usbd_status err;
   1590    1.1  augustss 
   1591   1.28  augustss 	err = usbd_device2interface_handle(sc->sc_udev, ifaceidx, &iface);
   1592   1.28  augustss 	if (err)
   1593  1.133     skrll 		return -1;
   1594  1.133     skrll 	return usbd_get_interface_altindex(iface);
   1595    1.1  augustss }
   1596    1.1  augustss 
   1597   1.37  augustss Static int
   1598   1.40  augustss ugen_do_ioctl(struct ugen_softc *sc, int endpt, u_long cmd,
   1599   1.92  christos 	      void *addr, int flag, struct lwp *l)
   1600    1.1  augustss {
   1601    1.8  augustss 	struct ugen_endpoint *sce;
   1602   1.28  augustss 	usbd_status err;
   1603  1.133     skrll 	struct usbd_interface *iface;
   1604    1.1  augustss 	struct usb_config_desc *cd;
   1605    1.1  augustss 	usb_config_descriptor_t *cdesc;
   1606    1.1  augustss 	struct usb_interface_desc *id;
   1607    1.1  augustss 	usb_interface_descriptor_t *idesc;
   1608    1.1  augustss 	struct usb_endpoint_desc *ed;
   1609    1.1  augustss 	usb_endpoint_descriptor_t *edesc;
   1610    1.1  augustss 	struct usb_alt_interface *ai;
   1611    1.2  augustss 	struct usb_string_desc *si;
   1612  1.133     skrll 	uint8_t conf, alt;
   1613  1.133     skrll 	int cdesclen;
   1614  1.133     skrll 	int error;
   1615  1.141      manu 	int dir;
   1616    1.1  augustss 
   1617  1.159  riastrad 	KASSERT(KERNEL_LOCKED_P()); /* ugen_set_config */
   1618  1.159  riastrad 
   1619    1.1  augustss 	DPRINTFN(5, ("ugenioctl: cmd=%08lx\n", cmd));
   1620    1.1  augustss 
   1621    1.2  augustss 	switch (cmd) {
   1622    1.2  augustss 	case FIONBIO:
   1623    1.2  augustss 		/* All handled in the upper FS layer. */
   1624  1.133     skrll 		return 0;
   1625    1.8  augustss 	case USB_SET_SHORT_XFER:
   1626   1.13  augustss 		if (endpt == USB_CONTROL_ENDPOINT)
   1627  1.133     skrll 			return EINVAL;
   1628   1.51  augustss 		/* This flag only affects read */
   1629    1.8  augustss 		sce = &sc->sc_endpoints[endpt][IN];
   1630   1.51  augustss 		if (sce == NULL || sce->pipeh == NULL)
   1631  1.133     skrll 			return EINVAL;
   1632    1.8  augustss 		if (*(int *)addr)
   1633    1.8  augustss 			sce->state |= UGEN_SHORT_OK;
   1634    1.8  augustss 		else
   1635    1.8  augustss 			sce->state &= ~UGEN_SHORT_OK;
   1636  1.133     skrll 		return 0;
   1637   1.17  augustss 	case USB_SET_TIMEOUT:
   1638  1.141      manu 		for (dir = OUT; dir <= IN; dir++) {
   1639  1.141      manu 			sce = &sc->sc_endpoints[endpt][dir];
   1640  1.141      manu 			if (sce == NULL)
   1641  1.141      manu 				return EINVAL;
   1642  1.141      manu 
   1643  1.141      manu 			sce->timeout = *(int *)addr;
   1644  1.141      manu 		}
   1645  1.133     skrll 		return 0;
   1646   1.84       gdt 	case USB_SET_BULK_RA:
   1647   1.84       gdt 		if (endpt == USB_CONTROL_ENDPOINT)
   1648  1.133     skrll 			return EINVAL;
   1649   1.84       gdt 		sce = &sc->sc_endpoints[endpt][IN];
   1650   1.84       gdt 		if (sce == NULL || sce->pipeh == NULL)
   1651  1.133     skrll 			return EINVAL;
   1652   1.84       gdt 		edesc = sce->edesc;
   1653   1.84       gdt 		if ((edesc->bmAttributes & UE_XFERTYPE) != UE_BULK)
   1654  1.133     skrll 			return EINVAL;
   1655   1.84       gdt 
   1656   1.84       gdt 		if (*(int *)addr) {
   1657   1.84       gdt 			/* Only turn RA on if it's currently off. */
   1658   1.84       gdt 			if (sce->state & UGEN_BULK_RA)
   1659  1.133     skrll 				return 0;
   1660  1.167  riastrad 			KASSERT(sce->ra_wb_xfer == NULL);
   1661  1.167  riastrad 			KASSERT(sce->ibuf == NULL);
   1662   1.84       gdt 
   1663   1.84       gdt 			if (sce->ra_wb_bufsize == 0 || sce->ra_wb_reqsize == 0)
   1664   1.84       gdt 				/* shouldn't happen */
   1665  1.133     skrll 				return EINVAL;
   1666  1.133     skrll 			error = usbd_create_xfer(sce->pipeh,
   1667  1.133     skrll 			    sce->ra_wb_reqsize, 0, 0, &sce->ra_wb_xfer);
   1668  1.133     skrll 			if (error)
   1669  1.133     skrll 				return error;
   1670   1.84       gdt 			sce->ra_wb_xferlen = sce->ra_wb_reqsize;
   1671  1.133     skrll 			sce->ibuf = kmem_alloc(sce->ra_wb_bufsize, KM_SLEEP);
   1672   1.84       gdt 			sce->fill = sce->cur = sce->ibuf;
   1673   1.84       gdt 			sce->limit = sce->ibuf + sce->ra_wb_bufsize;
   1674   1.84       gdt 			sce->ra_wb_used = 0;
   1675   1.84       gdt 			sce->state |= UGEN_BULK_RA;
   1676   1.84       gdt 			sce->state &= ~UGEN_RA_WB_STOP;
   1677   1.84       gdt 			/* Now start reading. */
   1678  1.133     skrll 			usbd_setup_xfer(sce->ra_wb_xfer, sce, NULL,
   1679  1.140  riastrad 			    uimin(sce->ra_wb_xferlen, sce->ra_wb_bufsize),
   1680  1.133     skrll 			     0, USBD_NO_TIMEOUT, ugen_bulkra_intr);
   1681   1.84       gdt 			err = usbd_transfer(sce->ra_wb_xfer);
   1682   1.84       gdt 			if (err != USBD_IN_PROGRESS) {
   1683   1.84       gdt 				sce->state &= ~UGEN_BULK_RA;
   1684  1.133     skrll 				kmem_free(sce->ibuf, sce->ra_wb_bufsize);
   1685   1.84       gdt 				sce->ibuf = NULL;
   1686  1.133     skrll 				usbd_destroy_xfer(sce->ra_wb_xfer);
   1687  1.167  riastrad 				sce->ra_wb_xfer = NULL;
   1688  1.133     skrll 				return EIO;
   1689   1.84       gdt 			}
   1690   1.84       gdt 		} else {
   1691   1.84       gdt 			/* Only turn RA off if it's currently on. */
   1692   1.84       gdt 			if (!(sce->state & UGEN_BULK_RA))
   1693  1.133     skrll 				return 0;
   1694   1.84       gdt 
   1695   1.84       gdt 			sce->state &= ~UGEN_BULK_RA;
   1696   1.84       gdt 			usbd_abort_pipe(sce->pipeh);
   1697  1.133     skrll 			usbd_destroy_xfer(sce->ra_wb_xfer);
   1698  1.167  riastrad 			sce->ra_wb_xfer = NULL;
   1699   1.84       gdt 			/*
   1700   1.84       gdt 			 * XXX Discard whatever's in the buffer, but we
   1701   1.84       gdt 			 * should keep it around and drain the buffer
   1702   1.84       gdt 			 * instead.
   1703   1.84       gdt 			 */
   1704  1.133     skrll 			kmem_free(sce->ibuf, sce->ra_wb_bufsize);
   1705   1.84       gdt 			sce->ibuf = NULL;
   1706   1.84       gdt 		}
   1707  1.133     skrll 		return 0;
   1708   1.84       gdt 	case USB_SET_BULK_WB:
   1709   1.84       gdt 		if (endpt == USB_CONTROL_ENDPOINT)
   1710  1.133     skrll 			return EINVAL;
   1711   1.84       gdt 		sce = &sc->sc_endpoints[endpt][OUT];
   1712   1.84       gdt 		if (sce == NULL || sce->pipeh == NULL)
   1713  1.133     skrll 			return EINVAL;
   1714   1.84       gdt 		edesc = sce->edesc;
   1715   1.84       gdt 		if ((edesc->bmAttributes & UE_XFERTYPE) != UE_BULK)
   1716  1.133     skrll 			return EINVAL;
   1717   1.84       gdt 
   1718   1.84       gdt 		if (*(int *)addr) {
   1719   1.84       gdt 			/* Only turn WB on if it's currently off. */
   1720   1.84       gdt 			if (sce->state & UGEN_BULK_WB)
   1721  1.133     skrll 				return 0;
   1722  1.167  riastrad 			KASSERT(sce->ra_wb_xfer == NULL);
   1723  1.167  riastrad 			KASSERT(sce->ibuf == NULL);
   1724   1.84       gdt 
   1725   1.84       gdt 			if (sce->ra_wb_bufsize == 0 || sce->ra_wb_reqsize == 0)
   1726   1.84       gdt 				/* shouldn't happen */
   1727  1.133     skrll 				return EINVAL;
   1728  1.133     skrll 			error = usbd_create_xfer(sce->pipeh, sce->ra_wb_reqsize,
   1729  1.133     skrll 			    0, 0, &sce->ra_wb_xfer);
   1730  1.167  riastrad 			/* XXX check error???  */
   1731   1.84       gdt 			sce->ra_wb_xferlen = sce->ra_wb_reqsize;
   1732  1.133     skrll 			sce->ibuf = kmem_alloc(sce->ra_wb_bufsize, KM_SLEEP);
   1733   1.84       gdt 			sce->fill = sce->cur = sce->ibuf;
   1734   1.84       gdt 			sce->limit = sce->ibuf + sce->ra_wb_bufsize;
   1735   1.84       gdt 			sce->ra_wb_used = 0;
   1736   1.84       gdt 			sce->state |= UGEN_BULK_WB | UGEN_RA_WB_STOP;
   1737   1.84       gdt 		} else {
   1738   1.84       gdt 			/* Only turn WB off if it's currently on. */
   1739   1.84       gdt 			if (!(sce->state & UGEN_BULK_WB))
   1740  1.133     skrll 				return 0;
   1741   1.84       gdt 
   1742   1.84       gdt 			sce->state &= ~UGEN_BULK_WB;
   1743   1.84       gdt 			/*
   1744   1.84       gdt 			 * XXX Discard whatever's in the buffer, but we
   1745  1.122  christos 			 * should keep it around and keep writing to
   1746   1.84       gdt 			 * drain the buffer instead.
   1747   1.84       gdt 			 */
   1748   1.84       gdt 			usbd_abort_pipe(sce->pipeh);
   1749  1.133     skrll 			usbd_destroy_xfer(sce->ra_wb_xfer);
   1750  1.167  riastrad 			sce->ra_wb_xfer = NULL;
   1751  1.133     skrll 			kmem_free(sce->ibuf, sce->ra_wb_bufsize);
   1752   1.84       gdt 			sce->ibuf = NULL;
   1753   1.84       gdt 		}
   1754  1.133     skrll 		return 0;
   1755   1.84       gdt 	case USB_SET_BULK_RA_OPT:
   1756   1.84       gdt 	case USB_SET_BULK_WB_OPT:
   1757   1.84       gdt 	{
   1758   1.84       gdt 		struct usb_bulk_ra_wb_opt *opt;
   1759   1.84       gdt 
   1760   1.84       gdt 		if (endpt == USB_CONTROL_ENDPOINT)
   1761  1.133     skrll 			return EINVAL;
   1762   1.84       gdt 		opt = (struct usb_bulk_ra_wb_opt *)addr;
   1763   1.84       gdt 		if (cmd == USB_SET_BULK_RA_OPT)
   1764   1.84       gdt 			sce = &sc->sc_endpoints[endpt][IN];
   1765   1.84       gdt 		else
   1766   1.84       gdt 			sce = &sc->sc_endpoints[endpt][OUT];
   1767   1.84       gdt 		if (sce == NULL || sce->pipeh == NULL)
   1768  1.133     skrll 			return EINVAL;
   1769   1.84       gdt 		if (opt->ra_wb_buffer_size < 1 ||
   1770   1.84       gdt 		    opt->ra_wb_buffer_size > UGEN_BULK_RA_WB_BUFMAX ||
   1771   1.84       gdt 		    opt->ra_wb_request_size < 1 ||
   1772   1.84       gdt 		    opt->ra_wb_request_size > opt->ra_wb_buffer_size)
   1773  1.133     skrll 			return EINVAL;
   1774  1.122  christos 		/*
   1775   1.84       gdt 		 * XXX These changes do not take effect until the
   1776   1.84       gdt 		 * next time RA/WB mode is enabled but they ought to
   1777   1.84       gdt 		 * take effect immediately.
   1778   1.84       gdt 		 */
   1779   1.84       gdt 		sce->ra_wb_bufsize = opt->ra_wb_buffer_size;
   1780   1.84       gdt 		sce->ra_wb_reqsize = opt->ra_wb_request_size;
   1781  1.133     skrll 		return 0;
   1782   1.84       gdt 	}
   1783    1.2  augustss 	default:
   1784    1.2  augustss 		break;
   1785    1.2  augustss 	}
   1786    1.2  augustss 
   1787    1.1  augustss 	if (endpt != USB_CONTROL_ENDPOINT)
   1788  1.133     skrll 		return EINVAL;
   1789    1.1  augustss 
   1790    1.1  augustss 	switch (cmd) {
   1791   1.30  augustss #ifdef UGEN_DEBUG
   1792    1.8  augustss 	case USB_SETDEBUG:
   1793    1.8  augustss 		ugendebug = *(int *)addr;
   1794    1.8  augustss 		break;
   1795    1.8  augustss #endif
   1796    1.1  augustss 	case USB_GET_CONFIG:
   1797   1.28  augustss 		err = usbd_get_config(sc->sc_udev, &conf);
   1798   1.28  augustss 		if (err)
   1799  1.133     skrll 			return EIO;
   1800    1.1  augustss 		*(int *)addr = conf;
   1801    1.1  augustss 		break;
   1802    1.1  augustss 	case USB_SET_CONFIG:
   1803    1.2  augustss 		if (!(flag & FWRITE))
   1804  1.133     skrll 			return EPERM;
   1805  1.138        ws 		err = ugen_set_config(sc, *(int *)addr, 1);
   1806   1.53  augustss 		switch (err) {
   1807   1.53  augustss 		case USBD_NORMAL_COMPLETION:
   1808   1.53  augustss 			break;
   1809   1.53  augustss 		case USBD_IN_USE:
   1810  1.133     skrll 			return EBUSY;
   1811   1.53  augustss 		default:
   1812  1.133     skrll 			return EIO;
   1813   1.53  augustss 		}
   1814    1.1  augustss 		break;
   1815    1.1  augustss 	case USB_GET_ALTINTERFACE:
   1816    1.1  augustss 		ai = (struct usb_alt_interface *)addr;
   1817   1.55  augustss 		err = usbd_device2interface_handle(sc->sc_udev,
   1818   1.58  christos 			  ai->uai_interface_index, &iface);
   1819   1.28  augustss 		if (err)
   1820  1.133     skrll 			return EINVAL;
   1821    1.1  augustss 		idesc = usbd_get_interface_descriptor(iface);
   1822   1.28  augustss 		if (idesc == NULL)
   1823  1.133     skrll 			return EIO;
   1824   1.58  christos 		ai->uai_alt_no = idesc->bAlternateSetting;
   1825    1.1  augustss 		break;
   1826    1.1  augustss 	case USB_SET_ALTINTERFACE:
   1827    1.2  augustss 		if (!(flag & FWRITE))
   1828  1.133     skrll 			return EPERM;
   1829    1.1  augustss 		ai = (struct usb_alt_interface *)addr;
   1830   1.55  augustss 		err = usbd_device2interface_handle(sc->sc_udev,
   1831   1.58  christos 			  ai->uai_interface_index, &iface);
   1832   1.28  augustss 		if (err)
   1833  1.133     skrll 			return EINVAL;
   1834   1.58  christos 		err = ugen_set_interface(sc, ai->uai_interface_index,
   1835   1.58  christos 		    ai->uai_alt_no);
   1836   1.28  augustss 		if (err)
   1837  1.133     skrll 			return EINVAL;
   1838    1.1  augustss 		break;
   1839    1.1  augustss 	case USB_GET_NO_ALT:
   1840    1.1  augustss 		ai = (struct usb_alt_interface *)addr;
   1841  1.133     skrll 		cdesc = ugen_get_cdesc(sc, ai->uai_config_index, &cdesclen);
   1842   1.28  augustss 		if (cdesc == NULL)
   1843  1.133     skrll 			return EINVAL;
   1844   1.58  christos 		idesc = usbd_find_idesc(cdesc, ai->uai_interface_index, 0);
   1845   1.28  augustss 		if (idesc == NULL) {
   1846  1.133     skrll 			kmem_free(cdesc, cdesclen);
   1847  1.133     skrll 			return EINVAL;
   1848   1.12  augustss 		}
   1849   1.58  christos 		ai->uai_alt_no = usbd_get_no_alts(cdesc,
   1850   1.58  christos 		    idesc->bInterfaceNumber);
   1851  1.133     skrll 		kmem_free(cdesc, cdesclen);
   1852    1.1  augustss 		break;
   1853    1.1  augustss 	case USB_GET_DEVICE_DESC:
   1854    1.1  augustss 		*(usb_device_descriptor_t *)addr =
   1855    1.1  augustss 			*usbd_get_device_descriptor(sc->sc_udev);
   1856    1.1  augustss 		break;
   1857    1.1  augustss 	case USB_GET_CONFIG_DESC:
   1858    1.1  augustss 		cd = (struct usb_config_desc *)addr;
   1859  1.133     skrll 		cdesc = ugen_get_cdesc(sc, cd->ucd_config_index, &cdesclen);
   1860   1.28  augustss 		if (cdesc == NULL)
   1861  1.133     skrll 			return EINVAL;
   1862   1.58  christos 		cd->ucd_desc = *cdesc;
   1863  1.133     skrll 		kmem_free(cdesc, cdesclen);
   1864    1.1  augustss 		break;
   1865    1.1  augustss 	case USB_GET_INTERFACE_DESC:
   1866    1.1  augustss 		id = (struct usb_interface_desc *)addr;
   1867  1.133     skrll 		cdesc = ugen_get_cdesc(sc, id->uid_config_index, &cdesclen);
   1868   1.28  augustss 		if (cdesc == NULL)
   1869  1.133     skrll 			return EINVAL;
   1870   1.58  christos 		if (id->uid_config_index == USB_CURRENT_CONFIG_INDEX &&
   1871   1.58  christos 		    id->uid_alt_index == USB_CURRENT_ALT_INDEX)
   1872   1.58  christos 			alt = ugen_get_alt_index(sc, id->uid_interface_index);
   1873    1.1  augustss 		else
   1874   1.58  christos 			alt = id->uid_alt_index;
   1875   1.58  christos 		idesc = usbd_find_idesc(cdesc, id->uid_interface_index, alt);
   1876   1.28  augustss 		if (idesc == NULL) {
   1877  1.133     skrll 			kmem_free(cdesc, cdesclen);
   1878  1.133     skrll 			return EINVAL;
   1879    1.1  augustss 		}
   1880   1.58  christos 		id->uid_desc = *idesc;
   1881  1.133     skrll 		kmem_free(cdesc, cdesclen);
   1882    1.1  augustss 		break;
   1883    1.1  augustss 	case USB_GET_ENDPOINT_DESC:
   1884    1.1  augustss 		ed = (struct usb_endpoint_desc *)addr;
   1885  1.133     skrll 		cdesc = ugen_get_cdesc(sc, ed->ued_config_index, &cdesclen);
   1886   1.28  augustss 		if (cdesc == NULL)
   1887  1.133     skrll 			return EINVAL;
   1888   1.58  christos 		if (ed->ued_config_index == USB_CURRENT_CONFIG_INDEX &&
   1889   1.58  christos 		    ed->ued_alt_index == USB_CURRENT_ALT_INDEX)
   1890   1.58  christos 			alt = ugen_get_alt_index(sc, ed->ued_interface_index);
   1891    1.1  augustss 		else
   1892   1.58  christos 			alt = ed->ued_alt_index;
   1893   1.58  christos 		edesc = usbd_find_edesc(cdesc, ed->ued_interface_index,
   1894   1.58  christos 					alt, ed->ued_endpoint_index);
   1895   1.28  augustss 		if (edesc == NULL) {
   1896  1.133     skrll 			kmem_free(cdesc, cdesclen);
   1897  1.133     skrll 			return EINVAL;
   1898    1.1  augustss 		}
   1899   1.58  christos 		ed->ued_desc = *edesc;
   1900  1.133     skrll 		kmem_free(cdesc, cdesclen);
   1901    1.1  augustss 		break;
   1902    1.1  augustss 	case USB_GET_FULL_DESC:
   1903    1.1  augustss 	{
   1904    1.1  augustss 		int len;
   1905    1.1  augustss 		struct iovec iov;
   1906    1.1  augustss 		struct uio uio;
   1907    1.1  augustss 		struct usb_full_desc *fd = (struct usb_full_desc *)addr;
   1908    1.1  augustss 
   1909  1.133     skrll 		cdesc = ugen_get_cdesc(sc, fd->ufd_config_index, &cdesclen);
   1910  1.104     pooka 		if (cdesc == NULL)
   1911  1.133     skrll 			return EINVAL;
   1912  1.133     skrll 		len = cdesclen;
   1913   1.58  christos 		if (len > fd->ufd_size)
   1914   1.58  christos 			len = fd->ufd_size;
   1915   1.92  christos 		iov.iov_base = (void *)fd->ufd_data;
   1916    1.1  augustss 		iov.iov_len = len;
   1917    1.1  augustss 		uio.uio_iov = &iov;
   1918    1.1  augustss 		uio.uio_iovcnt = 1;
   1919    1.1  augustss 		uio.uio_resid = len;
   1920    1.1  augustss 		uio.uio_offset = 0;
   1921    1.1  augustss 		uio.uio_rw = UIO_READ;
   1922   1.79      yamt 		uio.uio_vmspace = l->l_proc->p_vmspace;
   1923   1.30  augustss 		error = uiomove((void *)cdesc, len, &uio);
   1924  1.133     skrll 		kmem_free(cdesc, cdesclen);
   1925  1.133     skrll 		return error;
   1926    1.1  augustss 	}
   1927   1.68   mycroft 	case USB_GET_STRING_DESC: {
   1928   1.68   mycroft 		int len;
   1929    1.2  augustss 		si = (struct usb_string_desc *)addr;
   1930   1.58  christos 		err = usbd_get_string_desc(sc->sc_udev, si->usd_string_index,
   1931   1.68   mycroft 			  si->usd_language_id, &si->usd_desc, &len);
   1932   1.28  augustss 		if (err)
   1933  1.133     skrll 			return EINVAL;
   1934    1.2  augustss 		break;
   1935   1.68   mycroft 	}
   1936    1.1  augustss 	case USB_DO_REQUEST:
   1937    1.1  augustss 	{
   1938    1.1  augustss 		struct usb_ctl_request *ur = (void *)addr;
   1939   1.58  christos 		int len = UGETW(ur->ucr_request.wLength);
   1940    1.1  augustss 		struct iovec iov;
   1941    1.1  augustss 		struct uio uio;
   1942    1.1  augustss 		void *ptr = 0;
   1943   1.74  christos 		usbd_status xerr;
   1944  1.133     skrll 
   1945  1.133     skrll 		error = 0;
   1946    1.1  augustss 
   1947    1.2  augustss 		if (!(flag & FWRITE))
   1948  1.133     skrll 			return EPERM;
   1949    1.1  augustss 		/* Avoid requests that would damage the bus integrity. */
   1950   1.58  christos 		if ((ur->ucr_request.bmRequestType == UT_WRITE_DEVICE &&
   1951   1.58  christos 		     ur->ucr_request.bRequest == UR_SET_ADDRESS) ||
   1952   1.58  christos 		    (ur->ucr_request.bmRequestType == UT_WRITE_DEVICE &&
   1953   1.58  christos 		     ur->ucr_request.bRequest == UR_SET_CONFIG) ||
   1954   1.58  christos 		    (ur->ucr_request.bmRequestType == UT_WRITE_INTERFACE &&
   1955   1.58  christos 		     ur->ucr_request.bRequest == UR_SET_INTERFACE))
   1956  1.133     skrll 			return EINVAL;
   1957    1.1  augustss 
   1958    1.1  augustss 		if (len < 0 || len > 32767)
   1959  1.133     skrll 			return EINVAL;
   1960    1.1  augustss 		if (len != 0) {
   1961   1.92  christos 			iov.iov_base = (void *)ur->ucr_data;
   1962    1.1  augustss 			iov.iov_len = len;
   1963    1.1  augustss 			uio.uio_iov = &iov;
   1964    1.1  augustss 			uio.uio_iovcnt = 1;
   1965    1.1  augustss 			uio.uio_resid = len;
   1966    1.1  augustss 			uio.uio_offset = 0;
   1967    1.1  augustss 			uio.uio_rw =
   1968   1.58  christos 				ur->ucr_request.bmRequestType & UT_READ ?
   1969    1.1  augustss 				UIO_READ : UIO_WRITE;
   1970   1.79      yamt 			uio.uio_vmspace = l->l_proc->p_vmspace;
   1971  1.133     skrll 			ptr = kmem_alloc(len, KM_SLEEP);
   1972    1.1  augustss 			if (uio.uio_rw == UIO_WRITE) {
   1973    1.1  augustss 				error = uiomove(ptr, len, &uio);
   1974    1.1  augustss 				if (error)
   1975    1.1  augustss 					goto ret;
   1976    1.1  augustss 			}
   1977    1.1  augustss 		}
   1978   1.57  augustss 		sce = &sc->sc_endpoints[endpt][IN];
   1979   1.74  christos 		xerr = usbd_do_request_flags(sc->sc_udev, &ur->ucr_request,
   1980   1.58  christos 			  ptr, ur->ucr_flags, &ur->ucr_actlen, sce->timeout);
   1981   1.74  christos 		if (xerr) {
   1982    1.1  augustss 			error = EIO;
   1983    1.1  augustss 			goto ret;
   1984    1.1  augustss 		}
   1985    1.1  augustss 		if (len != 0) {
   1986    1.1  augustss 			if (uio.uio_rw == UIO_READ) {
   1987  1.140  riastrad 				size_t alen = uimin(len, ur->ucr_actlen);
   1988  1.133     skrll 				error = uiomove(ptr, alen, &uio);
   1989    1.1  augustss 				if (error)
   1990    1.1  augustss 					goto ret;
   1991    1.1  augustss 			}
   1992    1.1  augustss 		}
   1993    1.1  augustss 	ret:
   1994    1.1  augustss 		if (ptr)
   1995  1.133     skrll 			kmem_free(ptr, len);
   1996  1.133     skrll 		return error;
   1997    1.1  augustss 	}
   1998    1.2  augustss 	case USB_GET_DEVICEINFO:
   1999    1.2  augustss 		usbd_fill_deviceinfo(sc->sc_udev,
   2000   1.91  drochner 				     (struct usb_device_info *)addr, 0);
   2001    1.2  augustss 		break;
   2002   1.89     pavel 	case USB_GET_DEVICEINFO_OLD:
   2003  1.142  pgoyette 	{
   2004  1.142  pgoyette 		int ret;
   2005  1.145  pgoyette 		MODULE_HOOK_CALL(usb_subr_fill_30_hook,
   2006  1.142  pgoyette 		    (sc->sc_udev, (struct usb_device_info_old *)addr, 0,
   2007  1.142  pgoyette 		      usbd_devinfo_vp, usbd_printBCD),
   2008  1.142  pgoyette 		    enosys(), ret);
   2009  1.142  pgoyette 		if (ret == 0)
   2010  1.142  pgoyette 			return 0;
   2011  1.142  pgoyette 		return EINVAL;
   2012  1.142  pgoyette 	}
   2013    1.1  augustss 	default:
   2014  1.133     skrll 		return EINVAL;
   2015    1.1  augustss 	}
   2016  1.133     skrll 	return 0;
   2017    1.1  augustss }
   2018    1.1  augustss 
   2019  1.147      maxv static int
   2020   1.92  christos ugenioctl(dev_t dev, u_long cmd, void *addr, int flag, struct lwp *l)
   2021   1.12  augustss {
   2022   1.12  augustss 	int endpt = UGENENDPOINT(dev);
   2023   1.24  augustss 	struct ugen_softc *sc;
   2024   1.12  augustss 	int error;
   2025   1.12  augustss 
   2026  1.155  riastrad 	if ((sc = ugenif_acquire(UGENUNIT(dev))) == 0)
   2027  1.111    dyoung 		return ENXIO;
   2028  1.155  riastrad 	error = ugen_do_ioctl(sc, endpt, cmd, addr, flag, l);
   2029  1.155  riastrad 	ugenif_release(sc);
   2030   1.30  augustss 
   2031  1.133     skrll 	return error;
   2032   1.12  augustss }
   2033   1.12  augustss 
   2034  1.147      maxv static int
   2035   1.78  christos ugenpoll(dev_t dev, int events, struct lwp *l)
   2036    1.1  augustss {
   2037   1.24  augustss 	struct ugen_softc *sc;
   2038   1.84       gdt 	struct ugen_endpoint *sce_in, *sce_out;
   2039    1.1  augustss 	int revents = 0;
   2040    1.1  augustss 
   2041  1.155  riastrad 	if ((sc = ugenif_acquire(UGENUNIT(dev))) == NULL)
   2042  1.133     skrll 		return POLLHUP;
   2043    1.1  augustss 
   2044  1.155  riastrad 	if (UGENENDPOINT(dev) == USB_CONTROL_ENDPOINT) {
   2045  1.155  riastrad 		revents |= POLLERR;
   2046  1.155  riastrad 		goto out;
   2047  1.155  riastrad 	}
   2048  1.113  jakllsch 
   2049   1.84       gdt 	sce_in = &sc->sc_endpoints[UGENENDPOINT(dev)][IN];
   2050   1.84       gdt 	sce_out = &sc->sc_endpoints[UGENENDPOINT(dev)][OUT];
   2051  1.154  riastrad 	KASSERT(sce_in->edesc || sce_out->edesc);
   2052  1.154  riastrad 	KASSERT(sce_in->pipeh || sce_out->pipeh);
   2053  1.120       mrg 
   2054  1.120       mrg 	mutex_enter(&sc->sc_lock);
   2055   1.84       gdt 	if (sce_in && sce_in->pipeh && (events & (POLLIN | POLLRDNORM)))
   2056   1.84       gdt 		switch (sce_in->edesc->bmAttributes & UE_XFERTYPE) {
   2057   1.84       gdt 		case UE_INTERRUPT:
   2058   1.84       gdt 			if (sce_in->q.c_cc > 0)
   2059   1.41  augustss 				revents |= events & (POLLIN | POLLRDNORM);
   2060   1.41  augustss 			else
   2061   1.84       gdt 				selrecord(l, &sce_in->rsel);
   2062   1.84       gdt 			break;
   2063   1.84       gdt 		case UE_ISOCHRONOUS:
   2064   1.84       gdt 			if (sce_in->cur != sce_in->fill)
   2065    1.1  augustss 				revents |= events & (POLLIN | POLLRDNORM);
   2066    1.1  augustss 			else
   2067   1.84       gdt 				selrecord(l, &sce_in->rsel);
   2068   1.84       gdt 			break;
   2069   1.84       gdt 		case UE_BULK:
   2070   1.84       gdt 			if (sce_in->state & UGEN_BULK_RA) {
   2071   1.84       gdt 				if (sce_in->ra_wb_used > 0)
   2072   1.84       gdt 					revents |= events &
   2073   1.84       gdt 					    (POLLIN | POLLRDNORM);
   2074   1.84       gdt 				else
   2075   1.84       gdt 					selrecord(l, &sce_in->rsel);
   2076   1.84       gdt 				break;
   2077   1.84       gdt 			}
   2078   1.84       gdt 			/*
   2079   1.84       gdt 			 * We have no easy way of determining if a read will
   2080   1.84       gdt 			 * yield any data or a write will happen.
   2081   1.84       gdt 			 * Pretend they will.
   2082   1.84       gdt 			 */
   2083  1.155  riastrad 			revents |= events & (POLLIN | POLLRDNORM);
   2084  1.155  riastrad 			break;
   2085   1.84       gdt 		default:
   2086   1.84       gdt 			break;
   2087    1.1  augustss 		}
   2088   1.84       gdt 	if (sce_out && sce_out->pipeh && (events & (POLLOUT | POLLWRNORM)))
   2089   1.84       gdt 		switch (sce_out->edesc->bmAttributes & UE_XFERTYPE) {
   2090   1.84       gdt 		case UE_INTERRUPT:
   2091   1.84       gdt 		case UE_ISOCHRONOUS:
   2092   1.84       gdt 			/* XXX unimplemented */
   2093   1.84       gdt 			break;
   2094   1.84       gdt 		case UE_BULK:
   2095   1.84       gdt 			if (sce_out->state & UGEN_BULK_WB) {
   2096   1.84       gdt 				if (sce_out->ra_wb_used <
   2097   1.84       gdt 				    sce_out->limit - sce_out->ibuf)
   2098   1.84       gdt 					revents |= events &
   2099   1.84       gdt 					    (POLLOUT | POLLWRNORM);
   2100   1.84       gdt 				else
   2101   1.84       gdt 					selrecord(l, &sce_out->rsel);
   2102   1.84       gdt 				break;
   2103   1.84       gdt 			}
   2104   1.84       gdt 			/*
   2105   1.84       gdt 			 * We have no easy way of determining if a read will
   2106   1.84       gdt 			 * yield any data or a write will happen.
   2107   1.84       gdt 			 * Pretend they will.
   2108   1.84       gdt 			 */
   2109   1.84       gdt 			 revents |= events & (POLLOUT | POLLWRNORM);
   2110   1.84       gdt 			 break;
   2111   1.84       gdt 		default:
   2112   1.84       gdt 			break;
   2113   1.84       gdt 		}
   2114   1.84       gdt 
   2115  1.120       mrg 	mutex_exit(&sc->sc_lock);
   2116   1.84       gdt 
   2117  1.155  riastrad out:	ugenif_release(sc);
   2118  1.133     skrll 	return revents;
   2119   1.62  jdolecek }
   2120   1.62  jdolecek 
   2121   1.62  jdolecek static void
   2122   1.62  jdolecek filt_ugenrdetach(struct knote *kn)
   2123   1.62  jdolecek {
   2124   1.62  jdolecek 	struct ugen_endpoint *sce = kn->kn_hook;
   2125  1.120       mrg 	struct ugen_softc *sc = sce->sc;
   2126   1.62  jdolecek 
   2127  1.120       mrg 	mutex_enter(&sc->sc_lock);
   2128  1.158   thorpej 	selremove_knote(&sce->rsel, kn);
   2129  1.120       mrg 	mutex_exit(&sc->sc_lock);
   2130   1.62  jdolecek }
   2131   1.62  jdolecek 
   2132   1.62  jdolecek static int
   2133   1.88  christos filt_ugenread_intr(struct knote *kn, long hint)
   2134   1.62  jdolecek {
   2135   1.62  jdolecek 	struct ugen_endpoint *sce = kn->kn_hook;
   2136  1.135       mrg 	struct ugen_softc *sc = sce->sc;
   2137  1.153  riastrad 	int ret;
   2138  1.135       mrg 
   2139  1.153  riastrad 	mutex_enter(&sc->sc_lock);
   2140  1.153  riastrad 	if (sc->sc_dying) {
   2141  1.153  riastrad 		ret = 0;
   2142  1.153  riastrad 	} else {
   2143  1.153  riastrad 		kn->kn_data = sce->q.c_cc;
   2144  1.153  riastrad 		ret = kn->kn_data > 0;
   2145  1.153  riastrad 	}
   2146  1.153  riastrad 	mutex_exit(&sc->sc_lock);
   2147   1.62  jdolecek 
   2148  1.153  riastrad 	return ret;
   2149   1.62  jdolecek }
   2150   1.62  jdolecek 
   2151   1.62  jdolecek static int
   2152   1.88  christos filt_ugenread_isoc(struct knote *kn, long hint)
   2153   1.62  jdolecek {
   2154   1.62  jdolecek 	struct ugen_endpoint *sce = kn->kn_hook;
   2155  1.135       mrg 	struct ugen_softc *sc = sce->sc;
   2156  1.153  riastrad 	int ret;
   2157  1.135       mrg 
   2158  1.153  riastrad 	mutex_enter(&sc->sc_lock);
   2159  1.153  riastrad 	if (sc->sc_dying) {
   2160  1.153  riastrad 		ret = 0;
   2161  1.153  riastrad 	} else if (sce->cur == sce->fill) {
   2162  1.153  riastrad 		ret = 0;
   2163  1.153  riastrad 	} else if (sce->cur < sce->fill) {
   2164   1.62  jdolecek 		kn->kn_data = sce->fill - sce->cur;
   2165  1.153  riastrad 		ret = 1;
   2166  1.153  riastrad 	} else {
   2167   1.62  jdolecek 		kn->kn_data = (sce->limit - sce->cur) +
   2168   1.62  jdolecek 		    (sce->fill - sce->ibuf);
   2169  1.153  riastrad 		ret = 1;
   2170  1.153  riastrad 	}
   2171  1.153  riastrad 	mutex_exit(&sc->sc_lock);
   2172   1.62  jdolecek 
   2173  1.153  riastrad 	return ret;
   2174   1.62  jdolecek }
   2175   1.62  jdolecek 
   2176   1.84       gdt static int
   2177   1.84       gdt filt_ugenread_bulk(struct knote *kn, long hint)
   2178   1.84       gdt {
   2179   1.84       gdt 	struct ugen_endpoint *sce = kn->kn_hook;
   2180  1.135       mrg 	struct ugen_softc *sc = sce->sc;
   2181  1.153  riastrad 	int ret;
   2182  1.135       mrg 
   2183  1.153  riastrad 	mutex_enter(&sc->sc_lock);
   2184  1.153  riastrad 	if (sc->sc_dying) {
   2185  1.153  riastrad 		ret = 0;
   2186  1.153  riastrad 	} else if (!(sce->state & UGEN_BULK_RA)) {
   2187   1.84       gdt 		/*
   2188   1.84       gdt 		 * We have no easy way of determining if a read will
   2189   1.84       gdt 		 * yield any data or a write will happen.
   2190   1.84       gdt 		 * So, emulate "seltrue".
   2191   1.84       gdt 		 */
   2192  1.153  riastrad 		ret = filt_seltrue(kn, hint);
   2193  1.153  riastrad 	} else if (sce->ra_wb_used == 0) {
   2194  1.153  riastrad 		ret = 0;
   2195  1.153  riastrad 	} else {
   2196  1.153  riastrad 		kn->kn_data = sce->ra_wb_used;
   2197  1.153  riastrad 		ret = 1;
   2198  1.153  riastrad 	}
   2199  1.153  riastrad 	mutex_exit(&sc->sc_lock);
   2200   1.84       gdt 
   2201  1.153  riastrad 	return ret;
   2202   1.84       gdt }
   2203   1.84       gdt 
   2204   1.84       gdt static int
   2205   1.84       gdt filt_ugenwrite_bulk(struct knote *kn, long hint)
   2206   1.84       gdt {
   2207   1.84       gdt 	struct ugen_endpoint *sce = kn->kn_hook;
   2208  1.135       mrg 	struct ugen_softc *sc = sce->sc;
   2209  1.153  riastrad 	int ret;
   2210  1.135       mrg 
   2211  1.153  riastrad 	mutex_enter(&sc->sc_lock);
   2212  1.153  riastrad 	if (sc->sc_dying) {
   2213  1.153  riastrad 		ret = 0;
   2214  1.153  riastrad 	} else if (!(sce->state & UGEN_BULK_WB)) {
   2215   1.84       gdt 		/*
   2216   1.84       gdt 		 * We have no easy way of determining if a read will
   2217   1.84       gdt 		 * yield any data or a write will happen.
   2218   1.84       gdt 		 * So, emulate "seltrue".
   2219   1.84       gdt 		 */
   2220  1.153  riastrad 		ret = filt_seltrue(kn, hint);
   2221  1.153  riastrad 	} else if (sce->ra_wb_used == sce->limit - sce->ibuf) {
   2222  1.153  riastrad 		ret = 0;
   2223  1.153  riastrad 	} else {
   2224  1.153  riastrad 		kn->kn_data = (sce->limit - sce->ibuf) - sce->ra_wb_used;
   2225  1.153  riastrad 		ret = 1;
   2226  1.153  riastrad 	}
   2227  1.153  riastrad 	mutex_exit(&sc->sc_lock);
   2228   1.84       gdt 
   2229  1.153  riastrad 	return ret;
   2230   1.84       gdt }
   2231   1.84       gdt 
   2232  1.136      maya static const struct filterops ugenread_intr_filtops = {
   2233  1.168   thorpej 	.f_flags = FILTEROP_ISFD,
   2234  1.136      maya 	.f_attach = NULL,
   2235  1.136      maya 	.f_detach = filt_ugenrdetach,
   2236  1.136      maya 	.f_event = filt_ugenread_intr,
   2237  1.136      maya };
   2238   1.62  jdolecek 
   2239  1.136      maya static const struct filterops ugenread_isoc_filtops = {
   2240  1.168   thorpej 	.f_flags = FILTEROP_ISFD,
   2241  1.136      maya 	.f_attach = NULL,
   2242  1.136      maya 	.f_detach = filt_ugenrdetach,
   2243  1.136      maya 	.f_event = filt_ugenread_isoc,
   2244  1.136      maya };
   2245   1.62  jdolecek 
   2246  1.136      maya static const struct filterops ugenread_bulk_filtops = {
   2247  1.168   thorpej 	.f_flags = FILTEROP_ISFD,
   2248  1.136      maya 	.f_attach = NULL,
   2249  1.136      maya 	.f_detach = filt_ugenrdetach,
   2250  1.136      maya 	.f_event = filt_ugenread_bulk,
   2251  1.136      maya };
   2252   1.84       gdt 
   2253  1.136      maya static const struct filterops ugenwrite_bulk_filtops = {
   2254  1.168   thorpej 	.f_flags = FILTEROP_ISFD,
   2255  1.136      maya 	.f_attach = NULL,
   2256  1.136      maya 	.f_detach = filt_ugenrdetach,
   2257  1.136      maya 	.f_event = filt_ugenwrite_bulk,
   2258  1.136      maya };
   2259   1.62  jdolecek 
   2260  1.147      maxv static int
   2261   1.62  jdolecek ugenkqfilter(dev_t dev, struct knote *kn)
   2262   1.62  jdolecek {
   2263   1.62  jdolecek 	struct ugen_softc *sc;
   2264   1.62  jdolecek 	struct ugen_endpoint *sce;
   2265  1.158   thorpej 	struct selinfo *sip;
   2266  1.155  riastrad 	int error;
   2267   1.62  jdolecek 
   2268  1.155  riastrad 	if ((sc = ugenif_acquire(UGENUNIT(dev))) == NULL)
   2269  1.133     skrll 		return ENXIO;
   2270   1.62  jdolecek 
   2271  1.155  riastrad 	if (UGENENDPOINT(dev) == USB_CONTROL_ENDPOINT) {
   2272  1.155  riastrad 		error = ENODEV;
   2273  1.155  riastrad 		goto out;
   2274  1.155  riastrad 	}
   2275  1.113  jakllsch 
   2276   1.62  jdolecek 	switch (kn->kn_filter) {
   2277   1.62  jdolecek 	case EVFILT_READ:
   2278   1.84       gdt 		sce = &sc->sc_endpoints[UGENENDPOINT(dev)][IN];
   2279  1.155  riastrad 		if (sce == NULL) {
   2280  1.155  riastrad 			error = EINVAL;
   2281  1.155  riastrad 			goto out;
   2282  1.155  riastrad 		}
   2283   1.84       gdt 
   2284  1.158   thorpej 		sip = &sce->rsel;
   2285   1.62  jdolecek 		switch (sce->edesc->bmAttributes & UE_XFERTYPE) {
   2286   1.62  jdolecek 		case UE_INTERRUPT:
   2287   1.62  jdolecek 			kn->kn_fop = &ugenread_intr_filtops;
   2288   1.62  jdolecek 			break;
   2289   1.62  jdolecek 		case UE_ISOCHRONOUS:
   2290   1.62  jdolecek 			kn->kn_fop = &ugenread_isoc_filtops;
   2291   1.62  jdolecek 			break;
   2292   1.62  jdolecek 		case UE_BULK:
   2293   1.84       gdt 			kn->kn_fop = &ugenread_bulk_filtops;
   2294   1.84       gdt 			break;
   2295   1.62  jdolecek 		default:
   2296  1.155  riastrad 			error = EINVAL;
   2297  1.155  riastrad 			goto out;
   2298   1.62  jdolecek 		}
   2299   1.62  jdolecek 		break;
   2300   1.62  jdolecek 
   2301   1.62  jdolecek 	case EVFILT_WRITE:
   2302   1.84       gdt 		sce = &sc->sc_endpoints[UGENENDPOINT(dev)][OUT];
   2303  1.155  riastrad 		if (sce == NULL) {
   2304  1.155  riastrad 			error = EINVAL;
   2305  1.155  riastrad 			goto out;
   2306  1.155  riastrad 		}
   2307   1.84       gdt 
   2308  1.158   thorpej 		sip = &sce->rsel;
   2309   1.62  jdolecek 		switch (sce->edesc->bmAttributes & UE_XFERTYPE) {
   2310   1.62  jdolecek 		case UE_INTERRUPT:
   2311   1.62  jdolecek 		case UE_ISOCHRONOUS:
   2312   1.62  jdolecek 			/* XXX poll doesn't support this */
   2313  1.155  riastrad 			error = EINVAL;
   2314  1.155  riastrad 			goto out;
   2315   1.62  jdolecek 
   2316   1.62  jdolecek 		case UE_BULK:
   2317   1.84       gdt 			kn->kn_fop = &ugenwrite_bulk_filtops;
   2318   1.62  jdolecek 			break;
   2319   1.62  jdolecek 		default:
   2320  1.155  riastrad 			error = EINVAL;
   2321  1.155  riastrad 			goto out;
   2322   1.62  jdolecek 		}
   2323   1.62  jdolecek 		break;
   2324   1.62  jdolecek 
   2325   1.62  jdolecek 	default:
   2326  1.155  riastrad 		error = EINVAL;
   2327  1.155  riastrad 		goto out;
   2328   1.62  jdolecek 	}
   2329   1.62  jdolecek 
   2330   1.62  jdolecek 	kn->kn_hook = sce;
   2331   1.62  jdolecek 
   2332  1.120       mrg 	mutex_enter(&sc->sc_lock);
   2333  1.158   thorpej 	selrecord_knote(sip, kn);
   2334  1.120       mrg 	mutex_exit(&sc->sc_lock);
   2335   1.62  jdolecek 
   2336  1.155  riastrad 	error = 0;
   2337  1.155  riastrad 
   2338  1.155  riastrad out:	ugenif_release(sc);
   2339  1.155  riastrad 	return error;
   2340  1.155  riastrad }
   2341  1.155  riastrad 
   2342  1.155  riastrad MODULE(MODULE_CLASS_DRIVER, ugen, NULL);
   2343  1.155  riastrad 
   2344  1.155  riastrad static int
   2345  1.155  riastrad ugen_modcmd(modcmd_t cmd, void *aux)
   2346  1.155  riastrad {
   2347  1.155  riastrad 
   2348  1.155  riastrad 	switch (cmd) {
   2349  1.155  riastrad 	case MODULE_CMD_INIT:
   2350  1.155  riastrad 		mutex_init(&ugenif.lock, MUTEX_DEFAULT, IPL_NONE);
   2351  1.155  riastrad 		rb_tree_init(&ugenif.tree, &ugenif_tree_ops);
   2352  1.155  riastrad 		return 0;
   2353  1.155  riastrad 	default:
   2354  1.155  riastrad 		return ENOTTY;
   2355  1.155  riastrad 	}
   2356    1.1  augustss }
   2357