Home | History | Annotate | Line # | Download | only in usb
uhid.c revision 1.101.4.1
      1  1.101.4.1  christos /*	$NetBSD: uhid.c,v 1.101.4.1 2019/06/10 22:07:34 christos Exp $	*/
      2        1.1  augustss 
      3        1.1  augustss /*
      4       1.88       mrg  * Copyright (c) 1998, 2004, 2008, 2012 The NetBSD Foundation, Inc.
      5        1.1  augustss  * All rights reserved.
      6        1.1  augustss  *
      7        1.6  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.88       mrg  * Carlstedt Research & Technology and Matthew R. Green (mrg (at) eterna.com.au).
     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  *
     20        1.1  augustss  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     21        1.1  augustss  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     22        1.1  augustss  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     23        1.1  augustss  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     24        1.1  augustss  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     25        1.1  augustss  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     26        1.1  augustss  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     27        1.1  augustss  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     28        1.1  augustss  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     29        1.1  augustss  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     30        1.1  augustss  * POSSIBILITY OF SUCH DAMAGE.
     31        1.1  augustss  */
     32        1.1  augustss 
     33       1.15  augustss /*
     34       1.57  augustss  * HID spec: http://www.usb.org/developers/devclass_docs/HID1_11.pdf
     35       1.15  augustss  */
     36       1.46     lukem 
     37       1.46     lukem #include <sys/cdefs.h>
     38  1.101.4.1  christos __KERNEL_RCSID(0, "$NetBSD: uhid.c,v 1.101.4.1 2019/06/10 22:07:34 christos Exp $");
     39       1.73     pavel 
     40       1.89  christos #ifdef _KERNEL_OPT
     41       1.73     pavel #include "opt_compat_netbsd.h"
     42       1.96  jakllsch #include "opt_usb.h"
     43       1.89  christos #endif
     44        1.1  augustss 
     45        1.1  augustss #include <sys/param.h>
     46        1.1  augustss #include <sys/systm.h>
     47        1.1  augustss #include <sys/kernel.h>
     48       1.95     skrll #include <sys/kmem.h>
     49       1.37  augustss #include <sys/signalvar.h>
     50       1.14  augustss #include <sys/device.h>
     51       1.12  augustss #include <sys/ioctl.h>
     52       1.18  augustss #include <sys/conf.h>
     53        1.1  augustss #include <sys/tty.h>
     54        1.1  augustss #include <sys/file.h>
     55        1.1  augustss #include <sys/select.h>
     56        1.1  augustss #include <sys/proc.h>
     57        1.1  augustss #include <sys/vnode.h>
     58        1.1  augustss #include <sys/poll.h>
     59       1.80        ad #include <sys/intr.h>
     60  1.101.4.1  christos #include <sys/compat_stub.h>
     61        1.1  augustss 
     62        1.1  augustss #include <dev/usb/usb.h>
     63        1.1  augustss #include <dev/usb/usbhid.h>
     64        1.1  augustss 
     65       1.42  augustss #include <dev/usb/usbdevs.h>
     66        1.1  augustss #include <dev/usb/usbdi.h>
     67        1.1  augustss #include <dev/usb/usbdi_util.h>
     68        1.1  augustss #include <dev/usb/usb_quirks.h>
     69      1.101    bouyer #include <dev/hid/hid.h>
     70        1.1  augustss 
     71       1.47  augustss #include <dev/usb/uhidev.h>
     72       1.42  augustss 
     73  1.101.4.1  christos #include "ioconf.h"
     74  1.101.4.1  christos 
     75       1.26  augustss #ifdef UHID_DEBUG
     76       1.84    dyoung #define DPRINTF(x)	if (uhiddebug) printf x
     77       1.84    dyoung #define DPRINTFN(n,x)	if (uhiddebug>(n)) printf x
     78        1.1  augustss int	uhiddebug = 0;
     79        1.1  augustss #else
     80        1.1  augustss #define DPRINTF(x)
     81        1.1  augustss #define DPRINTFN(n,x)
     82        1.1  augustss #endif
     83        1.1  augustss 
     84        1.1  augustss struct uhid_softc {
     85       1.47  augustss 	struct uhidev sc_hdev;
     86        1.1  augustss 
     87       1.88       mrg 	kmutex_t sc_access_lock; /* serialises syscall accesses */
     88       1.88       mrg 	kmutex_t sc_lock;	/* protects refcnt, others */
     89       1.88       mrg 	kcondvar_t sc_cv;
     90       1.88       mrg 	kcondvar_t sc_detach_cv;
     91       1.88       mrg 
     92        1.1  augustss 	int sc_isize;
     93        1.1  augustss 	int sc_osize;
     94        1.2  augustss 	int sc_fsize;
     95        1.1  augustss 
     96       1.33  augustss 	u_char *sc_obuf;
     97        1.1  augustss 
     98       1.93       mrg 	struct clist sc_q;	/* protected by sc_lock */
     99        1.1  augustss 	struct selinfo sc_rsel;
    100       1.84    dyoung 	proc_t *sc_async;	/* process that wants SIGIO */
    101       1.80        ad 	void *sc_sih;
    102        1.1  augustss 	u_char sc_state;	/* driver state */
    103       1.47  augustss #define	UHID_ASLP	0x01	/* waiting for device data */
    104       1.47  augustss #define UHID_IMMED	0x02	/* return read data immediately */
    105       1.18  augustss 
    106       1.18  augustss 	int sc_refcnt;
    107       1.18  augustss 	u_char sc_dying;
    108        1.1  augustss };
    109        1.1  augustss 
    110        1.1  augustss #define	UHIDUNIT(dev)	(minor(dev))
    111        1.1  augustss #define	UHID_CHUNK	128	/* chunk size for read */
    112        1.1  augustss #define	UHID_BSIZE	1020	/* buffer size */
    113        1.1  augustss 
    114       1.53   gehenna dev_type_open(uhidopen);
    115       1.53   gehenna dev_type_close(uhidclose);
    116       1.53   gehenna dev_type_read(uhidread);
    117       1.53   gehenna dev_type_write(uhidwrite);
    118       1.53   gehenna dev_type_ioctl(uhidioctl);
    119       1.53   gehenna dev_type_poll(uhidpoll);
    120       1.55  jdolecek dev_type_kqfilter(uhidkqfilter);
    121       1.53   gehenna 
    122       1.53   gehenna const struct cdevsw uhid_cdevsw = {
    123       1.90  dholland 	.d_open = uhidopen,
    124       1.90  dholland 	.d_close = uhidclose,
    125       1.90  dholland 	.d_read = uhidread,
    126       1.90  dholland 	.d_write = uhidwrite,
    127       1.90  dholland 	.d_ioctl = uhidioctl,
    128       1.90  dholland 	.d_stop = nostop,
    129       1.90  dholland 	.d_tty = notty,
    130       1.90  dholland 	.d_poll = uhidpoll,
    131       1.90  dholland 	.d_mmap = nommap,
    132       1.90  dholland 	.d_kqfilter = uhidkqfilter,
    133       1.92  dholland 	.d_discard = nodiscard,
    134       1.93       mrg 	.d_flag = D_OTHER
    135       1.53   gehenna };
    136       1.19  augustss 
    137       1.95     skrll Static void uhid_intr(struct uhidev *, void *, u_int);
    138       1.80        ad Static void uhid_softintr(void *);
    139       1.18  augustss 
    140       1.95     skrll Static int uhid_do_read(struct uhid_softc *, struct uio *, int);
    141       1.95     skrll Static int uhid_do_write(struct uhid_softc *, struct uio *, int);
    142       1.76  christos Static int uhid_do_ioctl(struct uhid_softc*, u_long, void *, int, struct lwp *);
    143        1.1  augustss 
    144       1.98   msaitoh int	uhid_match(device_t, cfdata_t, void *);
    145       1.98   msaitoh void	uhid_attach(device_t, device_t, void *);
    146       1.98   msaitoh int	uhid_detach(device_t, int);
    147       1.98   msaitoh int	uhid_activate(device_t, enum devact);
    148  1.101.4.1  christos 
    149       1.98   msaitoh CFATTACH_DECL_NEW(uhid, sizeof(struct uhid_softc), uhid_match, uhid_attach,
    150       1.98   msaitoh     uhid_detach, uhid_activate);
    151        1.1  augustss 
    152       1.47  augustss int
    153       1.82      cube uhid_match(device_t parent, cfdata_t match, void *aux)
    154        1.1  augustss {
    155       1.66      tron #ifdef UHID_DEBUG
    156       1.47  augustss 	struct uhidev_attach_arg *uha = aux;
    157       1.66      tron #endif
    158       1.47  augustss 
    159       1.47  augustss 	DPRINTF(("uhid_match: report=%d\n", uha->reportid));
    160       1.47  augustss 
    161       1.65  augustss 	if (match->cf_flags & 1)
    162       1.93       mrg 		return UMATCH_HIGHEST;
    163       1.67  augustss 	else
    164       1.93       mrg 		return UMATCH_IFACECLASS_GENERIC;
    165        1.1  augustss }
    166        1.1  augustss 
    167       1.47  augustss void
    168       1.82      cube uhid_attach(device_t parent, device_t self, void *aux)
    169        1.1  augustss {
    170       1.82      cube 	struct uhid_softc *sc = device_private(self);
    171       1.47  augustss 	struct uhidev_attach_arg *uha = aux;
    172       1.47  augustss 	int size, repid;
    173        1.1  augustss 	void *desc;
    174       1.52  augustss 
    175       1.82      cube 	sc->sc_hdev.sc_dev = self;
    176       1.79     rmind 	selinit(&sc->sc_rsel);
    177       1.47  augustss 	sc->sc_hdev.sc_intr = uhid_intr;
    178       1.47  augustss 	sc->sc_hdev.sc_parent = uha->parent;
    179       1.47  augustss 	sc->sc_hdev.sc_report_id = uha->reportid;
    180       1.98   msaitoh 	sc->sc_sih = softint_establish(SOFTINT_CLOCK, uhid_softintr, sc);
    181       1.47  augustss 
    182       1.47  augustss 	uhidev_get_report_desc(uha->parent, &desc, &size);
    183       1.47  augustss 	repid = uha->reportid;
    184       1.47  augustss 	sc->sc_isize = hid_report_size(desc, size, hid_input,   repid);
    185       1.47  augustss 	sc->sc_osize = hid_report_size(desc, size, hid_output,  repid);
    186       1.47  augustss 	sc->sc_fsize = hid_report_size(desc, size, hid_feature, repid);
    187        1.1  augustss 
    188       1.82      cube 	aprint_naive("\n");
    189       1.82      cube 	aprint_normal(": input=%d, output=%d, feature=%d\n",
    190       1.47  augustss 	       sc->sc_isize, sc->sc_osize, sc->sc_fsize);
    191       1.32  augustss 
    192       1.88       mrg 	mutex_init(&sc->sc_access_lock, MUTEX_DEFAULT, IPL_NONE);
    193       1.95     skrll 	mutex_init(&sc->sc_lock, MUTEX_DEFAULT, IPL_SOFTUSB);
    194       1.88       mrg 	cv_init(&sc->sc_cv, "uhidrea");
    195       1.88       mrg 	cv_init(&sc->sc_detach_cv, "uhiddet");
    196       1.88       mrg 
    197       1.78  drochner 	if (!pmf_device_register(self, NULL, NULL))
    198       1.78  drochner 		aprint_error_dev(self, "couldn't establish power handler\n");
    199       1.78  drochner 
    200       1.84    dyoung 	return;
    201        1.1  augustss }
    202        1.1  augustss 
    203       1.18  augustss int
    204       1.84    dyoung uhid_activate(device_t self, enum devact act)
    205       1.18  augustss {
    206       1.82      cube 	struct uhid_softc *sc = device_private(self);
    207       1.21  augustss 
    208       1.21  augustss 	switch (act) {
    209       1.21  augustss 	case DVACT_DEACTIVATE:
    210       1.21  augustss 		sc->sc_dying = 1;
    211       1.83    dyoung 		return 0;
    212       1.83    dyoung 	default:
    213       1.83    dyoung 		return EOPNOTSUPP;
    214       1.21  augustss 	}
    215       1.12  augustss }
    216       1.12  augustss 
    217       1.47  augustss int
    218       1.82      cube uhid_detach(device_t self, int flags)
    219        1.1  augustss {
    220       1.82      cube 	struct uhid_softc *sc = device_private(self);
    221       1.18  augustss 	int maj, mn;
    222       1.18  augustss 
    223       1.18  augustss 	DPRINTF(("uhid_detach: sc=%p flags=%d\n", sc, flags));
    224        1.3  augustss 
    225       1.18  augustss 	sc->sc_dying = 1;
    226       1.18  augustss 
    227       1.91  christos 	pmf_device_deregister(self);
    228       1.91  christos 
    229       1.88       mrg 	mutex_enter(&sc->sc_lock);
    230       1.47  augustss 	if (sc->sc_hdev.sc_state & UHIDEV_OPEN) {
    231       1.18  augustss 		if (--sc->sc_refcnt >= 0) {
    232       1.18  augustss 			/* Wake everyone */
    233       1.88       mrg 			cv_broadcast(&sc->sc_cv);
    234       1.18  augustss 			/* Wait for processes to go away. */
    235  1.101.4.1  christos 			if (cv_timedwait(&sc->sc_detach_cv, &sc->sc_lock, hz * 60))
    236  1.101.4.1  christos 				aprint_error_dev(self, ": didn't detach\n");
    237       1.18  augustss 		}
    238       1.18  augustss 	}
    239       1.88       mrg 	mutex_exit(&sc->sc_lock);
    240       1.18  augustss 
    241       1.18  augustss 	/* locate the major number */
    242       1.53   gehenna 	maj = cdevsw_lookup_major(&uhid_cdevsw);
    243       1.18  augustss 
    244       1.18  augustss 	/* Nuke the vnodes for any open instances (calls close). */
    245       1.69   thorpej 	mn = device_unit(self);
    246       1.18  augustss 	vdevgone(maj, mn, mn, VCHR);
    247       1.47  augustss 
    248       1.47  augustss #if 0
    249       1.52  augustss 	usbd_add_drv_event(USB_EVENT_DRIVER_DETACH,
    250       1.98   msaitoh 	    sc->sc_hdev.sc_parent->sc_udev, sc->sc_hdev.sc_dev);
    251       1.26  augustss #endif
    252       1.88       mrg 	cv_destroy(&sc->sc_cv);
    253       1.88       mrg 	cv_destroy(&sc->sc_detach_cv);
    254       1.88       mrg 	mutex_destroy(&sc->sc_lock);
    255       1.88       mrg 	mutex_destroy(&sc->sc_access_lock);
    256       1.79     rmind 	seldestroy(&sc->sc_rsel);
    257       1.80        ad 	softint_disestablish(sc->sc_sih);
    258       1.18  augustss 
    259       1.93       mrg 	return 0;
    260        1.1  augustss }
    261        1.1  augustss 
    262        1.1  augustss void
    263       1.47  augustss uhid_intr(struct uhidev *addr, void *data, u_int len)
    264        1.1  augustss {
    265       1.47  augustss 	struct uhid_softc *sc = (struct uhid_softc *)addr;
    266        1.1  augustss 
    267       1.33  augustss #ifdef UHID_DEBUG
    268       1.33  augustss 	if (uhiddebug > 5) {
    269       1.95     skrll 		uint32_t i;
    270       1.52  augustss 
    271       1.33  augustss 		DPRINTF(("uhid_intr: data ="));
    272       1.47  augustss 		for (i = 0; i < len; i++)
    273       1.51  augustss 			DPRINTF((" %02x", ((u_char *)data)[i]));
    274       1.33  augustss 		DPRINTF(("\n"));
    275       1.33  augustss 	}
    276       1.33  augustss #endif
    277        1.1  augustss 
    278       1.88       mrg 	mutex_enter(&sc->sc_lock);
    279       1.47  augustss 	(void)b_to_q(data, len, &sc->sc_q);
    280       1.52  augustss 
    281        1.1  augustss 	if (sc->sc_state & UHID_ASLP) {
    282        1.1  augustss 		sc->sc_state &= ~UHID_ASLP;
    283       1.44      yamt 		DPRINTFN(5, ("uhid_intr: waking %p\n", &sc->sc_q));
    284       1.88       mrg 		cv_broadcast(&sc->sc_cv);
    285        1.1  augustss 	}
    286       1.79     rmind 	selnotify(&sc->sc_rsel, 0, 0);
    287       1.37  augustss 	if (sc->sc_async != NULL) {
    288       1.37  augustss 		DPRINTFN(3, ("uhid_intr: sending SIGIO %p\n", sc->sc_async));
    289       1.80        ad 		softint_schedule(sc->sc_sih);
    290       1.37  augustss 	}
    291       1.88       mrg 	mutex_exit(&sc->sc_lock);
    292        1.1  augustss }
    293        1.1  augustss 
    294       1.80        ad void
    295       1.80        ad uhid_softintr(void *cookie)
    296       1.80        ad {
    297       1.80        ad 	struct uhid_softc *sc;
    298       1.80        ad 
    299       1.80        ad 	sc = cookie;
    300       1.80        ad 
    301       1.80        ad 	mutex_enter(proc_lock);
    302       1.80        ad 	if (sc->sc_async != NULL)
    303       1.80        ad 		 psignal(sc->sc_async, SIGIO);
    304       1.80        ad 	mutex_exit(proc_lock);
    305       1.80        ad }
    306       1.80        ad 
    307        1.1  augustss int
    308       1.88       mrg uhidopen(dev_t dev, int flag, int mode, struct lwp *l)
    309        1.1  augustss {
    310       1.25  augustss 	struct uhid_softc *sc;
    311       1.47  augustss 	int error;
    312       1.25  augustss 
    313       1.84    dyoung 	sc = device_lookup_private(&uhid_cd, UHIDUNIT(dev));
    314       1.84    dyoung 	if (sc == NULL)
    315       1.84    dyoung 		return ENXIO;
    316        1.1  augustss 
    317       1.18  augustss 	DPRINTF(("uhidopen: sc=%p\n", sc));
    318        1.1  augustss 
    319       1.18  augustss 	if (sc->sc_dying)
    320       1.93       mrg 		return ENXIO;
    321        1.1  augustss 
    322  1.101.4.1  christos 	mutex_enter(&sc->sc_lock);
    323       1.93       mrg 
    324       1.93       mrg 	/*
    325       1.93       mrg 	 * uhid interrupts aren't enabled yet, so setup sc_q now, as
    326       1.93       mrg 	 * long as they're not already allocated.
    327       1.93       mrg 	 */
    328       1.93       mrg 	if (sc->sc_hdev.sc_state & UHIDEV_OPEN) {
    329  1.101.4.1  christos 		mutex_exit(&sc->sc_lock);
    330       1.93       mrg 		return EBUSY;
    331       1.93       mrg 	}
    332  1.101.4.1  christos 	mutex_exit(&sc->sc_lock);
    333  1.101.4.1  christos 
    334       1.93       mrg 	if (clalloc(&sc->sc_q, UHID_BSIZE, 0) == -1) {
    335       1.93       mrg 		return ENOMEM;
    336       1.93       mrg 	}
    337       1.93       mrg 
    338  1.101.4.1  christos 	mutex_enter(&sc->sc_access_lock);
    339       1.47  augustss 	error = uhidev_open(&sc->sc_hdev);
    340       1.88       mrg 	if (error) {
    341       1.93       mrg 		clfree(&sc->sc_q);
    342       1.88       mrg 		mutex_exit(&sc->sc_access_lock);
    343       1.93       mrg 		return error;
    344       1.88       mrg 	}
    345       1.88       mrg 	mutex_exit(&sc->sc_access_lock);
    346        1.1  augustss 
    347       1.97   mlelstv 	if (sc->sc_osize > 0)
    348       1.97   mlelstv 		sc->sc_obuf = kmem_alloc(sc->sc_osize, KM_SLEEP);
    349       1.97   mlelstv 	else
    350       1.97   mlelstv 		sc->sc_obuf = NULL;
    351       1.17  augustss 	sc->sc_state &= ~UHID_IMMED;
    352       1.88       mrg 
    353       1.80        ad 	mutex_enter(proc_lock);
    354       1.47  augustss 	sc->sc_async = NULL;
    355       1.80        ad 	mutex_exit(proc_lock);
    356       1.37  augustss 
    357       1.93       mrg 	return 0;
    358        1.1  augustss }
    359        1.1  augustss 
    360        1.1  augustss int
    361       1.88       mrg uhidclose(dev_t dev, int flag, int mode, struct lwp *l)
    362        1.1  augustss {
    363       1.25  augustss 	struct uhid_softc *sc;
    364       1.25  augustss 
    365       1.84    dyoung 	sc = device_lookup_private(&uhid_cd, UHIDUNIT(dev));
    366        1.1  augustss 
    367        1.1  augustss 	DPRINTF(("uhidclose: sc=%p\n", sc));
    368        1.1  augustss 
    369       1.80        ad 	mutex_enter(proc_lock);
    370       1.47  augustss 	sc->sc_async = NULL;
    371       1.80        ad 	mutex_exit(proc_lock);
    372       1.88       mrg 
    373       1.88       mrg 	mutex_enter(&sc->sc_access_lock);
    374       1.93       mrg 
    375       1.93       mrg 	uhidev_stop(&sc->sc_hdev);
    376       1.93       mrg 
    377       1.93       mrg 	clfree(&sc->sc_q);
    378       1.97   mlelstv 	if (sc->sc_osize > 0)
    379       1.97   mlelstv 		kmem_free(sc->sc_obuf, sc->sc_osize);
    380       1.93       mrg 
    381       1.47  augustss 	uhidev_close(&sc->sc_hdev);
    382       1.93       mrg 
    383       1.88       mrg 	mutex_exit(&sc->sc_access_lock);
    384       1.37  augustss 
    385       1.93       mrg 	return 0;
    386        1.1  augustss }
    387        1.1  augustss 
    388        1.1  augustss int
    389       1.39  augustss uhid_do_read(struct uhid_softc *sc, struct uio *uio, int flag)
    390        1.1  augustss {
    391        1.1  augustss 	int error = 0;
    392       1.47  augustss 	int extra;
    393        1.1  augustss 	size_t length;
    394        1.1  augustss 	u_char buffer[UHID_CHUNK];
    395       1.27  augustss 	usbd_status err;
    396        1.1  augustss 
    397        1.1  augustss 	DPRINTFN(1, ("uhidread\n"));
    398        1.2  augustss 	if (sc->sc_state & UHID_IMMED) {
    399        1.2  augustss 		DPRINTFN(1, ("uhidread immed\n"));
    400       1.47  augustss 		extra = sc->sc_hdev.sc_report_id != 0;
    401       1.47  augustss 		err = uhidev_get_report(&sc->sc_hdev, UHID_INPUT_REPORT,
    402       1.47  augustss 					buffer, sc->sc_isize + extra);
    403       1.27  augustss 		if (err)
    404       1.93       mrg 			return EIO;
    405       1.93       mrg 		return uiomove(buffer+extra, sc->sc_isize, uio);
    406        1.2  augustss 	}
    407        1.2  augustss 
    408       1.88       mrg 	mutex_enter(&sc->sc_lock);
    409        1.1  augustss 	while (sc->sc_q.c_cc == 0) {
    410        1.1  augustss 		if (flag & IO_NDELAY) {
    411       1.88       mrg 			mutex_exit(&sc->sc_lock);
    412       1.93       mrg 			return EWOULDBLOCK;
    413        1.1  augustss 		}
    414        1.1  augustss 		sc->sc_state |= UHID_ASLP;
    415       1.44      yamt 		DPRINTFN(5, ("uhidread: sleep on %p\n", &sc->sc_q));
    416       1.88       mrg 		error = cv_wait_sig(&sc->sc_cv, &sc->sc_lock);
    417        1.1  augustss 		DPRINTFN(5, ("uhidread: woke, error=%d\n", error));
    418       1.18  augustss 		if (sc->sc_dying)
    419       1.18  augustss 			error = EIO;
    420        1.1  augustss 		if (error) {
    421        1.1  augustss 			sc->sc_state &= ~UHID_ASLP;
    422       1.18  augustss 			break;
    423        1.1  augustss 		}
    424        1.1  augustss 	}
    425        1.1  augustss 
    426        1.1  augustss 	/* Transfer as many chunks as possible. */
    427       1.18  augustss 	while (sc->sc_q.c_cc > 0 && uio->uio_resid > 0 && !error) {
    428  1.101.4.1  christos 		length = uimin(sc->sc_q.c_cc, uio->uio_resid);
    429        1.1  augustss 		if (length > sizeof(buffer))
    430        1.1  augustss 			length = sizeof(buffer);
    431        1.1  augustss 
    432        1.1  augustss 		/* Remove a small chunk from the input queue. */
    433        1.1  augustss 		(void) q_to_b(&sc->sc_q, buffer, length);
    434       1.29  augustss 		DPRINTFN(5, ("uhidread: got %lu chars\n", (u_long)length));
    435        1.1  augustss 
    436        1.1  augustss 		/* Copy the data to the user process. */
    437       1.93       mrg 		mutex_exit(&sc->sc_lock);
    438        1.1  augustss 		if ((error = uiomove(buffer, length, uio)) != 0)
    439       1.93       mrg 			return error;
    440       1.93       mrg 		mutex_enter(&sc->sc_lock);
    441        1.1  augustss 	}
    442        1.1  augustss 
    443       1.93       mrg 	mutex_exit(&sc->sc_lock);
    444       1.93       mrg 	return error;
    445        1.1  augustss }
    446        1.1  augustss 
    447        1.1  augustss int
    448       1.39  augustss uhidread(dev_t dev, struct uio *uio, int flag)
    449        1.1  augustss {
    450       1.25  augustss 	struct uhid_softc *sc;
    451       1.25  augustss 	int error;
    452       1.25  augustss 
    453       1.84    dyoung 	sc = device_lookup_private(&uhid_cd, UHIDUNIT(dev));
    454       1.18  augustss 
    455       1.88       mrg 	mutex_enter(&sc->sc_lock);
    456       1.18  augustss 	sc->sc_refcnt++;
    457       1.88       mrg 	mutex_exit(&sc->sc_lock);
    458       1.88       mrg 
    459       1.88       mrg 	mutex_enter(&sc->sc_access_lock);
    460       1.18  augustss 	error = uhid_do_read(sc, uio, flag);
    461       1.88       mrg 	mutex_exit(&sc->sc_access_lock);
    462       1.88       mrg 
    463       1.88       mrg 	mutex_enter(&sc->sc_lock);
    464       1.18  augustss 	if (--sc->sc_refcnt < 0)
    465  1.101.4.1  christos 		cv_broadcast(&sc->sc_detach_cv);
    466       1.88       mrg 	mutex_exit(&sc->sc_lock);
    467       1.93       mrg 	return error;
    468       1.18  augustss }
    469       1.18  augustss 
    470       1.18  augustss int
    471       1.72  christos uhid_do_write(struct uhid_softc *sc, struct uio *uio, int flag)
    472       1.18  augustss {
    473        1.1  augustss 	int error;
    474        1.1  augustss 	int size;
    475       1.27  augustss 	usbd_status err;
    476        1.1  augustss 
    477       1.18  augustss 	DPRINTFN(1, ("uhidwrite\n"));
    478       1.52  augustss 
    479       1.18  augustss 	if (sc->sc_dying)
    480       1.93       mrg 		return EIO;
    481        1.1  augustss 
    482        1.1  augustss 	size = sc->sc_osize;
    483        1.1  augustss 	error = 0;
    484       1.97   mlelstv 	if (uio->uio_resid != size || size == 0)
    485       1.93       mrg 		return EINVAL;
    486       1.18  augustss 	error = uiomove(sc->sc_obuf, size, uio);
    487       1.18  augustss 	if (!error) {
    488       1.47  augustss 		err = uhidev_set_report(&sc->sc_hdev, UHID_OUTPUT_REPORT,
    489       1.47  augustss 					sc->sc_obuf, size);
    490       1.27  augustss 		if (err)
    491        1.1  augustss 			error = EIO;
    492        1.1  augustss 	}
    493       1.18  augustss 
    494       1.93       mrg 	return error;
    495        1.1  augustss }
    496        1.1  augustss 
    497        1.1  augustss int
    498       1.39  augustss uhidwrite(dev_t dev, struct uio *uio, int flag)
    499       1.18  augustss {
    500       1.25  augustss 	struct uhid_softc *sc;
    501       1.25  augustss 	int error;
    502       1.25  augustss 
    503       1.84    dyoung 	sc = device_lookup_private(&uhid_cd, UHIDUNIT(dev));
    504       1.18  augustss 
    505       1.88       mrg 	mutex_enter(&sc->sc_lock);
    506       1.18  augustss 	sc->sc_refcnt++;
    507       1.88       mrg 	mutex_exit(&sc->sc_lock);
    508       1.88       mrg 
    509       1.88       mrg 	mutex_enter(&sc->sc_access_lock);
    510       1.18  augustss 	error = uhid_do_write(sc, uio, flag);
    511       1.88       mrg 	mutex_exit(&sc->sc_access_lock);
    512       1.88       mrg 
    513       1.88       mrg 	mutex_enter(&sc->sc_lock);
    514       1.18  augustss 	if (--sc->sc_refcnt < 0)
    515  1.101.4.1  christos 		cv_broadcast(&sc->sc_detach_cv);
    516       1.88       mrg 	mutex_exit(&sc->sc_lock);
    517       1.93       mrg 	return error;
    518       1.18  augustss }
    519       1.18  augustss 
    520       1.18  augustss int
    521       1.76  christos uhid_do_ioctl(struct uhid_softc *sc, u_long cmd, void *addr,
    522       1.72  christos     int flag, struct lwp *l)
    523        1.1  augustss {
    524        1.1  augustss 	struct usb_ctl_report_desc *rd;
    525        1.2  augustss 	struct usb_ctl_report *re;
    526       1.47  augustss 	u_char buffer[UHID_CHUNK];
    527       1.47  augustss 	int size, extra;
    528       1.27  augustss 	usbd_status err;
    529       1.47  augustss 	void *desc;
    530        1.1  augustss 
    531       1.18  augustss 	DPRINTFN(2, ("uhidioctl: cmd=%lx\n", cmd));
    532       1.18  augustss 
    533       1.18  augustss 	if (sc->sc_dying)
    534       1.93       mrg 		return EIO;
    535        1.1  augustss 
    536        1.1  augustss 	switch (cmd) {
    537        1.2  augustss 	case FIONBIO:
    538        1.2  augustss 		/* All handled in the upper FS layer. */
    539       1.37  augustss 		break;
    540       1.37  augustss 
    541       1.37  augustss 	case FIOASYNC:
    542       1.80        ad 		mutex_enter(proc_lock);
    543       1.37  augustss 		if (*(int *)addr) {
    544       1.37  augustss 			if (sc->sc_async != NULL)
    545       1.93       mrg 				return EBUSY;
    546       1.68  christos 			sc->sc_async = l->l_proc;
    547       1.68  christos 			DPRINTF(("uhid_do_ioctl: FIOASYNC %p\n", l->l_proc));
    548       1.37  augustss 		} else
    549       1.37  augustss 			sc->sc_async = NULL;
    550       1.80        ad 		mutex_exit(proc_lock);
    551       1.37  augustss 		break;
    552       1.37  augustss 
    553       1.37  augustss 	/* XXX this is not the most general solution. */
    554       1.37  augustss 	case TIOCSPGRP:
    555       1.80        ad 		mutex_enter(proc_lock);
    556       1.80        ad 		if (sc->sc_async == NULL) {
    557       1.80        ad 			mutex_exit(proc_lock);
    558       1.93       mrg 			return EINVAL;
    559       1.80        ad 		}
    560       1.80        ad 		if (*(int *)addr != sc->sc_async->p_pgid) {
    561       1.80        ad 			mutex_exit(proc_lock);
    562       1.93       mrg 			return EPERM;
    563       1.80        ad 		}
    564       1.80        ad 		mutex_exit(proc_lock);
    565       1.60  jdolecek 		break;
    566       1.60  jdolecek 
    567       1.60  jdolecek 	case FIOSETOWN:
    568       1.80        ad 		mutex_enter(proc_lock);
    569       1.80        ad 		if (sc->sc_async == NULL) {
    570       1.80        ad 			mutex_exit(proc_lock);
    571       1.93       mrg 			return EINVAL;
    572       1.80        ad 		}
    573       1.60  jdolecek 		if (-*(int *)addr != sc->sc_async->p_pgid
    574       1.80        ad 		    && *(int *)addr != sc->sc_async->p_pid) {
    575       1.80        ad 			mutex_exit(proc_lock);
    576       1.93       mrg 			return EPERM;
    577       1.80        ad 		}
    578       1.80        ad 		mutex_exit(proc_lock);
    579        1.2  augustss 		break;
    580        1.2  augustss 
    581        1.1  augustss 	case USB_GET_REPORT_DESC:
    582       1.47  augustss 		uhidev_get_report_desc(sc->sc_hdev.sc_parent, &desc, &size);
    583        1.1  augustss 		rd = (struct usb_ctl_report_desc *)addr;
    584  1.101.4.1  christos 		size = uimin(size, sizeof(rd->ucrd_data));
    585       1.50  christos 		rd->ucrd_size = size;
    586       1.50  christos 		memcpy(rd->ucrd_data, desc, size);
    587        1.1  augustss 		break;
    588        1.2  augustss 
    589        1.2  augustss 	case USB_SET_IMMED:
    590        1.9  augustss 		if (*(int *)addr) {
    591       1.47  augustss 			extra = sc->sc_hdev.sc_report_id != 0;
    592       1.47  augustss 			err = uhidev_get_report(&sc->sc_hdev, UHID_INPUT_REPORT,
    593       1.47  augustss 						buffer, sc->sc_isize + extra);
    594       1.27  augustss 			if (err)
    595       1.93       mrg 				return EOPNOTSUPP;
    596       1.12  augustss 
    597        1.2  augustss 			sc->sc_state |=  UHID_IMMED;
    598        1.9  augustss 		} else
    599        1.2  augustss 			sc->sc_state &= ~UHID_IMMED;
    600        1.2  augustss 		break;
    601        1.2  augustss 
    602        1.2  augustss 	case USB_GET_REPORT:
    603        1.2  augustss 		re = (struct usb_ctl_report *)addr;
    604       1.50  christos 		switch (re->ucr_report) {
    605        1.2  augustss 		case UHID_INPUT_REPORT:
    606        1.2  augustss 			size = sc->sc_isize;
    607        1.2  augustss 			break;
    608        1.2  augustss 		case UHID_OUTPUT_REPORT:
    609        1.2  augustss 			size = sc->sc_osize;
    610        1.2  augustss 			break;
    611        1.2  augustss 		case UHID_FEATURE_REPORT:
    612        1.2  augustss 			size = sc->sc_fsize;
    613        1.2  augustss 			break;
    614        1.2  augustss 		default:
    615       1.93       mrg 			return EINVAL;
    616        1.2  augustss 		}
    617       1.47  augustss 		extra = sc->sc_hdev.sc_report_id != 0;
    618       1.50  christos 		err = uhidev_get_report(&sc->sc_hdev, re->ucr_report,
    619       1.50  christos 		    re->ucr_data, size + extra);
    620       1.47  augustss 		if (extra)
    621       1.99      maya 			memmove(re->ucr_data, re->ucr_data+1, size);
    622       1.35  augustss 		if (err)
    623       1.93       mrg 			return EIO;
    624       1.35  augustss 		break;
    625       1.35  augustss 
    626       1.35  augustss 	case USB_SET_REPORT:
    627       1.35  augustss 		re = (struct usb_ctl_report *)addr;
    628       1.50  christos 		switch (re->ucr_report) {
    629       1.35  augustss 		case UHID_INPUT_REPORT:
    630       1.35  augustss 			size = sc->sc_isize;
    631       1.35  augustss 			break;
    632       1.35  augustss 		case UHID_OUTPUT_REPORT:
    633       1.35  augustss 			size = sc->sc_osize;
    634       1.35  augustss 			break;
    635       1.35  augustss 		case UHID_FEATURE_REPORT:
    636       1.35  augustss 			size = sc->sc_fsize;
    637       1.35  augustss 			break;
    638       1.35  augustss 		default:
    639       1.93       mrg 			return EINVAL;
    640       1.35  augustss 		}
    641       1.50  christos 		err = uhidev_set_report(&sc->sc_hdev, re->ucr_report,
    642       1.50  christos 		    re->ucr_data, size);
    643       1.27  augustss 		if (err)
    644       1.93       mrg 			return EIO;
    645        1.2  augustss 		break;
    646        1.2  augustss 
    647       1.47  augustss 	case USB_GET_REPORT_ID:
    648       1.47  augustss 		*(int *)addr = sc->sc_hdev.sc_report_id;
    649       1.47  augustss 		break;
    650       1.47  augustss 
    651       1.87       erh 	case USB_GET_DEVICE_DESC:
    652       1.87       erh 		*(usb_device_descriptor_t *)addr =
    653       1.87       erh 			*usbd_get_device_descriptor(sc->sc_hdev.sc_parent->sc_udev);
    654       1.87       erh 		break;
    655       1.87       erh 
    656       1.61  jdolecek 	case USB_GET_DEVICEINFO:
    657       1.61  jdolecek 		usbd_fill_deviceinfo(sc->sc_hdev.sc_parent->sc_udev,
    658       1.95     skrll 				     (struct usb_device_info *)addr, 0);
    659       1.61  jdolecek 		break;
    660       1.73     pavel 	case USB_GET_DEVICEINFO_OLD:
    661  1.101.4.1  christos 		MODULE_HOOK_CALL(usb_subr_fill_30_hook,
    662  1.101.4.1  christos                     (sc->sc_hdev.sc_parent->sc_udev,
    663  1.101.4.1  christos 		      (struct usb_device_info_old *)addr, 0,
    664  1.101.4.1  christos                       usbd_devinfo_vp, usbd_printBCD),
    665  1.101.4.1  christos                     enosys(), err);
    666  1.101.4.1  christos 		if (err == 0)
    667  1.101.4.1  christos 			return 0;
    668       1.73     pavel 		break;
    669       1.95     skrll 	case USB_GET_STRING_DESC:
    670       1.61  jdolecek 	    {
    671       1.95     skrll 		struct usb_string_desc *si = (struct usb_string_desc *)addr;
    672       1.95     skrll 		err = usbd_get_string_desc(sc->sc_hdev.sc_parent->sc_udev,
    673       1.61  jdolecek 			si->usd_string_index,
    674       1.95     skrll 			si->usd_language_id, &si->usd_desc, &size);
    675       1.95     skrll 		if (err)
    676       1.95     skrll 			return EINVAL;
    677       1.95     skrll 		break;
    678       1.61  jdolecek 	    }
    679       1.61  jdolecek 
    680        1.1  augustss 	default:
    681       1.93       mrg 		return EINVAL;
    682        1.1  augustss 	}
    683       1.93       mrg 	return 0;
    684        1.1  augustss }
    685        1.1  augustss 
    686        1.1  augustss int
    687       1.76  christos uhidioctl(dev_t dev, u_long cmd, void *addr, int flag, struct lwp *l)
    688       1.18  augustss {
    689       1.25  augustss 	struct uhid_softc *sc;
    690       1.25  augustss 	int error;
    691       1.25  augustss 
    692       1.84    dyoung 	sc = device_lookup_private(&uhid_cd, UHIDUNIT(dev));
    693       1.88       mrg 	if (sc == NULL)
    694       1.88       mrg 		return ENXIO;
    695       1.88       mrg 
    696       1.88       mrg 	if (sc->sc_dying)
    697       1.88       mrg 		return EIO;
    698       1.18  augustss 
    699       1.88       mrg 	mutex_enter(&sc->sc_lock);
    700       1.18  augustss 	sc->sc_refcnt++;
    701       1.88       mrg 	mutex_exit(&sc->sc_lock);
    702       1.88       mrg 
    703       1.88       mrg 	mutex_enter(&sc->sc_access_lock);
    704       1.68  christos 	error = uhid_do_ioctl(sc, cmd, addr, flag, l);
    705       1.88       mrg 	mutex_exit(&sc->sc_access_lock);
    706       1.88       mrg 
    707       1.88       mrg 	mutex_enter(&sc->sc_lock);
    708       1.18  augustss 	if (--sc->sc_refcnt < 0)
    709  1.101.4.1  christos 		cv_broadcast(&sc->sc_detach_cv);
    710       1.88       mrg 	mutex_exit(&sc->sc_lock);
    711       1.93       mrg 	return error;
    712       1.18  augustss }
    713       1.18  augustss 
    714       1.18  augustss int
    715       1.68  christos uhidpoll(dev_t dev, int events, struct lwp *l)
    716        1.1  augustss {
    717       1.25  augustss 	struct uhid_softc *sc;
    718        1.1  augustss 	int revents = 0;
    719       1.25  augustss 
    720       1.84    dyoung 	sc = device_lookup_private(&uhid_cd, UHIDUNIT(dev));
    721       1.88       mrg 	if (sc == NULL)
    722       1.88       mrg 		return ENXIO;
    723        1.1  augustss 
    724       1.18  augustss 	if (sc->sc_dying)
    725       1.88       mrg 		return EIO;
    726        1.1  augustss 
    727       1.88       mrg 	mutex_enter(&sc->sc_lock);
    728        1.1  augustss 	if (events & (POLLOUT | POLLWRNORM))
    729        1.1  augustss 		revents |= events & (POLLOUT | POLLWRNORM);
    730        1.4     veego 	if (events & (POLLIN | POLLRDNORM)) {
    731        1.1  augustss 		if (sc->sc_q.c_cc > 0)
    732        1.1  augustss 			revents |= events & (POLLIN | POLLRDNORM);
    733        1.1  augustss 		else
    734       1.68  christos 			selrecord(l, &sc->sc_rsel);
    735        1.4     veego 	}
    736       1.88       mrg 	mutex_exit(&sc->sc_lock);
    737        1.1  augustss 
    738       1.93       mrg 	return revents;
    739       1.55  jdolecek }
    740       1.55  jdolecek 
    741       1.55  jdolecek static void
    742       1.55  jdolecek filt_uhidrdetach(struct knote *kn)
    743       1.55  jdolecek {
    744       1.55  jdolecek 	struct uhid_softc *sc = kn->kn_hook;
    745       1.55  jdolecek 
    746       1.88       mrg 	mutex_enter(&sc->sc_lock);
    747       1.56  christos 	SLIST_REMOVE(&sc->sc_rsel.sel_klist, kn, knote, kn_selnext);
    748       1.88       mrg 	mutex_exit(&sc->sc_lock);
    749       1.55  jdolecek }
    750       1.55  jdolecek 
    751       1.55  jdolecek static int
    752       1.72  christos filt_uhidread(struct knote *kn, long hint)
    753       1.55  jdolecek {
    754       1.55  jdolecek 	struct uhid_softc *sc = kn->kn_hook;
    755       1.55  jdolecek 
    756       1.55  jdolecek 	kn->kn_data = sc->sc_q.c_cc;
    757       1.95     skrll 	return kn->kn_data > 0;
    758       1.55  jdolecek }
    759       1.55  jdolecek 
    760      1.100      maya static const struct filterops uhidread_filtops = {
    761      1.100      maya 	.f_isfd = 1,
    762      1.100      maya 	.f_attach = NULL,
    763      1.100      maya 	.f_detach = filt_uhidrdetach,
    764      1.100      maya 	.f_event = filt_uhidread,
    765      1.100      maya };
    766       1.55  jdolecek 
    767      1.100      maya static const struct filterops uhid_seltrue_filtops = {
    768      1.100      maya 	.f_isfd = 1,
    769      1.100      maya 	.f_attach = NULL,
    770      1.100      maya 	.f_detach = filt_uhidrdetach,
    771      1.100      maya 	.f_event = filt_seltrue,
    772      1.100      maya };
    773       1.55  jdolecek 
    774       1.55  jdolecek int
    775       1.55  jdolecek uhidkqfilter(dev_t dev, struct knote *kn)
    776       1.55  jdolecek {
    777       1.55  jdolecek 	struct uhid_softc *sc;
    778       1.55  jdolecek 	struct klist *klist;
    779       1.55  jdolecek 
    780       1.84    dyoung 	sc = device_lookup_private(&uhid_cd, UHIDUNIT(dev));
    781       1.55  jdolecek 
    782       1.55  jdolecek 	if (sc->sc_dying)
    783       1.93       mrg 		return ENXIO;
    784       1.55  jdolecek 
    785       1.55  jdolecek 	switch (kn->kn_filter) {
    786       1.55  jdolecek 	case EVFILT_READ:
    787       1.56  christos 		klist = &sc->sc_rsel.sel_klist;
    788       1.55  jdolecek 		kn->kn_fop = &uhidread_filtops;
    789       1.55  jdolecek 		break;
    790       1.55  jdolecek 
    791       1.55  jdolecek 	case EVFILT_WRITE:
    792       1.56  christos 		klist = &sc->sc_rsel.sel_klist;
    793       1.55  jdolecek 		kn->kn_fop = &uhid_seltrue_filtops;
    794       1.55  jdolecek 		break;
    795       1.55  jdolecek 
    796       1.55  jdolecek 	default:
    797       1.93       mrg 		return EINVAL;
    798       1.55  jdolecek 	}
    799       1.55  jdolecek 
    800       1.55  jdolecek 	kn->kn_hook = sc;
    801       1.55  jdolecek 
    802       1.88       mrg 	mutex_enter(&sc->sc_lock);
    803       1.55  jdolecek 	SLIST_INSERT_HEAD(klist, kn, kn_selnext);
    804       1.88       mrg 	mutex_exit(&sc->sc_lock);
    805       1.55  jdolecek 
    806       1.93       mrg 	return 0;
    807        1.1  augustss }
    808