Home | History | Annotate | Line # | Download | only in usb
uhidev.c revision 1.59.2.1
      1  1.59.2.1       tls /*	$NetBSD: uhidev.c,v 1.59.2.1 2014/04/07 03:37:33 tls Exp $	*/
      2       1.1  augustss 
      3       1.1  augustss /*
      4      1.56       mrg  * Copyright (c) 2001, 2012 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 (lennart (at) augustsson.net) at
      9      1.56       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.1  augustss /*
     34      1.14  augustss  * HID spec: http://www.usb.org/developers/devclass_docs/HID1_11.pdf
     35       1.1  augustss  */
     36      1.15     lukem 
     37      1.15     lukem #include <sys/cdefs.h>
     38  1.59.2.1       tls __KERNEL_RCSID(0, "$NetBSD: uhidev.c,v 1.59.2.1 2014/04/07 03:37:33 tls Exp $");
     39       1.1  augustss 
     40       1.1  augustss #include <sys/param.h>
     41       1.1  augustss #include <sys/systm.h>
     42       1.1  augustss #include <sys/kernel.h>
     43       1.1  augustss #include <sys/malloc.h>
     44       1.1  augustss #include <sys/signalvar.h>
     45       1.1  augustss #include <sys/device.h>
     46       1.1  augustss #include <sys/ioctl.h>
     47       1.1  augustss #include <sys/conf.h>
     48       1.1  augustss 
     49       1.1  augustss #include <dev/usb/usb.h>
     50       1.1  augustss #include <dev/usb/usbhid.h>
     51       1.1  augustss 
     52       1.1  augustss #include <dev/usb/usbdevs.h>
     53       1.1  augustss #include <dev/usb/usbdi.h>
     54       1.1  augustss #include <dev/usb/usbdi_util.h>
     55       1.1  augustss #include <dev/usb/hid.h>
     56       1.1  augustss #include <dev/usb/usb_quirks.h>
     57       1.1  augustss 
     58       1.1  augustss #include <dev/usb/uhidev.h>
     59       1.1  augustss 
     60       1.1  augustss /* Report descriptor for broken Wacom Graphire */
     61       1.1  augustss #include <dev/usb/ugraphire_rdesc.h>
     62      1.51  jmcneill /* Report descriptor for game controllers in "XInput" mode */
     63      1.51  jmcneill #include <dev/usb/xinput_rdesc.h>
     64       1.1  augustss 
     65      1.22  drochner #include "locators.h"
     66      1.22  drochner 
     67       1.1  augustss #ifdef UHIDEV_DEBUG
     68      1.48    dyoung #define DPRINTF(x)	if (uhidevdebug) printf x
     69      1.48    dyoung #define DPRINTFN(n,x)	if (uhidevdebug>(n)) printf x
     70       1.1  augustss int	uhidevdebug = 0;
     71       1.1  augustss #else
     72       1.1  augustss #define DPRINTF(x)
     73       1.1  augustss #define DPRINTFN(n,x)
     74       1.1  augustss #endif
     75       1.1  augustss 
     76       1.1  augustss Static void uhidev_intr(usbd_xfer_handle, usbd_private_handle, usbd_status);
     77       1.1  augustss 
     78      1.29  drochner Static int uhidev_maxrepid(void *, int);
     79      1.29  drochner Static int uhidevprint(void *, const char *);
     80       1.1  augustss 
     81      1.41      cube int uhidev_match(device_t, cfdata_t, void *);
     82      1.39    dyoung void uhidev_attach(device_t, device_t, void *);
     83      1.39    dyoung void uhidev_childdet(device_t, device_t);
     84      1.39    dyoung int uhidev_detach(device_t, int);
     85      1.39    dyoung int uhidev_activate(device_t, enum devact);
     86      1.39    dyoung extern struct cfdriver uhidev_cd;
     87      1.41      cube CFATTACH_DECL2_NEW(uhidev, sizeof(struct uhidev_softc), uhidev_match,
     88      1.39    dyoung     uhidev_attach, uhidev_detach, uhidev_activate, NULL, uhidev_childdet);
     89       1.1  augustss 
     90      1.58     skrll int
     91      1.48    dyoung uhidev_match(device_t parent, cfdata_t match, void *aux)
     92       1.1  augustss {
     93      1.48    dyoung 	struct usbif_attach_arg *uaa = aux;
     94       1.6  augustss 
     95      1.51  jmcneill 	/* Game controllers in "XInput" mode */
     96      1.51  jmcneill 	if (USBIF_IS_XINPUT(uaa))
     97      1.51  jmcneill 		return UMATCH_IFACECLASS_IFACESUBCLASS_IFACEPROTO;
     98      1.34  drochner 	if (uaa->class != UICLASS_HID)
     99       1.1  augustss 		return (UMATCH_NONE);
    100      1.36     veego 	if (usbd_get_quirks(uaa->device)->uq_flags & UQ_HID_IGNORE)
    101      1.36     veego 		return (UMATCH_NONE);
    102       1.1  augustss 	return (UMATCH_IFACECLASS_GENERIC);
    103       1.1  augustss }
    104       1.1  augustss 
    105      1.58     skrll void
    106      1.48    dyoung uhidev_attach(device_t parent, device_t self, void *aux)
    107       1.1  augustss {
    108      1.48    dyoung 	struct uhidev_softc *sc = device_private(self);
    109      1.48    dyoung 	struct usbif_attach_arg *uaa = aux;
    110       1.1  augustss 	usbd_interface_handle iface = uaa->iface;
    111       1.1  augustss 	usb_interface_descriptor_t *id;
    112       1.1  augustss 	usb_endpoint_descriptor_t *ed;
    113       1.1  augustss 	struct uhidev_attach_arg uha;
    114      1.42  drochner 	device_t dev;
    115      1.42  drochner 	struct uhidev *csc;
    116      1.44     rafal 	int maxinpktsize, size, nrepid, repid, repsz;
    117      1.32  christos 	int *repsizes;
    118      1.25     skrll 	int i;
    119      1.19  jdolecek 	void *desc;
    120      1.20  augustss 	const void *descptr;
    121       1.1  augustss 	usbd_status err;
    122      1.26  augustss 	char *devinfop;
    123      1.28  drochner 	int locs[UHIDBUSCF_NLOCS];
    124       1.6  augustss 
    125      1.41      cube 	sc->sc_dev = self;
    126       1.1  augustss 	sc->sc_udev = uaa->device;
    127       1.1  augustss 	sc->sc_iface = iface;
    128      1.43    plunky 
    129      1.43    plunky 	aprint_naive("\n");
    130      1.43    plunky 	aprint_normal("\n");
    131      1.43    plunky 
    132      1.56       mrg 	mutex_init(&sc->sc_lock, MUTEX_DEFAULT, IPL_USB);
    133      1.56       mrg 
    134       1.1  augustss 	id = usbd_get_interface_descriptor(iface);
    135      1.26  augustss 
    136      1.26  augustss 	devinfop = usbd_devinfo_alloc(uaa->device, 0);
    137      1.41      cube 	aprint_normal_dev(self, "%s, iclass %d/%d\n",
    138      1.26  augustss 	       devinfop, id->bInterfaceClass, id->bInterfaceSubClass);
    139      1.26  augustss 	usbd_devinfo_free(devinfop);
    140       1.1  augustss 
    141      1.38  jmcneill 	if (!pmf_device_register(self, NULL, NULL))
    142      1.38  jmcneill 		aprint_error_dev(self, "couldn't establish power handler\n");
    143      1.38  jmcneill 
    144       1.1  augustss 	(void)usbd_set_idle(iface, 0, 0);
    145       1.1  augustss #if 0
    146       1.1  augustss 
    147       1.1  augustss 	qflags = usbd_get_quirks(sc->sc_udev)->uq_flags;
    148       1.1  augustss 	if ((qflags & UQ_NO_SET_PROTO) == 0 &&
    149       1.1  augustss 	    id->bInterfaceSubClass != UISUBCLASS_BOOT)
    150       1.1  augustss 		(void)usbd_set_protocol(iface, 1);
    151       1.1  augustss #endif
    152       1.1  augustss 
    153      1.44     rafal 	maxinpktsize = 0;
    154      1.25     skrll 	sc->sc_iep_addr = sc->sc_oep_addr = -1;
    155      1.25     skrll 	for (i = 0; i < id->bNumEndpoints; i++) {
    156      1.25     skrll 		ed = usbd_interface2endpoint_descriptor(iface, i);
    157      1.25     skrll 		if (ed == NULL) {
    158      1.41      cube 			aprint_error_dev(self,
    159      1.41      cube 			    "could not read endpoint descriptor\n");
    160      1.25     skrll 			sc->sc_dying = 1;
    161      1.48    dyoung 			return;
    162      1.25     skrll 		}
    163      1.25     skrll 
    164      1.25     skrll 		DPRINTFN(10,("uhidev_attach: bLength=%d bDescriptorType=%d "
    165      1.25     skrll 		    "bEndpointAddress=%d-%s bmAttributes=%d wMaxPacketSize=%d"
    166      1.25     skrll 		    " bInterval=%d\n",
    167      1.25     skrll 		    ed->bLength, ed->bDescriptorType,
    168      1.25     skrll 		    ed->bEndpointAddress & UE_ADDR,
    169      1.25     skrll 		    UE_GET_DIR(ed->bEndpointAddress)==UE_DIR_IN? "in" : "out",
    170      1.25     skrll 		    ed->bmAttributes & UE_XFERTYPE,
    171      1.25     skrll 		    UGETW(ed->wMaxPacketSize), ed->bInterval));
    172      1.25     skrll 
    173      1.25     skrll 		if (UE_GET_DIR(ed->bEndpointAddress) == UE_DIR_IN &&
    174      1.25     skrll 		    (ed->bmAttributes & UE_XFERTYPE) == UE_INTERRUPT) {
    175      1.44     rafal 			maxinpktsize = UGETW(ed->wMaxPacketSize);
    176      1.25     skrll 			sc->sc_iep_addr = ed->bEndpointAddress;
    177      1.25     skrll 		} else if (UE_GET_DIR(ed->bEndpointAddress) == UE_DIR_OUT &&
    178      1.25     skrll 		    (ed->bmAttributes & UE_XFERTYPE) == UE_INTERRUPT) {
    179      1.25     skrll 			sc->sc_oep_addr = ed->bEndpointAddress;
    180      1.25     skrll 		} else {
    181      1.41      cube 			aprint_verbose_dev(self, "endpoint %d: ignored\n", i);
    182      1.25     skrll 		}
    183       1.1  augustss 	}
    184       1.1  augustss 
    185      1.25     skrll 	/*
    186      1.25     skrll 	 * Check that we found an input interrupt endpoint. The output interrupt
    187      1.25     skrll 	 * endpoint is optional
    188      1.25     skrll 	 */
    189      1.25     skrll 	if (sc->sc_iep_addr == -1) {
    190      1.41      cube 		aprint_error_dev(self, "no input interrupt endpoint\n");
    191       1.1  augustss 		sc->sc_dying = 1;
    192      1.48    dyoung 		return;
    193       1.1  augustss 	}
    194       1.1  augustss 
    195       1.1  augustss 	/* XXX need to extend this */
    196      1.20  augustss 	descptr = NULL;
    197      1.20  augustss 	if (uaa->vendor == USB_VENDOR_WACOM) {
    198      1.20  augustss 		static uByte reportbuf[] = {2, 2, 2};
    199      1.17  augustss 
    200       1.1  augustss 		/* The report descriptor for the Wacom Graphire is broken. */
    201      1.17  augustss 		switch (uaa->product) {
    202      1.17  augustss 		case USB_PRODUCT_WACOM_GRAPHIRE:
    203      1.49   tsutsui 		case USB_PRODUCT_WACOM_GRAPHIRE2:
    204      1.33      ghen 		case USB_PRODUCT_WACOM_GRAPHIRE3_4X5:
    205      1.33      ghen 		case USB_PRODUCT_WACOM_GRAPHIRE3_6X8:
    206      1.33      ghen 		case USB_PRODUCT_WACOM_GRAPHIRE4_4X5: /* The 6x8 too? */
    207      1.17  augustss 			/*
    208      1.17  augustss 			 * The Graphire3 needs 0x0202 to be written to
    209      1.17  augustss 			 * feature report ID 2 before it'll start
    210      1.17  augustss 			 * returning digitizer data.
    211      1.17  augustss 			 */
    212      1.17  augustss 			usbd_set_report(uaa->iface, UHID_FEATURE_REPORT, 2,
    213      1.20  augustss 			    &reportbuf, sizeof reportbuf);
    214      1.17  augustss 
    215      1.17  augustss 			size = sizeof uhid_graphire3_4x5_report_descr;
    216      1.17  augustss 			descptr = uhid_graphire3_4x5_report_descr;
    217      1.17  augustss 			break;
    218      1.20  augustss 		default:
    219      1.20  augustss 			/* Keep descriptor */
    220      1.20  augustss 			break;
    221      1.17  augustss 		}
    222      1.17  augustss 	}
    223      1.51  jmcneill 	if (USBIF_IS_XINPUT(uaa)) {
    224      1.51  jmcneill 		size = sizeof uhid_xinput_report_descr;
    225      1.51  jmcneill 		descptr = uhid_xinput_report_descr;
    226      1.51  jmcneill 	}
    227      1.17  augustss 
    228      1.17  augustss 	if (descptr) {
    229       1.1  augustss 		desc = malloc(size, M_USBDEV, M_NOWAIT);
    230       1.1  augustss 		if (desc == NULL)
    231       1.1  augustss 			err = USBD_NOMEM;
    232       1.1  augustss 		else {
    233       1.1  augustss 			err = USBD_NORMAL_COMPLETION;
    234      1.17  augustss 			memcpy(desc, descptr, size);
    235       1.1  augustss 		}
    236       1.1  augustss 	} else {
    237       1.1  augustss 		desc = NULL;
    238      1.17  augustss 		err = usbd_read_report_desc(uaa->iface, &desc, &size,
    239      1.17  augustss 		    M_USBDEV);
    240       1.1  augustss 	}
    241       1.1  augustss 	if (err) {
    242      1.41      cube 		aprint_error_dev(self, "no report descriptor\n");
    243       1.1  augustss 		sc->sc_dying = 1;
    244      1.48    dyoung 		return;
    245       1.1  augustss 	}
    246       1.6  augustss 
    247      1.58     skrll 	if (uaa->vendor == USB_VENDOR_HOSIDEN &&
    248      1.27  augustss 	    uaa->product == USB_PRODUCT_HOSIDEN_PPP) {
    249      1.27  augustss 		static uByte reportbuf[] = { 1 };
    250      1.27  augustss 		/*
    251      1.58     skrll 		 *  This device was sold by Konami with its ParaParaParadise
    252      1.27  augustss 		 *  game for PlayStation2.  It needs to be "turned on"
    253      1.27  augustss 		 *  before it will send any reports.
    254      1.27  augustss 		 */
    255      1.27  augustss 
    256      1.27  augustss 		usbd_set_report(uaa->iface, UHID_FEATURE_REPORT, 0,
    257      1.27  augustss 		    &reportbuf, sizeof reportbuf);
    258      1.27  augustss 	}
    259      1.27  augustss 
    260      1.47  jakllsch 	if (uaa->vendor == USB_VENDOR_LOGITECH &&
    261      1.47  jakllsch 	    uaa->product == USB_PRODUCT_LOGITECH_CBT44 && size == 0xb1) {
    262      1.47  jakllsch 		uint8_t *data = desc;
    263      1.47  jakllsch 		/*
    264      1.47  jakllsch 		 * This device has a odd USAGE_MINIMUM value that would
    265      1.47  jakllsch 		 * cause the multimedia keys to have their usage number
    266      1.47  jakllsch 		 * shifted up one usage.  Adjust so the usages are sane.
    267      1.47  jakllsch 		 */
    268      1.47  jakllsch 
    269      1.47  jakllsch 		if (data[0x56] == 0x19 && data[0x57] == 0x01 &&
    270      1.47  jakllsch 		    data[0x58] == 0x2a && data[0x59] == 0x8c)
    271      1.47  jakllsch 			data[0x57] = 0x00;
    272      1.47  jakllsch 	}
    273      1.47  jakllsch 
    274      1.52   aymeric 	/*
    275      1.52   aymeric 	 * Enable the Six Axis and DualShock 3 controllers.
    276      1.52   aymeric 	 * See http://ps3.jim.sh/sixaxis/usb/
    277      1.52   aymeric 	 */
    278      1.52   aymeric 	if (uaa->vendor == USB_VENDOR_SONY &&
    279      1.52   aymeric 	    uaa->product == USB_PRODUCT_SONY_PS3CONTROLLER) {
    280      1.52   aymeric 		usb_device_request_t req;
    281      1.52   aymeric 		char data[17];
    282      1.52   aymeric 		int actlen;
    283      1.52   aymeric 
    284      1.52   aymeric 		req.bmRequestType = UT_READ_CLASS_INTERFACE;
    285      1.52   aymeric 		req.bRequest = 1;
    286      1.52   aymeric 		USETW(req.wValue, 0x3f2);
    287      1.52   aymeric 		USETW(req.wIndex, 0);
    288      1.52   aymeric 		USETW(req.wLength, sizeof data);
    289      1.52   aymeric 
    290      1.52   aymeric 		usbd_do_request_flags(sc->sc_udev, &req, data,
    291      1.52   aymeric 			USBD_SHORT_XFER_OK, &actlen, USBD_DEFAULT_TIMEOUT);
    292      1.52   aymeric 	}
    293      1.52   aymeric 
    294       1.1  augustss 	sc->sc_repdesc = desc;
    295       1.1  augustss 	sc->sc_repdesc_size = size;
    296       1.1  augustss 
    297       1.1  augustss 	uha.uaa = uaa;
    298       1.1  augustss 	nrepid = uhidev_maxrepid(desc, size);
    299       1.1  augustss 	if (nrepid < 0)
    300      1.48    dyoung 		return;
    301       1.1  augustss 	if (nrepid > 0)
    302      1.41      cube 		aprint_normal_dev(self, "%d report ids\n", nrepid);
    303       1.1  augustss 	nrepid++;
    304      1.32  christos 	repsizes = malloc(nrepid * sizeof(*repsizes), M_TEMP, M_NOWAIT);
    305      1.32  christos 	if (repsizes == NULL)
    306      1.32  christos 		goto nomem;
    307      1.39    dyoung 	sc->sc_subdevs = malloc(nrepid * sizeof(device_t),
    308       1.5  augustss 				M_USBDEV, M_NOWAIT | M_ZERO);
    309       1.1  augustss 	if (sc->sc_subdevs == NULL) {
    310      1.32  christos 		free(repsizes, M_TEMP);
    311      1.32  christos nomem:
    312      1.41      cube 		aprint_error_dev(self, "no memory\n");
    313      1.48    dyoung 		return;
    314       1.1  augustss 	}
    315      1.44     rafal 
    316      1.44     rafal 	/* Just request max packet size for the interrupt pipe */
    317      1.44     rafal 	sc->sc_isize = maxinpktsize;
    318       1.1  augustss 	sc->sc_nrepid = nrepid;
    319       1.1  augustss 
    320       1.1  augustss 	usbd_add_drv_event(USB_EVENT_DRIVER_ATTACH, sc->sc_udev,
    321      1.48    dyoung 			   sc->sc_dev);
    322       1.1  augustss 
    323       1.1  augustss 	for (repid = 0; repid < nrepid; repid++) {
    324       1.1  augustss 		repsz = hid_report_size(desc, size, hid_input, repid);
    325       1.1  augustss 		DPRINTF(("uhidev_match: repid=%d, repsz=%d\n", repid, repsz));
    326       1.2  augustss 		repsizes[repid] = repsz;
    327       1.1  augustss 	}
    328      1.44     rafal 
    329       1.1  augustss 	DPRINTF(("uhidev_attach: isize=%d\n", sc->sc_isize));
    330       1.1  augustss 
    331       1.1  augustss 	uha.parent = sc;
    332       1.1  augustss 	for (repid = 0; repid < nrepid; repid++) {
    333       1.1  augustss 		DPRINTF(("uhidev_match: try repid=%d\n", repid));
    334       1.1  augustss 		if (hid_report_size(desc, size, hid_input, repid) == 0 &&
    335       1.1  augustss 		    hid_report_size(desc, size, hid_output, repid) == 0 &&
    336       1.1  augustss 		    hid_report_size(desc, size, hid_feature, repid) == 0) {
    337       1.5  augustss 			;	/* already NULL in sc->sc_subdevs[repid] */
    338       1.1  augustss 		} else {
    339       1.1  augustss 			uha.reportid = repid;
    340      1.28  drochner 			locs[UHIDBUSCF_REPORTID] = repid;
    341      1.22  drochner 
    342      1.42  drochner 			dev = config_found_sm_loc(self,
    343      1.28  drochner 				"uhidbus", locs, &uha,
    344      1.42  drochner 				uhidevprint, config_stdsubmatch);
    345       1.1  augustss 			sc->sc_subdevs[repid] = dev;
    346       1.4  augustss 			if (dev != NULL) {
    347      1.42  drochner 				csc = device_private(dev);
    348      1.42  drochner 				csc->sc_in_rep_size = repsizes[repid];
    349       1.1  augustss #ifdef DIAGNOSTIC
    350       1.1  augustss 				DPRINTF(("uhidev_match: repid=%d dev=%p\n",
    351       1.1  augustss 					 repid, dev));
    352      1.42  drochner 				if (csc->sc_intr == NULL) {
    353      1.32  christos 					free(repsizes, M_TEMP);
    354      1.41      cube 					aprint_error_dev(self,
    355      1.41      cube 					    "sc_intr == NULL\n");
    356      1.48    dyoung 					return;
    357       1.1  augustss 				}
    358       1.4  augustss #endif
    359      1.42  drochner 				rnd_attach_source(&csc->rnd_source,
    360      1.48    dyoung 						  device_xname(dev),
    361  1.59.2.1       tls 						  RND_TYPE_TTY,
    362  1.59.2.1       tls 						  RND_FLAG_DEFAULT);
    363       1.1  augustss 			}
    364       1.1  augustss 		}
    365       1.1  augustss 	}
    366      1.32  christos 	free(repsizes, M_TEMP);
    367       1.1  augustss 
    368      1.48    dyoung 	return;
    369       1.1  augustss }
    370       1.1  augustss 
    371       1.1  augustss int
    372       1.1  augustss uhidev_maxrepid(void *buf, int len)
    373       1.1  augustss {
    374       1.1  augustss 	struct hid_data *d;
    375       1.1  augustss 	struct hid_item h;
    376       1.1  augustss 	int maxid;
    377       1.1  augustss 
    378       1.1  augustss 	maxid = -1;
    379       1.1  augustss 	h.report_ID = 0;
    380       1.1  augustss 	for (d = hid_start_parse(buf, len, hid_none); hid_get_item(d, &h); )
    381       1.1  augustss 		if (h.report_ID > maxid)
    382       1.1  augustss 			maxid = h.report_ID;
    383       1.1  augustss 	hid_end_parse(d);
    384       1.1  augustss 	return (maxid);
    385       1.1  augustss }
    386       1.1  augustss 
    387       1.1  augustss int
    388       1.1  augustss uhidevprint(void *aux, const char *pnp)
    389       1.1  augustss {
    390       1.1  augustss 	struct uhidev_attach_arg *uha = aux;
    391       1.1  augustss 
    392       1.1  augustss 	if (pnp)
    393      1.12   thorpej 		aprint_normal("uhid at %s", pnp);
    394       1.1  augustss 	if (uha->reportid != 0)
    395      1.12   thorpej 		aprint_normal(" reportid %d", uha->reportid);
    396       1.1  augustss 	return (UNCONF);
    397       1.1  augustss }
    398       1.1  augustss 
    399       1.1  augustss int
    400      1.39    dyoung uhidev_activate(device_t self, enum devact act)
    401       1.1  augustss {
    402      1.39    dyoung 	struct uhidev_softc *sc = device_private(self);
    403       1.1  augustss 
    404       1.1  augustss 	switch (act) {
    405       1.1  augustss 	case DVACT_DEACTIVATE:
    406       1.1  augustss 		sc->sc_dying = 1;
    407      1.45    dyoung 		return 0;
    408      1.16  christos 	default:
    409      1.45    dyoung 		return EOPNOTSUPP;
    410       1.1  augustss 	}
    411       1.1  augustss }
    412       1.1  augustss 
    413      1.39    dyoung void
    414      1.39    dyoung uhidev_childdet(device_t self, device_t child)
    415      1.39    dyoung {
    416      1.39    dyoung 	int i;
    417      1.39    dyoung 	struct uhidev_softc *sc = device_private(self);
    418      1.39    dyoung 
    419      1.39    dyoung 	for (i = 0; i < sc->sc_nrepid; i++) {
    420      1.42  drochner 		if (sc->sc_subdevs[i] == child)
    421      1.39    dyoung 			break;
    422      1.39    dyoung 	}
    423      1.39    dyoung 	KASSERT(i < sc->sc_nrepid);
    424      1.39    dyoung 	sc->sc_subdevs[i] = NULL;
    425      1.39    dyoung }
    426      1.39    dyoung 
    427      1.58     skrll int
    428      1.48    dyoung uhidev_detach(device_t self, int flags)
    429       1.1  augustss {
    430      1.48    dyoung 	struct uhidev_softc *sc = device_private(self);
    431       1.1  augustss 	int i, rv;
    432      1.42  drochner 	struct uhidev *csc;
    433       1.1  augustss 
    434       1.1  augustss 	DPRINTF(("uhidev_detach: sc=%p flags=%d\n", sc, flags));
    435       1.1  augustss 
    436       1.1  augustss 	sc->sc_dying = 1;
    437      1.25     skrll 	if (sc->sc_ipipe != NULL)
    438      1.25     skrll 		usbd_abort_pipe(sc->sc_ipipe);
    439       1.1  augustss 
    440       1.1  augustss 	if (sc->sc_repdesc != NULL)
    441       1.1  augustss 		free(sc->sc_repdesc, M_USBDEV);
    442       1.1  augustss 
    443       1.1  augustss 	rv = 0;
    444       1.1  augustss 	for (i = 0; i < sc->sc_nrepid; i++) {
    445       1.1  augustss 		if (sc->sc_subdevs[i] != NULL) {
    446      1.42  drochner 			csc = device_private(sc->sc_subdevs[i]);
    447      1.42  drochner 			rnd_detach_source(&csc->rnd_source);
    448      1.42  drochner 			rv |= config_detach(sc->sc_subdevs[i], flags);
    449       1.1  augustss 		}
    450       1.1  augustss 	}
    451       1.1  augustss 
    452       1.1  augustss 	usbd_add_drv_event(USB_EVENT_DRIVER_DETACH, sc->sc_udev,
    453      1.48    dyoung 			   sc->sc_dev);
    454       1.1  augustss 
    455      1.38  jmcneill 	pmf_device_deregister(self);
    456      1.56       mrg 	mutex_destroy(&sc->sc_lock);
    457      1.38  jmcneill 
    458       1.1  augustss 	return (rv);
    459       1.1  augustss }
    460       1.1  augustss 
    461       1.1  augustss void
    462       1.1  augustss uhidev_intr(usbd_xfer_handle xfer, usbd_private_handle addr, usbd_status status)
    463       1.1  augustss {
    464       1.1  augustss 	struct uhidev_softc *sc = addr;
    465      1.42  drochner 	device_t cdev;
    466       1.1  augustss 	struct uhidev *scd;
    467       1.1  augustss 	u_char *p;
    468       1.1  augustss 	u_int rep;
    469       1.1  augustss 	u_int32_t cc;
    470       1.1  augustss 
    471       1.1  augustss 	usbd_get_xfer_status(xfer, NULL, NULL, &cc, NULL);
    472       1.1  augustss 
    473       1.1  augustss #ifdef UHIDEV_DEBUG
    474       1.1  augustss 	if (uhidevdebug > 5) {
    475       1.1  augustss 		u_int32_t i;
    476       1.6  augustss 
    477       1.1  augustss 		DPRINTF(("uhidev_intr: status=%d cc=%d\n", status, cc));
    478       1.1  augustss 		DPRINTF(("uhidev_intr: data ="));
    479       1.1  augustss 		for (i = 0; i < cc; i++)
    480       1.1  augustss 			DPRINTF((" %02x", sc->sc_ibuf[i]));
    481       1.1  augustss 		DPRINTF(("\n"));
    482       1.1  augustss 	}
    483       1.1  augustss #endif
    484       1.1  augustss 
    485       1.1  augustss 	if (status == USBD_CANCELLED)
    486       1.1  augustss 		return;
    487       1.1  augustss 
    488       1.1  augustss 	if (status != USBD_NORMAL_COMPLETION) {
    489      1.48    dyoung 		DPRINTF(("%s: interrupt status=%d\n", device_xname(sc->sc_dev),
    490       1.3  augustss 			 status));
    491      1.25     skrll 		usbd_clear_endpoint_stall_async(sc->sc_ipipe);
    492       1.1  augustss 		return;
    493       1.1  augustss 	}
    494       1.1  augustss 
    495       1.1  augustss 	p = sc->sc_ibuf;
    496       1.1  augustss 	if (sc->sc_nrepid != 1)
    497       1.1  augustss 		rep = *p++, cc--;
    498       1.1  augustss 	else
    499       1.1  augustss 		rep = 0;
    500       1.1  augustss 	if (rep >= sc->sc_nrepid) {
    501       1.1  augustss 		printf("uhidev_intr: bad repid %d\n", rep);
    502       1.1  augustss 		return;
    503       1.1  augustss 	}
    504      1.42  drochner 	cdev = sc->sc_subdevs[rep];
    505      1.42  drochner 	if (!cdev)
    506      1.42  drochner 		return;
    507      1.42  drochner 	scd = device_private(cdev);
    508       1.1  augustss 	DPRINTFN(5,("uhidev_intr: rep=%d, scd=%p state=0x%x\n",
    509       1.1  augustss 		    rep, scd, scd ? scd->sc_state : 0));
    510      1.42  drochner 	if (!(scd->sc_state & UHIDEV_OPEN))
    511       1.1  augustss 		return;
    512      1.46  jakllsch #ifdef UHIDEV_DEBUG
    513      1.46  jakllsch 	if (scd->sc_in_rep_size != cc) {
    514      1.46  jakllsch 		DPRINTF(("%s: expected %d bytes, got %d\n",
    515      1.48    dyoung 		       device_xname(sc->sc_dev), scd->sc_in_rep_size, cc));
    516      1.46  jakllsch 	}
    517      1.46  jakllsch #endif
    518      1.46  jakllsch 	if (cc == 0) {
    519      1.46  jakllsch 		DPRINTF(("%s: 0-length input ignored\n",
    520      1.48    dyoung 			device_xname(sc->sc_dev)));
    521      1.23  augustss 		return;
    522      1.23  augustss 	}
    523      1.10      fair 	rnd_add_uint32(&scd->rnd_source, (uintptr_t)(sc->sc_ibuf));
    524       1.1  augustss 	scd->sc_intr(scd, p, cc);
    525       1.1  augustss }
    526       1.1  augustss 
    527       1.1  augustss void
    528       1.1  augustss uhidev_get_report_desc(struct uhidev_softc *sc, void **desc, int *size)
    529       1.1  augustss {
    530       1.1  augustss 	*desc = sc->sc_repdesc;
    531       1.1  augustss 	*size = sc->sc_repdesc_size;
    532       1.1  augustss }
    533       1.1  augustss 
    534       1.1  augustss int
    535       1.1  augustss uhidev_open(struct uhidev *scd)
    536       1.1  augustss {
    537       1.1  augustss 	struct uhidev_softc *sc = scd->sc_parent;
    538       1.1  augustss 	usbd_status err;
    539      1.25     skrll 	int error;
    540       1.1  augustss 
    541      1.56       mrg 	DPRINTF(("uhidev_open: open pipe, state=%d\n", scd->sc_state));
    542       1.1  augustss 
    543      1.56       mrg 	mutex_enter(&sc->sc_lock);
    544      1.56       mrg 	if (scd->sc_state & UHIDEV_OPEN) {
    545      1.56       mrg 		mutex_exit(&sc->sc_lock);
    546       1.1  augustss 		return (EBUSY);
    547      1.56       mrg 	}
    548       1.1  augustss 	scd->sc_state |= UHIDEV_OPEN;
    549      1.56       mrg 	mutex_exit(&sc->sc_lock);
    550       1.1  augustss 
    551       1.1  augustss 	if (sc->sc_isize == 0)
    552       1.1  augustss 		return (0);
    553       1.1  augustss 
    554       1.1  augustss 	sc->sc_ibuf = malloc(sc->sc_isize, M_USBDEV, M_WAITOK);
    555       1.1  augustss 
    556      1.25     skrll 	/* Set up input interrupt pipe. */
    557       1.1  augustss 	DPRINTF(("uhidev_open: isize=%d, ep=0x%02x\n", sc->sc_isize,
    558      1.25     skrll 		 sc->sc_iep_addr));
    559      1.58     skrll 
    560      1.25     skrll 	err = usbd_open_pipe_intr(sc->sc_iface, sc->sc_iep_addr,
    561      1.25     skrll 		  USBD_SHORT_XFER_OK, &sc->sc_ipipe, sc, sc->sc_ibuf,
    562       1.1  augustss 		  sc->sc_isize, uhidev_intr, USBD_DEFAULT_INTERVAL);
    563      1.25     skrll 	if (err != USBD_NORMAL_COMPLETION) {
    564       1.1  augustss 		DPRINTF(("uhidopen: usbd_open_pipe_intr failed, "
    565      1.25     skrll 		    "error=%d\n", err));
    566      1.25     skrll 		error = EIO;
    567      1.25     skrll 		goto out1;
    568      1.25     skrll 	}
    569      1.25     skrll 
    570      1.25     skrll 	/*
    571      1.25     skrll 	 * Set up output interrupt pipe if an output interrupt endpoint
    572      1.25     skrll 	 * exists.
    573      1.25     skrll 	 */
    574      1.25     skrll 	if (sc->sc_oep_addr != -1) {
    575      1.25     skrll 		DPRINTF(("uhidev_open: oep=0x%02x\n", sc->sc_oep_addr));
    576      1.25     skrll 
    577      1.25     skrll 		err = usbd_open_pipe(sc->sc_iface, sc->sc_oep_addr,
    578      1.25     skrll 		    0, &sc->sc_opipe);
    579      1.25     skrll 
    580      1.25     skrll 		if (err != USBD_NORMAL_COMPLETION) {
    581      1.25     skrll 			DPRINTF(("uhidev_open: usbd_open_pipe failed, "
    582      1.25     skrll 			    "error=%d\n", err));
    583      1.25     skrll 			error = EIO;
    584      1.25     skrll 			goto out2;
    585      1.25     skrll 		}
    586      1.25     skrll 		DPRINTF(("uhidev_open: sc->sc_opipe=%p\n", sc->sc_opipe));
    587      1.25     skrll 
    588      1.25     skrll 		sc->sc_oxfer = usbd_alloc_xfer(sc->sc_udev);
    589      1.25     skrll 		if (sc->sc_oxfer == NULL) {
    590      1.25     skrll 			DPRINTF(("uhidev_open: couldn't allocate an xfer\n"));
    591      1.25     skrll 			error = ENOMEM;
    592      1.25     skrll 			goto out3;
    593      1.25     skrll 		}
    594       1.1  augustss 	}
    595      1.58     skrll 
    596       1.1  augustss 	return (0);
    597      1.25     skrll out3:
    598      1.25     skrll 	/* Abort output pipe */
    599      1.25     skrll 	usbd_close_pipe(sc->sc_opipe);
    600      1.25     skrll out2:
    601      1.25     skrll 	/* Abort input pipe */
    602      1.25     skrll 	usbd_close_pipe(sc->sc_ipipe);
    603      1.25     skrll out1:
    604      1.25     skrll 	DPRINTF(("uhidev_open: failed in someway"));
    605      1.25     skrll 	free(sc->sc_ibuf, M_USBDEV);
    606      1.56       mrg 	mutex_enter(&sc->sc_lock);
    607      1.25     skrll 	scd->sc_state &= ~UHIDEV_OPEN;
    608      1.59  christos 	sc->sc_ibuf = NULL;
    609      1.25     skrll 	sc->sc_ipipe = NULL;
    610      1.25     skrll 	sc->sc_opipe = NULL;
    611      1.25     skrll 	sc->sc_oxfer = NULL;
    612      1.56       mrg 	mutex_exit(&sc->sc_lock);
    613      1.25     skrll 	return error;
    614       1.1  augustss }
    615       1.1  augustss 
    616       1.1  augustss void
    617       1.1  augustss uhidev_close(struct uhidev *scd)
    618       1.1  augustss {
    619       1.1  augustss 	struct uhidev_softc *sc = scd->sc_parent;
    620       1.1  augustss 
    621      1.56       mrg 	mutex_enter(&sc->sc_lock);
    622      1.56       mrg 	if (!(scd->sc_state & UHIDEV_OPEN)) {
    623      1.56       mrg 		mutex_exit(&sc->sc_lock);
    624       1.1  augustss 		return;
    625      1.56       mrg 	}
    626       1.1  augustss 	scd->sc_state &= ~UHIDEV_OPEN;
    627      1.56       mrg 	mutex_exit(&sc->sc_lock);
    628      1.56       mrg 
    629       1.1  augustss 	DPRINTF(("uhidev_close: close pipe\n"));
    630       1.1  augustss 
    631      1.59  christos 	if (sc->sc_oxfer != NULL) {
    632      1.25     skrll 		usbd_free_xfer(sc->sc_oxfer);
    633      1.59  christos 		sc->sc_oxfer = NULL;
    634      1.59  christos 	}
    635      1.58     skrll 
    636       1.1  augustss 	/* Disable interrupts. */
    637      1.25     skrll 	if (sc->sc_opipe != NULL) {
    638      1.25     skrll 		usbd_abort_pipe(sc->sc_opipe);
    639      1.25     skrll 		usbd_close_pipe(sc->sc_opipe);
    640      1.25     skrll 		sc->sc_opipe = NULL;
    641      1.25     skrll 	}
    642      1.25     skrll 
    643      1.25     skrll 	if (sc->sc_ipipe != NULL) {
    644      1.25     skrll 		usbd_abort_pipe(sc->sc_ipipe);
    645      1.25     skrll 		usbd_close_pipe(sc->sc_ipipe);
    646      1.25     skrll 		sc->sc_ipipe = NULL;
    647       1.1  augustss 	}
    648       1.1  augustss 
    649       1.1  augustss 	if (sc->sc_ibuf != NULL) {
    650       1.1  augustss 		free(sc->sc_ibuf, M_USBDEV);
    651       1.1  augustss 		sc->sc_ibuf = NULL;
    652       1.1  augustss 	}
    653       1.1  augustss }
    654       1.1  augustss 
    655       1.1  augustss usbd_status
    656       1.1  augustss uhidev_set_report(struct uhidev *scd, int type, void *data, int len)
    657       1.1  augustss {
    658      1.13   dsainty 	char *buf;
    659      1.13   dsainty 	usbd_status retstat;
    660      1.13   dsainty 
    661      1.13   dsainty 	if (scd->sc_report_id == 0)
    662      1.13   dsainty 		return usbd_set_report(scd->sc_parent->sc_iface, type,
    663      1.13   dsainty 				       scd->sc_report_id, data, len);
    664      1.13   dsainty 
    665      1.13   dsainty 	buf = malloc(len + 1, M_TEMP, M_WAITOK);
    666      1.13   dsainty 	buf[0] = scd->sc_report_id;
    667      1.13   dsainty 	memcpy(buf+1, data, len);
    668      1.13   dsainty 
    669      1.13   dsainty 	retstat = usbd_set_report(scd->sc_parent->sc_iface, type,
    670      1.18   dsainty 				  scd->sc_report_id, buf, len + 1);
    671      1.13   dsainty 
    672      1.13   dsainty 	free(buf, M_TEMP);
    673       1.1  augustss 
    674      1.13   dsainty 	return retstat;
    675       1.1  augustss }
    676       1.1  augustss 
    677       1.1  augustss usbd_status
    678       1.1  augustss uhidev_get_report(struct uhidev *scd, int type, void *data, int len)
    679       1.1  augustss {
    680       1.6  augustss 	return usbd_get_report(scd->sc_parent->sc_iface, type,
    681       1.1  augustss 			       scd->sc_report_id, data, len);
    682       1.1  augustss }
    683      1.25     skrll 
    684      1.25     skrll usbd_status
    685      1.25     skrll uhidev_write(struct uhidev_softc *sc, void *data, int len)
    686      1.25     skrll {
    687      1.25     skrll 
    688      1.25     skrll 	DPRINTF(("uhidev_write: data=%p, len=%d\n", data, len));
    689      1.25     skrll 
    690      1.25     skrll 	if (sc->sc_opipe == NULL)
    691      1.25     skrll 		return USBD_INVAL;
    692      1.25     skrll 
    693      1.25     skrll #ifdef UHIDEV_DEBUG
    694      1.25     skrll 	if (uhidevdebug > 50) {
    695      1.25     skrll 
    696      1.25     skrll 		u_int32_t i;
    697      1.25     skrll 		u_int8_t *d = data;
    698      1.25     skrll 
    699      1.25     skrll 		DPRINTF(("uhidev_write: data ="));
    700      1.25     skrll 		for (i = 0; i < len; i++)
    701      1.25     skrll 			DPRINTF((" %02x", d[i]));
    702      1.25     skrll 		DPRINTF(("\n"));
    703      1.25     skrll 	}
    704      1.25     skrll #endif
    705      1.25     skrll 	return usbd_intr_transfer(sc->sc_oxfer, sc->sc_opipe, 0,
    706      1.25     skrll 	    USBD_NO_TIMEOUT, data, &len, "uhidevwi");
    707      1.25     skrll }
    708