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