Home | History | Annotate | Line # | Download | only in usb
ugen.c revision 1.7
      1  1.7  augustss /*	$NetBSD: ugen.c,v 1.7 1998/12/29 15:33:10 augustss Exp $	*/
      2  1.1  augustss 
      3  1.1  augustss /*
      4  1.1  augustss  * Copyright (c) 1998 The NetBSD Foundation, Inc.
      5  1.1  augustss  * All rights reserved.
      6  1.1  augustss  *
      7  1.1  augustss  * This code is derived from software contributed to The NetBSD Foundation
      8  1.1  augustss  * by Lennart Augustsson (augustss (at) carlstedt.se) at
      9  1.1  augustss  * Carlstedt Research & Technology.
     10  1.1  augustss  *
     11  1.1  augustss  * Redistribution and use in source and binary forms, with or without
     12  1.1  augustss  * modification, are permitted provided that the following conditions
     13  1.1  augustss  * are met:
     14  1.1  augustss  * 1. Redistributions of source code must retain the above copyright
     15  1.1  augustss  *    notice, this list of conditions and the following disclaimer.
     16  1.1  augustss  * 2. Redistributions in binary form must reproduce the above copyright
     17  1.1  augustss  *    notice, this list of conditions and the following disclaimer in the
     18  1.1  augustss  *    documentation and/or other materials provided with the distribution.
     19  1.1  augustss  * 3. All advertising materials mentioning features or use of this software
     20  1.1  augustss  *    must display the following acknowledgement:
     21  1.1  augustss  *        This product includes software developed by the NetBSD
     22  1.1  augustss  *        Foundation, Inc. and its contributors.
     23  1.1  augustss  * 4. Neither the name of The NetBSD Foundation nor the names of its
     24  1.1  augustss  *    contributors may be used to endorse or promote products derived
     25  1.1  augustss  *    from this software without specific prior written permission.
     26  1.1  augustss  *
     27  1.1  augustss  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     28  1.1  augustss  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     29  1.1  augustss  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     30  1.1  augustss  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     31  1.1  augustss  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     32  1.1  augustss  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     33  1.1  augustss  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     34  1.1  augustss  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     35  1.1  augustss  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     36  1.1  augustss  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     37  1.1  augustss  * POSSIBILITY OF SUCH DAMAGE.
     38  1.1  augustss  */
     39  1.1  augustss 
     40  1.1  augustss 
     41  1.1  augustss #include <sys/param.h>
     42  1.1  augustss #include <sys/systm.h>
     43  1.1  augustss #include <sys/kernel.h>
     44  1.1  augustss #include <sys/malloc.h>
     45  1.1  augustss #include <sys/device.h>
     46  1.1  augustss #include <sys/ioctl.h>
     47  1.1  augustss #include <sys/tty.h>
     48  1.1  augustss #include <sys/file.h>
     49  1.1  augustss #include <sys/select.h>
     50  1.1  augustss #include <sys/proc.h>
     51  1.1  augustss #include <sys/vnode.h>
     52  1.1  augustss #include <sys/device.h>
     53  1.1  augustss #include <sys/poll.h>
     54  1.1  augustss 
     55  1.1  augustss #include <dev/usb/usb.h>
     56  1.1  augustss #include <dev/usb/usbdi.h>
     57  1.1  augustss #include <dev/usb/usbdi_util.h>
     58  1.1  augustss 
     59  1.1  augustss #ifdef USB_DEBUG
     60  1.1  augustss #define DPRINTF(x)	if (ugendebug) printf x
     61  1.1  augustss #define DPRINTFN(n,x)	if (ugendebug>(n)) printf x
     62  1.2  augustss int	ugendebug = 0;
     63  1.1  augustss #else
     64  1.1  augustss #define DPRINTF(x)
     65  1.1  augustss #define DPRINTFN(n,x)
     66  1.1  augustss #endif
     67  1.1  augustss 
     68  1.1  augustss struct ugen_endpoint {
     69  1.1  augustss 	struct ugen_softc *sc;
     70  1.1  augustss 	usb_endpoint_descriptor_t *edesc;
     71  1.1  augustss 	usbd_interface_handle iface;
     72  1.1  augustss 	int state;
     73  1.1  augustss #define UGEN_OPEN	0x01	/* device is open */
     74  1.1  augustss #define	UGEN_ASLP	0x02	/* waiting for data */
     75  1.1  augustss 	usbd_pipe_handle pipeh;
     76  1.1  augustss 	struct clist q;
     77  1.1  augustss 	struct selinfo rsel;
     78  1.1  augustss 	void *ibuf;
     79  1.1  augustss };
     80  1.1  augustss 
     81  1.1  augustss #define	UGEN_CHUNK	128	/* chunk size for read */
     82  1.1  augustss #define	UGEN_IBSIZE	1020	/* buffer size */
     83  1.1  augustss #define	UGEN_BBSIZE	1024
     84  1.1  augustss 
     85  1.1  augustss struct ugen_softc {
     86  1.1  augustss 	struct device sc_dev;		/* base device */
     87  1.1  augustss 	struct usbd_device *sc_udev;
     88  1.1  augustss 
     89  1.1  augustss 	struct ugen_endpoint sc_endpoints[USB_MAX_ENDPOINTS][2];
     90  1.1  augustss #define OUT 0			/* index order is important, from UE_OUT */
     91  1.1  augustss #define IN  1			/* from UE_IN */
     92  1.1  augustss 
     93  1.1  augustss 	int sc_disconnected;		/* device is gone */
     94  1.1  augustss };
     95  1.1  augustss 
     96  1.1  augustss int ugen_match __P((struct device *, struct cfdata *, void *));
     97  1.1  augustss void ugen_attach __P((struct device *, struct device *, void *));
     98  1.1  augustss 
     99  1.1  augustss int ugenopen __P((dev_t, int, int, struct proc *));
    100  1.1  augustss int ugenclose __P((dev_t, int, int, struct proc *p));
    101  1.1  augustss int ugenread __P((dev_t, struct uio *uio, int));
    102  1.1  augustss int ugenwrite __P((dev_t, struct uio *uio, int));
    103  1.1  augustss int ugenioctl __P((dev_t, u_long, caddr_t, int, struct proc *));
    104  1.1  augustss int ugenpoll __P((dev_t, int, struct proc *));
    105  1.3  augustss void ugenintr __P((usbd_request_handle reqh, usbd_private_handle addr,
    106  1.3  augustss 		   usbd_status status));
    107  1.1  augustss void ugen_disco __P((void *));
    108  1.1  augustss 
    109  1.1  augustss int ugen_set_config __P((struct ugen_softc *sc, int configno));
    110  1.3  augustss usb_config_descriptor_t *ugen_get_cdesc __P((struct ugen_softc *sc, int index,
    111  1.3  augustss 					     int *lenp));
    112  1.1  augustss usbd_status ugen_set_interface __P((struct ugen_softc *, int, int));
    113  1.2  augustss int ugen_get_alt_index __P((struct ugen_softc *sc, int ifaceidx));
    114  1.1  augustss 
    115  1.1  augustss #define UGENUNIT(n) (((n) >> 4) & 0xf)
    116  1.1  augustss #define UGENENDPOINT(n) ((n) & 0xf)
    117  1.1  augustss 
    118  1.5  augustss USB_DECLARE_DRIVER(ugen);
    119  1.1  augustss 
    120  1.5  augustss USB_MATCH(ugen)
    121  1.1  augustss {
    122  1.5  augustss 	USB_MATCH_START(ugen, uaa);
    123  1.1  augustss 
    124  1.1  augustss 	if (uaa->usegeneric)
    125  1.1  augustss 		return (UMATCH_GENERIC);
    126  1.1  augustss 	else
    127  1.1  augustss 		return (UMATCH_NONE);
    128  1.1  augustss }
    129  1.1  augustss 
    130  1.5  augustss USB_ATTACH(ugen)
    131  1.1  augustss {
    132  1.5  augustss 	USB_ATTACH_START(ugen, sc, uaa);
    133  1.1  augustss 	char devinfo[1024];
    134  1.1  augustss 	usbd_status r;
    135  1.7  augustss 	int conf;
    136  1.1  augustss 
    137  1.1  augustss 	usbd_devinfo(uaa->device, 0, devinfo);
    138  1.5  augustss 	USB_ATTACH_SETUP;
    139  1.5  augustss 	printf("%s: %s\n", USBDEVNAME(sc->sc_dev), devinfo);
    140  1.1  augustss 
    141  1.1  augustss 	sc->sc_udev = uaa->device;
    142  1.7  augustss 	conf = 1;		/* XXX should not hard code 1 */
    143  1.7  augustss 	r = ugen_set_config(sc, conf);
    144  1.1  augustss 	if (r != USBD_NORMAL_COMPLETION) {
    145  1.7  augustss 		printf("%s: setting configuration %d failed\n",
    146  1.7  augustss 		       USBDEVNAME(sc->sc_dev), conf);
    147  1.1  augustss 		sc->sc_disconnected = 1;
    148  1.5  augustss 		USB_ATTACH_ERROR_RETURN;
    149  1.1  augustss 	}
    150  1.5  augustss 	USB_ATTACH_SUCCESS_RETURN;
    151  1.1  augustss }
    152  1.1  augustss 
    153  1.1  augustss int
    154  1.1  augustss ugen_set_config(sc, configno)
    155  1.1  augustss 	struct ugen_softc *sc;
    156  1.1  augustss 	int configno;
    157  1.1  augustss {
    158  1.1  augustss 	usbd_device_handle dev = sc->sc_udev;
    159  1.1  augustss 	usbd_interface_handle iface;
    160  1.1  augustss 	usb_endpoint_descriptor_t *ed;
    161  1.1  augustss 	struct ugen_endpoint *sce;
    162  1.1  augustss 	u_int8_t niface, nendpt;
    163  1.1  augustss 	int ifaceno, endptno, endpt;
    164  1.1  augustss 	usbd_status r;
    165  1.1  augustss 
    166  1.1  augustss 	DPRINTFN(1,("ugen_set_config: %s to configno %d, sc=%p\n",
    167  1.5  augustss 		    USBDEVNAME(sc->sc_dev), configno, sc));
    168  1.7  augustss 	if (usbd_get_config_descriptor(dev)->bConfigurationValue != configno) {
    169  1.7  augustss 		/* Avoid setting the current value. */
    170  1.7  augustss 		r = usbd_set_config_no(dev, configno, 0);
    171  1.7  augustss 		if (r != USBD_NORMAL_COMPLETION)
    172  1.7  augustss 			return (r);
    173  1.7  augustss 	}
    174  1.1  augustss 
    175  1.1  augustss 	r = usbd_interface_count(dev, &niface);
    176  1.1  augustss 	if (r != USBD_NORMAL_COMPLETION)
    177  1.1  augustss 		return (r);
    178  1.1  augustss 	memset(sc->sc_endpoints, 0, sizeof sc->sc_endpoints);
    179  1.1  augustss 	for (ifaceno = 0; ifaceno < niface; ifaceno++) {
    180  1.1  augustss 		DPRINTFN(1,("ugen_set_config: ifaceno %d\n", ifaceno));
    181  1.1  augustss 		r = usbd_device2interface_handle(dev, ifaceno, &iface);
    182  1.1  augustss 		if (r != USBD_NORMAL_COMPLETION)
    183  1.1  augustss 			return (r);
    184  1.1  augustss 		r = usbd_endpoint_count(iface, &nendpt);
    185  1.1  augustss 		if (r != USBD_NORMAL_COMPLETION)
    186  1.1  augustss 			return (r);
    187  1.1  augustss 		for (endptno = 0; endptno < nendpt; endptno++) {
    188  1.1  augustss 			ed = usbd_interface2endpoint_descriptor(iface,endptno);
    189  1.1  augustss 			endpt = ed->bEndpointAddress;
    190  1.1  augustss 			sce = &sc->sc_endpoints[UE_GET_ADDR(endpt)]
    191  1.1  augustss 				               [UE_GET_IN(endpt)];
    192  1.3  augustss 			DPRINTFN(1,("ugen_set_config: endptno %d, endpt=0x%02x"
    193  1.3  augustss 				    "(%d,%d), sce=%p\n",
    194  1.1  augustss 				    endptno, endpt, UE_GET_ADDR(endpt),
    195  1.1  augustss 				    UE_GET_IN(endpt), sce));
    196  1.1  augustss 			sce->sc = sc;
    197  1.1  augustss 			sce->edesc = ed;
    198  1.1  augustss 			sce->iface = iface;
    199  1.1  augustss 		}
    200  1.1  augustss 	}
    201  1.1  augustss 	return (USBD_NORMAL_COMPLETION);
    202  1.1  augustss }
    203  1.1  augustss 
    204  1.1  augustss void
    205  1.1  augustss ugen_disco(p)
    206  1.1  augustss 	void *p;
    207  1.1  augustss {
    208  1.1  augustss 	struct ugen_softc *sc = p;
    209  1.1  augustss 	sc->sc_disconnected = 1;
    210  1.1  augustss }
    211  1.1  augustss 
    212  1.1  augustss int
    213  1.1  augustss ugenopen(dev, flag, mode, p)
    214  1.1  augustss 	dev_t dev;
    215  1.1  augustss 	int flag;
    216  1.1  augustss 	int mode;
    217  1.1  augustss 	struct proc *p;
    218  1.1  augustss {
    219  1.1  augustss 	int unit = UGENUNIT(dev);
    220  1.1  augustss 	int endpt = UGENENDPOINT(dev);
    221  1.1  augustss 	usb_endpoint_descriptor_t *edesc;
    222  1.1  augustss 	struct ugen_softc *sc;
    223  1.1  augustss 	struct ugen_endpoint *sce;
    224  1.1  augustss 	int dir, isize;
    225  1.1  augustss 	usbd_status r;
    226  1.1  augustss 
    227  1.1  augustss 	DPRINTFN(5, ("ugenopen: flag=%d, unit=%d endpt=%d\n",
    228  1.1  augustss 		     flag, unit, endpt));
    229  1.1  augustss 	if (unit >= ugen_cd.cd_ndevs)
    230  1.1  augustss 		return (ENXIO);
    231  1.1  augustss 	sc = ugen_cd.cd_devs[unit];
    232  1.1  augustss 	if (!sc)
    233  1.1  augustss 		return (ENXIO);
    234  1.1  augustss 
    235  1.1  augustss 	if (sc->sc_disconnected)
    236  1.1  augustss 		return (EIO);
    237  1.1  augustss 
    238  1.1  augustss 	if (endpt == USB_CONTROL_ENDPOINT) {
    239  1.1  augustss 		/*if ((flag & (FWRITE|FREAD)) != (FWRITE|FREAD))
    240  1.1  augustss 		  return (EACCES);*/
    241  1.1  augustss 		sce = &sc->sc_endpoints[USB_CONTROL_ENDPOINT][OUT];
    242  1.1  augustss 		if (sce->state & UGEN_OPEN)
    243  1.1  augustss 			return (EBUSY);
    244  1.1  augustss 	} else {
    245  1.1  augustss 		switch (flag & (FWRITE|FREAD)) {
    246  1.1  augustss 		case FWRITE:
    247  1.1  augustss 			dir = OUT;
    248  1.1  augustss 			break;
    249  1.1  augustss 		case FREAD:
    250  1.1  augustss 			dir = IN;
    251  1.1  augustss 			break;
    252  1.1  augustss 		default:
    253  1.1  augustss 			return (EACCES);
    254  1.1  augustss 		}
    255  1.1  augustss 		sce = &sc->sc_endpoints[endpt][dir];
    256  1.3  augustss 		DPRINTFN(5, ("ugenopen: sc=%p, endpt=%d, dir=%d, sce=%p\n",
    257  1.3  augustss 			     sc, endpt, dir, sce));
    258  1.1  augustss 		if (sce->state & UGEN_OPEN)
    259  1.1  augustss 			return (EBUSY);
    260  1.1  augustss 		edesc = sce->edesc;
    261  1.1  augustss 		if (!edesc)
    262  1.1  augustss 			return (ENXIO);
    263  1.1  augustss 		switch (edesc->bmAttributes & UE_XFERTYPE) {
    264  1.1  augustss 		case UE_INTERRUPT:
    265  1.1  augustss 			isize = UGETW(edesc->wMaxPacketSize);
    266  1.1  augustss 			if (isize == 0)	/* shouldn't happen */
    267  1.1  augustss 				return (EINVAL);
    268  1.1  augustss 			sce->ibuf = malloc(isize, M_USB, M_NOWAIT);
    269  1.1  augustss 			DPRINTFN(5, ("ugenopen: intr endpt=%d,isize=%d\n",
    270  1.1  augustss 				     endpt, isize));
    271  1.1  augustss 			if (clalloc(&sce->q, UGEN_IBSIZE, 0) == -1)
    272  1.1  augustss 				return (ENOMEM);
    273  1.1  augustss 			r = usbd_open_pipe_intr(sce->iface,
    274  1.1  augustss 				edesc->bEndpointAddress,
    275  1.1  augustss 				USBD_SHORT_XFER_OK, &sce->pipeh, sce,
    276  1.1  augustss 				sce->ibuf, isize, ugenintr);
    277  1.1  augustss 			if (r != USBD_NORMAL_COMPLETION) {
    278  1.1  augustss 				free(sce->ibuf, M_USB);
    279  1.1  augustss 				clfree(&sce->q);
    280  1.1  augustss 				return (EIO);
    281  1.1  augustss 			}
    282  1.1  augustss 			usbd_set_disco(sce->pipeh, ugen_disco, sc);
    283  1.1  augustss 			DPRINTFN(5, ("ugenopen: interrupt open done\n"));
    284  1.1  augustss 			break;
    285  1.1  augustss 		case UE_BULK:
    286  1.1  augustss 			r = usbd_open_pipe(sce->iface,
    287  1.1  augustss 					   edesc->bEndpointAddress, 0,
    288  1.1  augustss 					   &sce->pipeh);
    289  1.1  augustss 			if (r != USBD_NORMAL_COMPLETION)
    290  1.1  augustss 				return (EIO);
    291  1.1  augustss 			break;
    292  1.1  augustss 		case UE_CONTROL:
    293  1.1  augustss 		case UE_ISOCHRONOUS:
    294  1.1  augustss 			return (EINVAL);
    295  1.1  augustss 		}
    296  1.1  augustss 	}
    297  1.1  augustss 	sce->state |= UGEN_OPEN;
    298  1.1  augustss 	return (0);
    299  1.1  augustss }
    300  1.1  augustss 
    301  1.1  augustss int
    302  1.1  augustss ugenclose(dev, flag, mode, p)
    303  1.1  augustss 	dev_t dev;
    304  1.1  augustss 	int flag;
    305  1.1  augustss 	int mode;
    306  1.1  augustss 	struct proc *p;
    307  1.1  augustss {
    308  1.1  augustss 	struct ugen_softc *sc = ugen_cd.cd_devs[UGENUNIT(dev)];
    309  1.1  augustss 	int endpt = UGENENDPOINT(dev);
    310  1.1  augustss 	struct ugen_endpoint *sce;
    311  1.1  augustss 	int dir;
    312  1.1  augustss 
    313  1.1  augustss 	DPRINTFN(5, ("ugenclose\n"));
    314  1.1  augustss 	if (sc->sc_disconnected)
    315  1.1  augustss 		return (EIO);
    316  1.1  augustss 
    317  1.1  augustss 	if (endpt == USB_CONTROL_ENDPOINT) {
    318  1.1  augustss 		sc->sc_endpoints[endpt][OUT].state &= ~UGEN_OPEN;
    319  1.1  augustss 		return (0);
    320  1.1  augustss 	}
    321  1.1  augustss 	dir = flag & FWRITE ? OUT : IN;
    322  1.1  augustss 	sce = &sc->sc_endpoints[endpt][dir];
    323  1.1  augustss 	sce->state &= ~UGEN_OPEN;
    324  1.1  augustss 
    325  1.1  augustss 	usbd_abort_pipe(sce->pipeh);
    326  1.1  augustss 	usbd_close_pipe(sce->pipeh);
    327  1.1  augustss 
    328  1.1  augustss 	if (sce->ibuf) {
    329  1.1  augustss 		free(sce->ibuf, M_USB);
    330  1.1  augustss 		sce->ibuf = 0;
    331  1.1  augustss 	}
    332  1.1  augustss 
    333  1.1  augustss 	return (0);
    334  1.1  augustss }
    335  1.1  augustss 
    336  1.1  augustss int
    337  1.1  augustss ugenread(dev, uio, flag)
    338  1.1  augustss 	dev_t dev;
    339  1.1  augustss 	struct uio *uio;
    340  1.1  augustss 	int flag;
    341  1.1  augustss {
    342  1.1  augustss 	struct ugen_softc *sc = ugen_cd.cd_devs[UGENUNIT(dev)];
    343  1.1  augustss 	int endpt = UGENENDPOINT(dev);
    344  1.1  augustss 	struct ugen_endpoint *sce = &sc->sc_endpoints[endpt][IN];
    345  1.1  augustss 	size_t n;
    346  1.1  augustss 	char buf[UGEN_BBSIZE];
    347  1.1  augustss 	usbd_request_handle reqh;
    348  1.1  augustss 	usbd_status r;
    349  1.1  augustss 	int s;
    350  1.1  augustss 	int error = 0;
    351  1.1  augustss 	u_char buffer[UGEN_CHUNK];
    352  1.1  augustss 
    353  1.1  augustss 	DPRINTFN(5, ("ugenread: %d:%d\n", UGENUNIT(dev), UGENENDPOINT(dev)));
    354  1.1  augustss 	if (sc->sc_disconnected)
    355  1.1  augustss 		return (EIO);
    356  1.1  augustss 
    357  1.1  augustss #ifdef DIAGNOSTIC
    358  1.1  augustss 	if (!sce->edesc) {
    359  1.1  augustss 		printf("ugenread: no edesc\n");
    360  1.1  augustss 		return (EIO);
    361  1.1  augustss 	}
    362  1.1  augustss #endif
    363  1.1  augustss 
    364  1.1  augustss 	switch (sce->edesc->bmAttributes & UE_XFERTYPE) {
    365  1.1  augustss 	case UE_INTERRUPT:
    366  1.1  augustss 		/* Block until activity occured. */
    367  1.2  augustss 		s = splusb();
    368  1.1  augustss 		while (sce->q.c_cc == 0) {
    369  1.1  augustss 			if (flag & IO_NDELAY) {
    370  1.1  augustss 				splx(s);
    371  1.1  augustss 				return EWOULDBLOCK;
    372  1.1  augustss 			}
    373  1.1  augustss 			sce->state |= UGEN_ASLP;
    374  1.1  augustss 			DPRINTFN(5, ("ugenread: sleep on %p\n", sc));
    375  1.1  augustss 			error = tsleep((caddr_t)sce, PZERO | PCATCH,
    376  1.1  augustss 				       "ugenrea", 0);
    377  1.1  augustss 			DPRINTFN(5, ("ugenread: woke, error=%d\n", error));
    378  1.1  augustss 			if (error) {
    379  1.1  augustss 				sce->state &= ~UGEN_ASLP;
    380  1.1  augustss 				splx(s);
    381  1.1  augustss 				return (error);
    382  1.1  augustss 			}
    383  1.1  augustss 		}
    384  1.1  augustss 		splx(s);
    385  1.1  augustss 
    386  1.1  augustss 		/* Transfer as many chunks as possible. */
    387  1.1  augustss 		while (sce->q.c_cc > 0 && uio->uio_resid > 0) {
    388  1.1  augustss 			n = min(sce->q.c_cc, uio->uio_resid);
    389  1.1  augustss 			if (n > sizeof(buffer))
    390  1.1  augustss 				n = sizeof(buffer);
    391  1.1  augustss 
    392  1.1  augustss 			/* Remove a small chunk from the input queue. */
    393  1.1  augustss 			q_to_b(&sce->q, buffer, n);
    394  1.1  augustss 			DPRINTFN(5, ("ugenread: got %d chars\n", n));
    395  1.1  augustss 
    396  1.1  augustss 			/* Copy the data to the user process. */
    397  1.1  augustss 			error = uiomove(buffer, n, uio);
    398  1.1  augustss 			if (error)
    399  1.1  augustss 				break;
    400  1.1  augustss 		}
    401  1.1  augustss 		break;
    402  1.1  augustss 	case UE_BULK:
    403  1.1  augustss 		reqh = usbd_alloc_request();
    404  1.1  augustss 		if (reqh == 0)
    405  1.1  augustss 			return (ENOMEM);
    406  1.1  augustss 		while ((n = min(UGEN_BBSIZE, uio->uio_resid)) != 0) {
    407  1.1  augustss 			/* XXX use callback to enable interrupt? */
    408  1.1  augustss 			r = usbd_setup_request(reqh, sce->pipeh, 0, buf, n,
    409  1.1  augustss 					       0, USBD_NO_TIMEOUT, 0);
    410  1.1  augustss 			if (r != USBD_NORMAL_COMPLETION) {
    411  1.1  augustss 				error = EIO;
    412  1.1  augustss 				break;
    413  1.1  augustss 			}
    414  1.1  augustss 			DPRINTFN(1, ("ugenread: transfer %d bytes\n", n));
    415  1.1  augustss 			r = usbd_sync_transfer(reqh);
    416  1.1  augustss 			if (r != USBD_NORMAL_COMPLETION) {
    417  1.1  augustss 				DPRINTF(("ugenread: error=%d\n", r));
    418  1.1  augustss 				usbd_clear_endpoint_stall(sce->pipeh);
    419  1.1  augustss 				error = EIO;
    420  1.1  augustss 				break;
    421  1.1  augustss 			}
    422  1.1  augustss 			error = uiomove(buf, n, uio);
    423  1.1  augustss 			if (error)
    424  1.1  augustss 				break;
    425  1.1  augustss 		}
    426  1.1  augustss 		usbd_free_request(reqh);
    427  1.1  augustss 		break;
    428  1.1  augustss 	default:
    429  1.1  augustss 		return (ENXIO);
    430  1.1  augustss 	}
    431  1.1  augustss 
    432  1.1  augustss 	return (error);
    433  1.1  augustss }
    434  1.1  augustss 
    435  1.1  augustss int
    436  1.1  augustss ugenwrite(dev, uio, flag)
    437  1.1  augustss 	dev_t dev;
    438  1.1  augustss 	struct uio *uio;
    439  1.1  augustss 	int flag;
    440  1.1  augustss {
    441  1.1  augustss 	struct ugen_softc *sc = ugen_cd.cd_devs[UGENUNIT(dev)];
    442  1.1  augustss 	int endpt = UGENENDPOINT(dev);
    443  1.1  augustss 	struct ugen_endpoint *sce = &sc->sc_endpoints[endpt][IN];
    444  1.1  augustss 	size_t n;
    445  1.1  augustss 	int error = 0;
    446  1.1  augustss 	char buf[UGEN_BBSIZE];
    447  1.1  augustss 	usbd_request_handle reqh;
    448  1.1  augustss 	usbd_status r;
    449  1.1  augustss 
    450  1.1  augustss 	if (sc->sc_disconnected)
    451  1.1  augustss 		return (EIO);
    452  1.1  augustss 
    453  1.1  augustss #ifdef DIAGNOSTIC
    454  1.1  augustss 	if (!sce->edesc) {
    455  1.1  augustss 		printf("ugenwrite: no edesc\n");
    456  1.1  augustss 		return (EIO);
    457  1.1  augustss 	}
    458  1.1  augustss #endif
    459  1.1  augustss 
    460  1.1  augustss 	DPRINTF(("ugenwrite\n"));
    461  1.1  augustss 	switch (sce->edesc->bmAttributes & UE_XFERTYPE) {
    462  1.1  augustss 	case UE_BULK:
    463  1.1  augustss 		reqh = usbd_alloc_request();
    464  1.1  augustss 		if (reqh == 0)
    465  1.1  augustss 			return (EIO);
    466  1.1  augustss 		while ((n = min(UGEN_BBSIZE, uio->uio_resid)) != 0) {
    467  1.1  augustss 			error = uiomove(buf, n, uio);
    468  1.1  augustss 			if (error)
    469  1.1  augustss 				break;
    470  1.1  augustss 			/* XXX use callback to enable interrupt? */
    471  1.1  augustss 			r = usbd_setup_request(reqh, sce->pipeh, 0, buf, n,
    472  1.1  augustss 					       0, USBD_NO_TIMEOUT, 0);
    473  1.1  augustss 			if (r != USBD_NORMAL_COMPLETION) {
    474  1.1  augustss 				error = EIO;
    475  1.1  augustss 				break;
    476  1.1  augustss 			}
    477  1.1  augustss 			DPRINTFN(1, ("ugenwrite: transfer %d bytes\n", n));
    478  1.1  augustss 			r = usbd_sync_transfer(reqh);
    479  1.1  augustss 			if (r != USBD_NORMAL_COMPLETION) {
    480  1.1  augustss 				DPRINTF(("ugenwrite: error=%d\n", r));
    481  1.1  augustss 				usbd_clear_endpoint_stall(sce->pipeh);
    482  1.1  augustss 				error = EIO;
    483  1.1  augustss 				break;
    484  1.1  augustss 			}
    485  1.1  augustss 		}
    486  1.1  augustss 		usbd_free_request(reqh);
    487  1.1  augustss 		break;
    488  1.1  augustss 	default:
    489  1.1  augustss 		return (ENXIO);
    490  1.1  augustss 	}
    491  1.1  augustss 	return (error);
    492  1.1  augustss }
    493  1.1  augustss 
    494  1.1  augustss 
    495  1.1  augustss void
    496  1.1  augustss ugenintr(reqh, addr, status)
    497  1.1  augustss 	usbd_request_handle reqh;
    498  1.1  augustss 	usbd_private_handle addr;
    499  1.1  augustss 	usbd_status status;
    500  1.1  augustss {
    501  1.1  augustss 	struct ugen_endpoint *sce = addr;
    502  1.1  augustss 	/*struct ugen_softc *sc = sce->sc;*/
    503  1.1  augustss 	u_char *ibuf;
    504  1.1  augustss 	int isize;
    505  1.1  augustss 
    506  1.1  augustss 	if (status == USBD_CANCELLED)
    507  1.1  augustss 		return;
    508  1.1  augustss 
    509  1.1  augustss 	if (status != USBD_NORMAL_COMPLETION) {
    510  1.1  augustss 		DPRINTF(("ugenintr: status=%d\n", status));
    511  1.1  augustss 		usbd_clear_endpoint_stall_async(sce->pipeh);
    512  1.1  augustss 		return;
    513  1.1  augustss 	}
    514  1.1  augustss 
    515  1.1  augustss 	ibuf = sce->ibuf;
    516  1.1  augustss 	isize = UGETW(sce->edesc->wMaxPacketSize);
    517  1.1  augustss 
    518  1.1  augustss 	/*DPRINTFN(5, ("ugenintr: addr=%d endpt=%d\n",
    519  1.1  augustss 		     addr, endpt, isize));
    520  1.1  augustss 	DPRINTFN(5, ("          data = %02x %02x %02x\n",
    521  1.1  augustss 	ibuf[0], ibuf[1], ibuf[2]));*/
    522  1.1  augustss 
    523  1.1  augustss 	(void)b_to_q(ibuf, isize, &sce->q);
    524  1.1  augustss 
    525  1.1  augustss 	if (sce->state & UGEN_ASLP) {
    526  1.1  augustss 		sce->state &= ~UGEN_ASLP;
    527  1.1  augustss 		DPRINTFN(5, ("ugen_intr: waking %p\n", sce));
    528  1.1  augustss 		wakeup((caddr_t)sce);
    529  1.1  augustss 	}
    530  1.1  augustss 	selwakeup(&sce->rsel);
    531  1.1  augustss }
    532  1.1  augustss 
    533  1.1  augustss usbd_status
    534  1.1  augustss ugen_set_interface(sc, ifaceidx, altno)
    535  1.1  augustss 	struct ugen_softc *sc;
    536  1.1  augustss 	int ifaceidx, altno;
    537  1.1  augustss {
    538  1.1  augustss 	usbd_interface_handle iface;
    539  1.1  augustss 	usb_endpoint_descriptor_t *ed;
    540  1.1  augustss 	usbd_status r;
    541  1.1  augustss 	struct ugen_endpoint *sce;
    542  1.1  augustss 	u_int8_t niface, nendpt, endptno, endpt;
    543  1.1  augustss 
    544  1.1  augustss 	DPRINTFN(15, ("ugen_set_interface %d %d\n", ifaceidx, altno));
    545  1.1  augustss 
    546  1.1  augustss 	r = usbd_interface_count(sc->sc_udev, &niface);
    547  1.1  augustss 	if (r != USBD_NORMAL_COMPLETION)
    548  1.1  augustss 		return (r);
    549  1.1  augustss 	if (ifaceidx < 0 || ifaceidx >= niface)
    550  1.1  augustss 		return (USBD_INVAL);
    551  1.1  augustss 
    552  1.1  augustss 	r = usbd_device2interface_handle(sc->sc_udev, ifaceidx, &iface);
    553  1.1  augustss 	if (r != USBD_NORMAL_COMPLETION)
    554  1.1  augustss 		return (r);
    555  1.1  augustss 	r = usbd_endpoint_count(iface, &nendpt);
    556  1.1  augustss 	if (r != USBD_NORMAL_COMPLETION)
    557  1.1  augustss 		return (r);
    558  1.1  augustss 	for (endptno = 0; endptno < nendpt; endptno++) {
    559  1.1  augustss 		ed = usbd_interface2endpoint_descriptor(iface,endptno);
    560  1.1  augustss 		endpt = ed->bEndpointAddress;
    561  1.1  augustss 		sce = &sc->sc_endpoints[UE_GET_ADDR(endpt)][UE_GET_IN(endpt)];
    562  1.1  augustss 		sce->sc = 0;
    563  1.1  augustss 		sce->edesc = 0;
    564  1.1  augustss 		sce->iface = 0;
    565  1.1  augustss 	}
    566  1.1  augustss 
    567  1.1  augustss 	/* change setting */
    568  1.1  augustss 	r = usbd_set_interface(iface, altno);
    569  1.1  augustss 	if (r != USBD_NORMAL_COMPLETION)
    570  1.1  augustss 		return (r);
    571  1.1  augustss 
    572  1.1  augustss 	r = usbd_endpoint_count(iface, &nendpt);
    573  1.1  augustss 	if (r != USBD_NORMAL_COMPLETION)
    574  1.1  augustss 		return (r);
    575  1.1  augustss 	for (endptno = 0; endptno < nendpt; endptno++) {
    576  1.1  augustss 		ed = usbd_interface2endpoint_descriptor(iface,endptno);
    577  1.1  augustss 		endpt = ed->bEndpointAddress;
    578  1.1  augustss 		sce = &sc->sc_endpoints[UE_GET_ADDR(endpt)][UE_GET_IN(endpt)];
    579  1.1  augustss 		sce->sc = sc;
    580  1.1  augustss 		sce->edesc = ed;
    581  1.1  augustss 		sce->iface = iface;
    582  1.1  augustss 	}
    583  1.1  augustss 	return (0);
    584  1.1  augustss }
    585  1.1  augustss 
    586  1.1  augustss /* Retrieve a complete descriptor for a certain device and index. */
    587  1.1  augustss usb_config_descriptor_t *
    588  1.1  augustss ugen_get_cdesc(sc, index, lenp)
    589  1.1  augustss 	struct ugen_softc *sc;
    590  1.1  augustss 	int index;
    591  1.1  augustss 	int *lenp;
    592  1.1  augustss {
    593  1.1  augustss 	usb_config_descriptor_t *cdesc, *tdesc, cdescr;
    594  1.1  augustss 	int len;
    595  1.1  augustss 	usbd_status r;
    596  1.1  augustss 
    597  1.1  augustss 	if (index == USB_CURRENT_CONFIG_INDEX) {
    598  1.1  augustss 		tdesc = usbd_get_config_descriptor(sc->sc_udev);
    599  1.1  augustss 		len = UGETW(tdesc->wTotalLength);
    600  1.1  augustss 		if (lenp)
    601  1.1  augustss 			*lenp = len;
    602  1.1  augustss 		cdesc = malloc(len, M_TEMP, M_WAITOK);
    603  1.1  augustss 		memcpy(cdesc, tdesc, len);
    604  1.1  augustss 		DPRINTFN(5,("ugen_get_cdesc: current, len=%d\n", len));
    605  1.1  augustss 	} else {
    606  1.1  augustss 		r = usbd_get_config_desc(sc->sc_udev, index, &cdescr);
    607  1.1  augustss 		if (r != USBD_NORMAL_COMPLETION)
    608  1.1  augustss 			return (0);
    609  1.1  augustss 		len = UGETW(cdescr.wTotalLength);
    610  1.1  augustss 		DPRINTFN(5,("ugen_get_cdesc: index=%d, len=%d\n", index, len));
    611  1.1  augustss 		if (lenp)
    612  1.1  augustss 			*lenp = len;
    613  1.1  augustss 		cdesc = malloc(len, M_TEMP, M_WAITOK);
    614  1.1  augustss 		r = usbd_get_config_desc_full(sc->sc_udev, index, cdesc, len);
    615  1.1  augustss 		if (r != USBD_NORMAL_COMPLETION) {
    616  1.1  augustss 			free(cdesc, M_TEMP);
    617  1.1  augustss 			return (0);
    618  1.1  augustss 		}
    619  1.1  augustss 	}
    620  1.1  augustss 	return (cdesc);
    621  1.1  augustss }
    622  1.1  augustss 
    623  1.1  augustss int
    624  1.2  augustss ugen_get_alt_index(sc, ifaceidx)
    625  1.1  augustss 	struct ugen_softc *sc;
    626  1.1  augustss 	int ifaceidx;
    627  1.1  augustss {
    628  1.1  augustss 	usbd_interface_handle iface;
    629  1.1  augustss 	usbd_status r;
    630  1.1  augustss 
    631  1.1  augustss 	r = usbd_device2interface_handle(sc->sc_udev, ifaceidx, &iface);
    632  1.1  augustss 	if (r != USBD_NORMAL_COMPLETION)
    633  1.1  augustss 			return (-1);
    634  1.2  augustss 	return (usbd_get_interface_altindex(iface));
    635  1.1  augustss }
    636  1.1  augustss 
    637  1.1  augustss int
    638  1.1  augustss ugenioctl(dev, cmd, addr, flag, p)
    639  1.1  augustss 	dev_t dev;
    640  1.1  augustss 	u_long cmd;
    641  1.1  augustss 	caddr_t addr;
    642  1.1  augustss 	int flag;
    643  1.1  augustss 	struct proc *p;
    644  1.1  augustss {
    645  1.1  augustss 	struct ugen_softc *sc = ugen_cd.cd_devs[UGENUNIT(dev)];
    646  1.1  augustss 	int endpt = UGENENDPOINT(dev);
    647  1.1  augustss 	usbd_status r;
    648  1.1  augustss 	usbd_interface_handle iface;
    649  1.1  augustss 	struct usb_config_desc *cd;
    650  1.1  augustss 	usb_config_descriptor_t *cdesc;
    651  1.1  augustss 	struct usb_interface_desc *id;
    652  1.1  augustss 	usb_interface_descriptor_t *idesc;
    653  1.1  augustss 	struct usb_endpoint_desc *ed;
    654  1.1  augustss 	usb_endpoint_descriptor_t *edesc;
    655  1.1  augustss 	struct usb_alt_interface *ai;
    656  1.2  augustss 	struct usb_string_desc *si;
    657  1.1  augustss 	u_int8_t conf, alt;
    658  1.1  augustss 
    659  1.1  augustss 	DPRINTFN(5, ("ugenioctl: cmd=%08lx\n", cmd));
    660  1.1  augustss 	if (sc->sc_disconnected)
    661  1.1  augustss 		return (EIO);
    662  1.1  augustss 
    663  1.2  augustss 	switch (cmd) {
    664  1.2  augustss 	case FIONBIO:
    665  1.2  augustss 		/* All handled in the upper FS layer. */
    666  1.2  augustss 		return (0);
    667  1.2  augustss 	default:
    668  1.2  augustss 		break;
    669  1.2  augustss 	}
    670  1.2  augustss 
    671  1.1  augustss 	if (endpt != USB_CONTROL_ENDPOINT)
    672  1.1  augustss 		return (EINVAL);
    673  1.1  augustss 
    674  1.1  augustss 	switch (cmd) {
    675  1.1  augustss 	case USB_GET_CONFIG:
    676  1.1  augustss 		r = usbd_get_config(sc->sc_udev, &conf);
    677  1.1  augustss 		if (r != USBD_NORMAL_COMPLETION)
    678  1.1  augustss 			return (EIO);
    679  1.1  augustss 		*(int *)addr = conf;
    680  1.1  augustss 		break;
    681  1.1  augustss 	case USB_SET_CONFIG:
    682  1.2  augustss 		if (!(flag & FWRITE))
    683  1.2  augustss 			return (EPERM);
    684  1.5  augustss 		r = ugen_set_config(sc, *(int *)addr);
    685  1.1  augustss 		if (r != USBD_NORMAL_COMPLETION)
    686  1.1  augustss 			return (EIO);
    687  1.1  augustss 		break;
    688  1.1  augustss 	case USB_GET_ALTINTERFACE:
    689  1.1  augustss 		ai = (struct usb_alt_interface *)addr;
    690  1.1  augustss 		r = usbd_device2interface_handle(sc->sc_udev,
    691  1.1  augustss 						 ai->interface_index, &iface);
    692  1.1  augustss 		if (r != USBD_NORMAL_COMPLETION)
    693  1.1  augustss 			return (EINVAL);
    694  1.1  augustss 		idesc = usbd_get_interface_descriptor(iface);
    695  1.2  augustss 		if (!idesc)
    696  1.2  augustss 			return (EIO);
    697  1.1  augustss 		ai->alt_no = idesc->bAlternateSetting;
    698  1.1  augustss 		break;
    699  1.1  augustss 	case USB_SET_ALTINTERFACE:
    700  1.2  augustss 		if (!(flag & FWRITE))
    701  1.2  augustss 			return (EPERM);
    702  1.1  augustss 		ai = (struct usb_alt_interface *)addr;
    703  1.1  augustss 		r = usbd_device2interface_handle(sc->sc_udev,
    704  1.1  augustss 						 ai->interface_index, &iface);
    705  1.1  augustss 		if (r != USBD_NORMAL_COMPLETION)
    706  1.1  augustss 			return (EINVAL);
    707  1.1  augustss 		r = ugen_set_interface(sc, ai->interface_index, ai->alt_no);
    708  1.1  augustss 		if (r != USBD_NORMAL_COMPLETION)
    709  1.1  augustss 			return (EINVAL);
    710  1.1  augustss 		break;
    711  1.1  augustss 	case USB_GET_NO_ALT:
    712  1.1  augustss 		ai = (struct usb_alt_interface *)addr;
    713  1.2  augustss 		cdesc = ugen_get_cdesc(sc, ai->config_index, 0);
    714  1.2  augustss 		if (!cdesc)
    715  1.2  augustss 			return (EINVAL);
    716  1.2  augustss 		idesc = usbd_find_idesc(cdesc, ai->interface_index, 0);
    717  1.2  augustss 		if (!idesc)
    718  1.1  augustss 			return (EINVAL);
    719  1.2  augustss 		ai->alt_no = usbd_get_no_alts(cdesc, idesc->bInterfaceNumber);
    720  1.1  augustss 		break;
    721  1.1  augustss 	case USB_GET_DEVICE_DESC:
    722  1.1  augustss 		*(usb_device_descriptor_t *)addr =
    723  1.1  augustss 			*usbd_get_device_descriptor(sc->sc_udev);
    724  1.1  augustss 		break;
    725  1.1  augustss 	case USB_GET_CONFIG_DESC:
    726  1.1  augustss 		cd = (struct usb_config_desc *)addr;
    727  1.1  augustss 		cdesc = ugen_get_cdesc(sc, cd->config_index, 0);
    728  1.1  augustss 		if (!cdesc)
    729  1.1  augustss 			return (EINVAL);
    730  1.1  augustss 		cd->desc = *cdesc;
    731  1.1  augustss 		free(cdesc, M_TEMP);
    732  1.1  augustss 		break;
    733  1.1  augustss 	case USB_GET_INTERFACE_DESC:
    734  1.1  augustss 		id = (struct usb_interface_desc *)addr;
    735  1.1  augustss 		cdesc = ugen_get_cdesc(sc, id->config_index, 0);
    736  1.1  augustss 		if (!cdesc)
    737  1.1  augustss 			return (EINVAL);
    738  1.1  augustss 		if (id->config_index == USB_CURRENT_CONFIG_INDEX &&
    739  1.1  augustss 		    id->alt_index == USB_CURRENT_ALT_INDEX)
    740  1.2  augustss 			alt = ugen_get_alt_index(sc, id->interface_index);
    741  1.1  augustss 		else
    742  1.1  augustss 			alt = id->alt_index;
    743  1.1  augustss 		idesc = usbd_find_idesc(cdesc, id->interface_index, alt);
    744  1.1  augustss 		if (!idesc) {
    745  1.1  augustss 			free(cdesc, M_TEMP);
    746  1.1  augustss 			return (EINVAL);
    747  1.1  augustss 		}
    748  1.1  augustss 		id->desc = *idesc;
    749  1.1  augustss 		free(cdesc, M_TEMP);
    750  1.1  augustss 		break;
    751  1.1  augustss 	case USB_GET_ENDPOINT_DESC:
    752  1.1  augustss 		ed = (struct usb_endpoint_desc *)addr;
    753  1.1  augustss 		cdesc = ugen_get_cdesc(sc, ed->config_index, 0);
    754  1.1  augustss 		if (!cdesc)
    755  1.1  augustss 			return (EINVAL);
    756  1.1  augustss 		if (ed->config_index == USB_CURRENT_CONFIG_INDEX &&
    757  1.1  augustss 		    ed->alt_index == USB_CURRENT_ALT_INDEX)
    758  1.2  augustss 			alt = ugen_get_alt_index(sc, ed->interface_index);
    759  1.1  augustss 		else
    760  1.1  augustss 			alt = ed->alt_index;
    761  1.1  augustss 		edesc = usbd_find_edesc(cdesc, ed->interface_index,
    762  1.1  augustss 					alt, ed->endpoint_index);
    763  1.1  augustss 		if (!edesc) {
    764  1.1  augustss 			free(cdesc, M_TEMP);
    765  1.1  augustss 			return (EINVAL);
    766  1.1  augustss 		}
    767  1.1  augustss 		ed->desc = *edesc;
    768  1.1  augustss 		free(cdesc, M_TEMP);
    769  1.1  augustss 		break;
    770  1.1  augustss 	case USB_GET_FULL_DESC:
    771  1.1  augustss 	{
    772  1.1  augustss 		int len;
    773  1.1  augustss 		struct iovec iov;
    774  1.1  augustss 		struct uio uio;
    775  1.1  augustss 		struct usb_full_desc *fd = (struct usb_full_desc *)addr;
    776  1.1  augustss 		int error;
    777  1.1  augustss 
    778  1.1  augustss 		cdesc = ugen_get_cdesc(sc, fd->config_index, &len);
    779  1.1  augustss 		if (len > fd->size)
    780  1.1  augustss 			len = fd->size;
    781  1.1  augustss 		iov.iov_base = (caddr_t)fd->data;
    782  1.1  augustss 		iov.iov_len = len;
    783  1.1  augustss 		uio.uio_iov = &iov;
    784  1.1  augustss 		uio.uio_iovcnt = 1;
    785  1.1  augustss 		uio.uio_resid = len;
    786  1.1  augustss 		uio.uio_offset = 0;
    787  1.1  augustss 		uio.uio_segflg = UIO_USERSPACE;
    788  1.1  augustss 		uio.uio_rw = UIO_READ;
    789  1.1  augustss 		uio.uio_procp = p;
    790  1.1  augustss 		error = uiomove(cdesc, len, &uio);
    791  1.1  augustss 		free(cdesc, M_TEMP);
    792  1.1  augustss 		return (error);
    793  1.1  augustss 	}
    794  1.2  augustss 	case USB_GET_STRING_DESC:
    795  1.2  augustss 		si = (struct usb_string_desc *)addr;
    796  1.3  augustss 		r = usbd_get_string_desc(sc->sc_udev, si->string_index,
    797  1.3  augustss 					 si->language_id, &si->desc);
    798  1.2  augustss 		if (r != USBD_NORMAL_COMPLETION)
    799  1.2  augustss 			return (EINVAL);
    800  1.2  augustss 		break;
    801  1.1  augustss 	case USB_DO_REQUEST:
    802  1.1  augustss 	{
    803  1.1  augustss 		struct usb_ctl_request *ur = (void *)addr;
    804  1.1  augustss 		int len = UGETW(ur->request.wLength);
    805  1.1  augustss 		struct iovec iov;
    806  1.1  augustss 		struct uio uio;
    807  1.1  augustss 		void *ptr = 0;
    808  1.1  augustss 		usbd_status r;
    809  1.1  augustss 		int error = 0;
    810  1.1  augustss 
    811  1.2  augustss 		if (!(flag & FWRITE))
    812  1.2  augustss 			return (EPERM);
    813  1.1  augustss 		/* Avoid requests that would damage the bus integrity. */
    814  1.1  augustss 		if ((ur->request.bmRequestType == UT_WRITE_DEVICE &&
    815  1.1  augustss 		     ur->request.bRequest == UR_SET_ADDRESS) ||
    816  1.1  augustss 		    (ur->request.bmRequestType == UT_WRITE_DEVICE &&
    817  1.1  augustss 		     ur->request.bRequest == UR_SET_CONFIG) ||
    818  1.1  augustss 		    (ur->request.bmRequestType == UT_WRITE_INTERFACE &&
    819  1.1  augustss 		     ur->request.bRequest == UR_SET_INTERFACE))
    820  1.1  augustss 			return (EINVAL);
    821  1.1  augustss 
    822  1.1  augustss 		if (len < 0 || len > 32767)
    823  1.1  augustss 			return (EINVAL);
    824  1.1  augustss 		if (len != 0) {
    825  1.1  augustss 			iov.iov_base = (caddr_t)ur->data;
    826  1.1  augustss 			iov.iov_len = len;
    827  1.1  augustss 			uio.uio_iov = &iov;
    828  1.1  augustss 			uio.uio_iovcnt = 1;
    829  1.1  augustss 			uio.uio_resid = len;
    830  1.1  augustss 			uio.uio_offset = 0;
    831  1.1  augustss 			uio.uio_segflg = UIO_USERSPACE;
    832  1.1  augustss 			uio.uio_rw =
    833  1.1  augustss 				ur->request.bmRequestType & UT_READ ?
    834  1.1  augustss 				UIO_READ : UIO_WRITE;
    835  1.1  augustss 			uio.uio_procp = p;
    836  1.1  augustss 			ptr = malloc(len, M_TEMP, M_WAITOK);
    837  1.1  augustss 			if (uio.uio_rw == UIO_WRITE) {
    838  1.1  augustss 				error = uiomove(ptr, len, &uio);
    839  1.1  augustss 				if (error)
    840  1.1  augustss 					goto ret;
    841  1.1  augustss 			}
    842  1.1  augustss 		}
    843  1.6  augustss 		r = usbd_do_request_flags(sc->sc_udev, &ur->request,
    844  1.6  augustss 					  ptr, ur->flags);
    845  1.1  augustss 		if (r) {
    846  1.1  augustss 			error = EIO;
    847  1.1  augustss 			goto ret;
    848  1.1  augustss 		}
    849  1.1  augustss 		if (len != 0) {
    850  1.1  augustss 			if (uio.uio_rw == UIO_READ) {
    851  1.1  augustss 				error = uiomove(ptr, len, &uio);
    852  1.1  augustss 				if (error)
    853  1.1  augustss 					goto ret;
    854  1.1  augustss 			}
    855  1.1  augustss 		}
    856  1.1  augustss 	ret:
    857  1.1  augustss 		if (ptr)
    858  1.1  augustss 			free(ptr, M_TEMP);
    859  1.1  augustss 		return (error);
    860  1.1  augustss 	}
    861  1.2  augustss 	case USB_GET_DEVICEINFO:
    862  1.2  augustss 		usbd_fill_deviceinfo(sc->sc_udev,
    863  1.2  augustss 				     (struct usb_device_info *)addr);
    864  1.2  augustss 		break;
    865  1.1  augustss 	default:
    866  1.1  augustss 		return (EINVAL);
    867  1.1  augustss 	}
    868  1.1  augustss 	return (0);
    869  1.1  augustss }
    870  1.1  augustss 
    871  1.1  augustss int
    872  1.1  augustss ugenpoll(dev, events, p)
    873  1.1  augustss 	dev_t dev;
    874  1.1  augustss 	int events;
    875  1.1  augustss 	struct proc *p;
    876  1.1  augustss {
    877  1.1  augustss 	struct ugen_softc *sc = ugen_cd.cd_devs[UGENUNIT(dev)];
    878  1.1  augustss 	/* XXX */
    879  1.2  augustss 	struct ugen_endpoint *sce;
    880  1.1  augustss 	int revents = 0;
    881  1.1  augustss 	int s;
    882  1.1  augustss 
    883  1.1  augustss 	if (sc->sc_disconnected)
    884  1.1  augustss 		return (EIO);
    885  1.1  augustss 
    886  1.4  augustss 	sce = &sc->sc_endpoints[UGENENDPOINT(dev)][IN];
    887  1.4  augustss 	if (!sce->edesc) return (0); /* XXX */
    888  1.2  augustss 	s = splusb();
    889  1.2  augustss 	switch (sce->edesc->bmAttributes & UE_XFERTYPE) {
    890  1.1  augustss 	case UE_INTERRUPT:
    891  1.1  augustss 		if (events & (POLLIN | POLLRDNORM)) {
    892  1.1  augustss 			if (sce->q.c_cc > 0)
    893  1.1  augustss 				revents |= events & (POLLIN | POLLRDNORM);
    894  1.1  augustss 			else
    895  1.1  augustss 				selrecord(p, &sce->rsel);
    896  1.1  augustss 		}
    897  1.2  augustss 		break;
    898  1.2  augustss 	case UE_BULK:
    899  1.2  augustss 		/*
    900  1.2  augustss 		 * We have no easy way of determining if a read will
    901  1.2  augustss 		 * yield any data or a write will happen.
    902  1.2  augustss 		 * Pretend they will.
    903  1.2  augustss 		 */
    904  1.2  augustss 		revents |= events &
    905  1.2  augustss 			   (POLLIN | POLLRDNORM | POLLOUT | POLLWRNORM);
    906  1.2  augustss 		break;
    907  1.2  augustss 	default:
    908  1.1  augustss 		break;
    909  1.1  augustss 	}
    910  1.1  augustss 	splx(s);
    911  1.1  augustss 	return (revents);
    912  1.1  augustss }
    913  1.5  augustss 
    914  1.5  augustss #if defined(__FreeBSD__)
    915  1.5  augustss static int
    916  1.5  augustss ugen_detach(device_t self)
    917  1.5  augustss {
    918  1.5  augustss         struct ugen_softc *sc = device_get_softc(self);
    919  1.5  augustss 	char *devinfo = (char *) device_get_desc(self);
    920  1.5  augustss 
    921  1.5  augustss 	if (devinfo) {
    922  1.5  augustss 		device_set_desc(self, NULL);
    923  1.5  augustss 		free(devinfo, M_USB);
    924  1.5  augustss 	}
    925  1.5  augustss 	return 0;
    926  1.5  augustss }
    927  1.5  augustss #endif
    928