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