Home | History | Annotate | Line # | Download | only in usb
ums.c revision 1.33.2.2
      1  1.33.2.2    bouyer /*	$NetBSD: ums.c,v 1.33.2.2 2001/01/05 17:36:33 bouyer Exp $	*/
      2       1.1  augustss 
      3       1.1  augustss /*
      4       1.1  augustss  * Copyright (c) 1998 The NetBSD Foundation, Inc.
      5       1.1  augustss  * All rights reserved.
      6       1.1  augustss  *
      7      1.11  augustss  * This code is derived from software contributed to The NetBSD Foundation
      8  1.33.2.1    bouyer  * by Lennart Augustsson (lennart (at) augustsson.net) at
      9      1.11  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.20  augustss  */
     39      1.20  augustss 
     40      1.20  augustss /*
     41  1.33.2.2    bouyer  * HID spec: http://www.usb.org/developers/data/devclass/hid1_1.pdf
     42       1.1  augustss  */
     43       1.1  augustss 
     44  1.33.2.1    bouyer /* XXX complete SPUR_UP change */
     45  1.33.2.1    bouyer 
     46       1.1  augustss #include <sys/param.h>
     47       1.1  augustss #include <sys/systm.h>
     48       1.1  augustss #include <sys/kernel.h>
     49       1.1  augustss #include <sys/malloc.h>
     50       1.1  augustss #include <sys/device.h>
     51       1.1  augustss #include <sys/ioctl.h>
     52       1.1  augustss #include <sys/tty.h>
     53       1.1  augustss #include <sys/file.h>
     54       1.1  augustss #include <sys/select.h>
     55       1.1  augustss #include <sys/proc.h>
     56       1.1  augustss #include <sys/vnode.h>
     57       1.1  augustss #include <sys/poll.h>
     58       1.1  augustss 
     59       1.1  augustss #include <dev/usb/usb.h>
     60       1.1  augustss #include <dev/usb/usbhid.h>
     61       1.1  augustss 
     62       1.1  augustss #include <dev/usb/usbdi.h>
     63       1.1  augustss #include <dev/usb/usbdi_util.h>
     64       1.1  augustss #include <dev/usb/usbdevs.h>
     65       1.1  augustss #include <dev/usb/usb_quirks.h>
     66       1.1  augustss #include <dev/usb/hid.h>
     67       1.1  augustss 
     68       1.3  augustss #include <dev/wscons/wsconsio.h>
     69       1.3  augustss #include <dev/wscons/wsmousevar.h>
     70       1.3  augustss 
     71       1.1  augustss #ifdef USB_DEBUG
     72      1.26  augustss #define DPRINTF(x)	if (umsdebug) logprintf x
     73      1.26  augustss #define DPRINTFN(n,x)	if (umsdebug>(n)) logprintf x
     74       1.1  augustss int	umsdebug = 0;
     75       1.1  augustss #else
     76       1.1  augustss #define DPRINTF(x)
     77       1.1  augustss #define DPRINTFN(n,x)
     78       1.1  augustss #endif
     79       1.1  augustss 
     80      1.27  augustss #define UMS_BUT(i) ((i) == 1 || (i) == 2 ? 3 - (i) : i)
     81      1.27  augustss 
     82      1.27  augustss #define UMSUNIT(s)	(minor(s))
     83      1.16  augustss 
     84      1.16  augustss #define PS2LBUTMASK	x01
     85      1.16  augustss #define PS2RBUTMASK	x02
     86      1.16  augustss #define PS2MBUTMASK	x04
     87       1.1  augustss #define PS2BUTMASK 0x0f
     88       1.1  augustss 
     89       1.1  augustss struct ums_softc {
     90      1.31  augustss 	USBBASEDEVICE sc_dev;		/* base device */
     91  1.33.2.1    bouyer 	usbd_device_handle sc_udev;
     92       1.1  augustss 	usbd_interface_handle sc_iface;	/* interface */
     93       1.1  augustss 	usbd_pipe_handle sc_intrpipe;	/* interrupt pipe */
     94       1.1  augustss 	int sc_ep_addr;
     95       1.1  augustss 
     96       1.1  augustss 	u_char *sc_ibuf;
     97       1.1  augustss 	u_int8_t sc_iid;
     98       1.1  augustss 	int sc_isize;
     99      1.16  augustss 	struct hid_location sc_loc_x, sc_loc_y, sc_loc_z;
    100      1.16  augustss 	struct hid_location *sc_loc_btn;
    101       1.1  augustss 
    102      1.16  augustss 	int sc_enabled;
    103       1.3  augustss 
    104      1.16  augustss 	int flags;		/* device configuration */
    105      1.16  augustss #define UMS_Z		0x01	/* z direction available */
    106  1.33.2.1    bouyer #define UMS_SPUR_BUT_UP	0x02	/* spurious button up events */
    107  1.33.2.1    bouyer #define UMS_REVZ	0x04	/* Z-axis is reversed */
    108  1.33.2.1    bouyer 
    109      1.16  augustss 	int nbuttons;
    110      1.27  augustss #define MAX_BUTTONS	31	/* chosen because sc_buttons is u_int32_t */
    111      1.16  augustss 
    112      1.27  augustss 	u_int32_t sc_buttons;	/* mouse button status */
    113       1.3  augustss 	struct device *sc_wsmousedev;
    114      1.28  augustss 
    115      1.28  augustss 	char			sc_dying;
    116       1.1  augustss };
    117       1.1  augustss 
    118       1.2  augustss #define MOUSE_FLAGS_MASK (HIO_CONST|HIO_RELATIVE)
    119       1.2  augustss #define MOUSE_FLAGS (HIO_RELATIVE)
    120       1.2  augustss 
    121  1.33.2.1    bouyer Static void ums_intr(usbd_xfer_handle, usbd_private_handle, usbd_status);
    122       1.1  augustss 
    123  1.33.2.1    bouyer Static int	ums_enable(void *);
    124  1.33.2.1    bouyer Static void	ums_disable(void *);
    125  1.33.2.1    bouyer Static int	ums_ioctl(void *, u_long, caddr_t, int, struct proc *);
    126       1.3  augustss 
    127       1.3  augustss const struct wsmouse_accessops ums_accessops = {
    128       1.3  augustss 	ums_enable,
    129       1.3  augustss 	ums_ioctl,
    130       1.3  augustss 	ums_disable,
    131       1.3  augustss };
    132       1.3  augustss 
    133      1.16  augustss USB_DECLARE_DRIVER(ums);
    134       1.1  augustss 
    135      1.16  augustss USB_MATCH(ums)
    136       1.1  augustss {
    137      1.16  augustss 	USB_MATCH_START(ums, uaa);
    138       1.1  augustss 	usb_interface_descriptor_t *id;
    139       1.1  augustss 	int size, ret;
    140       1.1  augustss 	void *desc;
    141  1.33.2.1    bouyer 	usbd_status err;
    142       1.1  augustss 
    143  1.33.2.1    bouyer 	if (uaa->iface == NULL)
    144       1.1  augustss 		return (UMATCH_NONE);
    145       1.1  augustss 	id = usbd_get_interface_descriptor(uaa->iface);
    146  1.33.2.1    bouyer 	if (id == NULL || id->bInterfaceClass != UICLASS_HID)
    147       1.1  augustss 		return (UMATCH_NONE);
    148       1.1  augustss 
    149  1.33.2.1    bouyer 	err = usbd_alloc_report_desc(uaa->iface, &desc, &size, M_TEMP);
    150  1.33.2.1    bouyer 	if (err)
    151       1.1  augustss 		return (UMATCH_NONE);
    152       1.1  augustss 
    153       1.1  augustss 	if (hid_is_collection(desc, size,
    154       1.1  augustss 			      HID_USAGE2(HUP_GENERIC_DESKTOP, HUG_MOUSE)))
    155       1.1  augustss 		ret = UMATCH_IFACECLASS;
    156       1.1  augustss 	else
    157       1.1  augustss 		ret = UMATCH_NONE;
    158       1.1  augustss 
    159       1.1  augustss 	free(desc, M_TEMP);
    160       1.1  augustss 	return (ret);
    161       1.1  augustss }
    162       1.1  augustss 
    163      1.16  augustss USB_ATTACH(ums)
    164       1.1  augustss {
    165      1.16  augustss 	USB_ATTACH_START(ums, sc, uaa);
    166       1.1  augustss 	usbd_interface_handle iface = uaa->iface;
    167       1.1  augustss 	usb_interface_descriptor_t *id;
    168       1.1  augustss 	usb_endpoint_descriptor_t *ed;
    169       1.3  augustss 	struct wsmousedev_attach_args a;
    170       1.1  augustss 	int size;
    171       1.1  augustss 	void *desc;
    172  1.33.2.1    bouyer 	usbd_status err;
    173       1.1  augustss 	char devinfo[1024];
    174  1.33.2.1    bouyer 	u_int32_t flags, quirks;
    175  1.33.2.1    bouyer 	int i, wheel;
    176      1.16  augustss 	struct hid_location loc_btn;
    177       1.1  augustss 
    178  1.33.2.1    bouyer 	sc->sc_udev = uaa->device;
    179       1.1  augustss 	sc->sc_iface = iface;
    180       1.1  augustss 	id = usbd_get_interface_descriptor(iface);
    181       1.1  augustss 	usbd_devinfo(uaa->device, 0, devinfo);
    182      1.16  augustss 	USB_ATTACH_SETUP;
    183      1.16  augustss 	printf("%s: %s, iclass %d/%d\n", USBDEVNAME(sc->sc_dev),
    184      1.12  augustss 	       devinfo, id->bInterfaceClass, id->bInterfaceSubClass);
    185       1.1  augustss 	ed = usbd_interface2endpoint_descriptor(iface, 0);
    186  1.33.2.1    bouyer 	if (ed == NULL) {
    187       1.1  augustss 		printf("%s: could not read endpoint descriptor\n",
    188      1.16  augustss 		       USBDEVNAME(sc->sc_dev));
    189      1.16  augustss 		USB_ATTACH_ERROR_RETURN;
    190       1.1  augustss 	}
    191       1.1  augustss 
    192      1.15  augustss 	DPRINTFN(10,("ums_attach: bLength=%d bDescriptorType=%d "
    193      1.15  augustss 		     "bEndpointAddress=%d-%s bmAttributes=%d wMaxPacketSize=%d"
    194      1.15  augustss 		     " bInterval=%d\n",
    195      1.15  augustss 		     ed->bLength, ed->bDescriptorType,
    196      1.15  augustss 		     ed->bEndpointAddress & UE_ADDR,
    197      1.30  augustss 		     UE_GET_DIR(ed->bEndpointAddress)==UE_DIR_IN? "in" : "out",
    198      1.15  augustss 		     ed->bmAttributes & UE_XFERTYPE,
    199      1.15  augustss 		     UGETW(ed->wMaxPacketSize), ed->bInterval));
    200       1.1  augustss 
    201      1.30  augustss 	if (UE_GET_DIR(ed->bEndpointAddress) != UE_DIR_IN ||
    202       1.1  augustss 	    (ed->bmAttributes & UE_XFERTYPE) != UE_INTERRUPT) {
    203       1.1  augustss 		printf("%s: unexpected endpoint\n",
    204      1.16  augustss 		       USBDEVNAME(sc->sc_dev));
    205      1.16  augustss 		USB_ATTACH_ERROR_RETURN;
    206       1.1  augustss 	}
    207       1.1  augustss 
    208  1.33.2.1    bouyer 	quirks = usbd_get_quirks(uaa->device)->uq_flags;
    209  1.33.2.1    bouyer 	if (quirks & UQ_MS_REVZ)
    210  1.33.2.1    bouyer 		sc->flags |= UMS_REVZ;
    211  1.33.2.1    bouyer 	if (quirks & UQ_SPUR_BUT_UP)
    212  1.33.2.1    bouyer 		sc->flags |= UMS_SPUR_BUT_UP;
    213      1.24  augustss 
    214  1.33.2.1    bouyer 	err = usbd_alloc_report_desc(uaa->iface, &desc, &size, M_TEMP);
    215  1.33.2.1    bouyer 	if (err)
    216      1.16  augustss 		USB_ATTACH_ERROR_RETURN;
    217      1.16  augustss 
    218       1.2  augustss 	if (!hid_locate(desc, size, HID_USAGE2(HUP_GENERIC_DESKTOP, HUG_X),
    219       1.2  augustss 		       hid_input, &sc->sc_loc_x, &flags)) {
    220      1.16  augustss 		printf("%s: mouse has no X report\n", USBDEVNAME(sc->sc_dev));
    221      1.16  augustss 		USB_ATTACH_ERROR_RETURN;
    222      1.16  augustss 	}
    223      1.16  augustss 	if ((flags & MOUSE_FLAGS_MASK) != MOUSE_FLAGS) {
    224      1.16  augustss 		printf("%s: X report 0x%04x not supported\n",
    225      1.16  augustss 		       USBDEVNAME(sc->sc_dev), flags);
    226      1.16  augustss 		USB_ATTACH_ERROR_RETURN;
    227       1.1  augustss 	}
    228      1.10  augustss 
    229       1.2  augustss 	if (!hid_locate(desc, size, HID_USAGE2(HUP_GENERIC_DESKTOP, HUG_Y),
    230       1.2  augustss 		       hid_input, &sc->sc_loc_y, &flags)) {
    231      1.16  augustss 		printf("%s: mouse has no Y report\n", USBDEVNAME(sc->sc_dev));
    232      1.16  augustss 		USB_ATTACH_ERROR_RETURN;
    233      1.16  augustss 	}
    234      1.16  augustss 	if ((flags & MOUSE_FLAGS_MASK) != MOUSE_FLAGS) {
    235      1.16  augustss 		printf("%s: Y report 0x%04x not supported\n",
    236      1.16  augustss 		       USBDEVNAME(sc->sc_dev), flags);
    237      1.16  augustss 		USB_ATTACH_ERROR_RETURN;
    238       1.1  augustss 	}
    239      1.10  augustss 
    240      1.22  augustss 	/* Try to guess the Z activator: first check Z, then WHEEL. */
    241  1.33.2.1    bouyer 	wheel = 0;
    242       1.6  augustss 	if (hid_locate(desc, size, HID_USAGE2(HUP_GENERIC_DESKTOP, HUG_Z),
    243       1.6  augustss 		       hid_input, &sc->sc_loc_z, &flags) ||
    244  1.33.2.1    bouyer 	    (wheel = hid_locate(desc, size, HID_USAGE2(HUP_GENERIC_DESKTOP,
    245  1.33.2.1    bouyer 						       HUG_WHEEL),
    246  1.33.2.1    bouyer 		       hid_input, &sc->sc_loc_z, &flags))) {
    247      1.16  augustss 		if ((flags & MOUSE_FLAGS_MASK) != MOUSE_FLAGS) {
    248      1.16  augustss 			sc->sc_loc_z.size = 0;	/* Bad Z coord, ignore it */
    249      1.16  augustss 		} else {
    250      1.16  augustss 			sc->flags |= UMS_Z;
    251  1.33.2.1    bouyer 			/* Wheels need the Z axis reversed. */
    252  1.33.2.1    bouyer 			if (wheel)
    253  1.33.2.1    bouyer 				sc->flags ^= UMS_REVZ;
    254      1.16  augustss 		}
    255       1.6  augustss 	}
    256       1.6  augustss 
    257      1.21  augustss 	/* figure out the number of buttons */
    258      1.21  augustss 	for (i = 1; i <= MAX_BUTTONS; i++)
    259      1.16  augustss 		if (!hid_locate(desc, size, HID_USAGE2(HUP_BUTTON, i),
    260      1.16  augustss 				hid_input, &loc_btn, 0))
    261      1.16  augustss 			break;
    262      1.16  augustss 	sc->nbuttons = i - 1;
    263  1.33.2.1    bouyer 	sc->sc_loc_btn = malloc(sizeof(struct hid_location) * sc->nbuttons,
    264      1.16  augustss 				M_USBDEV, M_NOWAIT);
    265      1.22  augustss 	if (!sc->sc_loc_btn) {
    266      1.22  augustss 		printf("%s: no memory\n", USBDEVNAME(sc->sc_dev));
    267      1.16  augustss 		USB_ATTACH_ERROR_RETURN;
    268      1.22  augustss 	}
    269      1.16  augustss 
    270  1.33.2.1    bouyer 	printf("%s: %d button%s%s\n", USBDEVNAME(sc->sc_dev),
    271  1.33.2.1    bouyer 	    sc->nbuttons, sc->nbuttons == 1 ? "" : "s",
    272  1.33.2.1    bouyer 	    sc->flags & UMS_Z ? " and Z dir." : "");
    273      1.16  augustss 
    274      1.16  augustss 	for (i = 1; i <= sc->nbuttons; i++)
    275      1.16  augustss 		hid_locate(desc, size, HID_USAGE2(HUP_BUTTON, i),
    276      1.16  augustss 				hid_input, &sc->sc_loc_btn[i-1], 0);
    277       1.1  augustss 
    278       1.1  augustss 	sc->sc_isize = hid_report_size(desc, size, hid_input, &sc->sc_iid);
    279      1.25  augustss 	sc->sc_ibuf = malloc(sc->sc_isize, M_USBDEV, M_NOWAIT);
    280  1.33.2.1    bouyer 	if (sc->sc_ibuf == NULL) {
    281      1.22  augustss 		printf("%s: no memory\n", USBDEVNAME(sc->sc_dev));
    282      1.25  augustss 		free(sc->sc_loc_btn, M_USBDEV);
    283      1.16  augustss 		USB_ATTACH_ERROR_RETURN;
    284      1.16  augustss 	}
    285       1.1  augustss 
    286       1.1  augustss 	sc->sc_ep_addr = ed->bEndpointAddress;
    287       1.1  augustss 	free(desc, M_TEMP);
    288       1.3  augustss 
    289      1.16  augustss #ifdef USB_DEBUG
    290      1.16  augustss 	DPRINTF(("ums_attach: sc=%p\n", sc));
    291      1.16  augustss 	DPRINTF(("ums_attach: X\t%d/%d\n",
    292      1.16  augustss 		 sc->sc_loc_x.pos, sc->sc_loc_x.size));
    293      1.16  augustss 	DPRINTF(("ums_attach: Y\t%d/%d\n",
    294      1.16  augustss 		 sc->sc_loc_x.pos, sc->sc_loc_x.size));
    295      1.16  augustss 	if (sc->flags & UMS_Z)
    296      1.16  augustss 		DPRINTF(("ums_attach: Z\t%d/%d\n",
    297      1.16  augustss 			 sc->sc_loc_z.pos, sc->sc_loc_z.size));
    298      1.16  augustss 	for (i = 1; i <= sc->nbuttons; i++) {
    299      1.16  augustss 		DPRINTF(("ums_attach: B%d\t%d/%d\n",
    300      1.16  augustss 			 i, sc->sc_loc_btn[i-1].pos,sc->sc_loc_btn[i-1].size));
    301      1.16  augustss 	}
    302      1.16  augustss 	DPRINTF(("ums_attach: size=%d, id=%d\n", sc->sc_isize, sc->sc_iid));
    303      1.16  augustss #endif
    304      1.16  augustss 
    305       1.3  augustss 	a.accessops = &ums_accessops;
    306       1.3  augustss 	a.accesscookie = sc;
    307       1.3  augustss 
    308       1.3  augustss 	sc->sc_wsmousedev = config_found(self, &a, wsmousedevprint);
    309      1.16  augustss 
    310  1.33.2.1    bouyer 	usbd_add_drv_event(USB_EVENT_DRIVER_ATTACH, sc->sc_udev,
    311  1.33.2.1    bouyer 			   USBDEV(sc->sc_dev));
    312  1.33.2.1    bouyer 
    313      1.16  augustss 	USB_ATTACH_SUCCESS_RETURN;
    314      1.16  augustss }
    315      1.16  augustss 
    316      1.25  augustss int
    317  1.33.2.1    bouyer ums_activate(device_ptr_t self, enum devact act)
    318      1.16  augustss {
    319      1.28  augustss 	struct ums_softc *sc = (struct ums_softc *)self;
    320      1.32  augustss 	int rv = 0;
    321      1.28  augustss 
    322      1.28  augustss 	switch (act) {
    323      1.28  augustss 	case DVACT_ACTIVATE:
    324      1.28  augustss 		return (EOPNOTSUPP);
    325      1.28  augustss 		break;
    326      1.28  augustss 
    327      1.28  augustss 	case DVACT_DEACTIVATE:
    328  1.33.2.1    bouyer 		if (sc->sc_wsmousedev != NULL)
    329      1.32  augustss 			rv = config_deactivate(sc->sc_wsmousedev);
    330      1.28  augustss 		sc->sc_dying = 1;
    331      1.28  augustss 		break;
    332      1.28  augustss 	}
    333      1.32  augustss 	return (rv);
    334       1.1  augustss }
    335       1.1  augustss 
    336      1.33  augustss USB_DETACH(ums)
    337       1.1  augustss {
    338      1.33  augustss 	USB_DETACH_START(ums, sc);
    339      1.25  augustss 	int rv = 0;
    340       1.8  augustss 
    341      1.25  augustss 	DPRINTF(("ums_detach: sc=%p flags=%d\n", sc, flags));
    342      1.33  augustss 
    343      1.25  augustss 	/* No need to do reference counting of ums, wsmouse has all the goo. */
    344  1.33.2.1    bouyer 	if (sc->sc_wsmousedev != NULL)
    345      1.25  augustss 		rv = config_detach(sc->sc_wsmousedev, flags);
    346      1.25  augustss 	if (rv == 0) {
    347      1.25  augustss 		free(sc->sc_loc_btn, M_USBDEV);
    348      1.25  augustss 		free(sc->sc_ibuf, M_USBDEV);
    349      1.25  augustss 	}
    350  1.33.2.1    bouyer 
    351  1.33.2.1    bouyer 	usbd_add_drv_event(USB_EVENT_DRIVER_DETACH, sc->sc_udev,
    352  1.33.2.1    bouyer 			   USBDEV(sc->sc_dev));
    353  1.33.2.1    bouyer 
    354      1.25  augustss 	return (rv);
    355       1.1  augustss }
    356       1.1  augustss 
    357       1.1  augustss void
    358  1.33.2.1    bouyer ums_intr(usbd_xfer_handle xfer, usbd_private_handle addr, usbd_status status)
    359       1.1  augustss {
    360       1.1  augustss 	struct ums_softc *sc = addr;
    361       1.1  augustss 	u_char *ibuf;
    362       1.6  augustss 	int dx, dy, dz;
    363      1.27  augustss 	u_int32_t buttons = 0;
    364      1.16  augustss 	int i;
    365      1.23  augustss 	int s;
    366      1.21  augustss 
    367       1.1  augustss 	DPRINTFN(5, ("ums_intr: sc=%p status=%d\n", sc, status));
    368       1.1  augustss 	DPRINTFN(5, ("ums_intr: data = %02x %02x %02x\n",
    369       1.1  augustss 		     sc->sc_ibuf[0], sc->sc_ibuf[1], sc->sc_ibuf[2]));
    370       1.1  augustss 
    371       1.1  augustss 	if (status == USBD_CANCELLED)
    372       1.1  augustss 		return;
    373       1.1  augustss 
    374  1.33.2.1    bouyer 	if (status) {
    375       1.1  augustss 		DPRINTF(("ums_intr: status=%d\n", status));
    376       1.7  augustss 		usbd_clear_endpoint_stall_async(sc->sc_intrpipe);
    377       1.1  augustss 		return;
    378       1.1  augustss 	}
    379       1.1  augustss 
    380       1.1  augustss 	ibuf = sc->sc_ibuf;
    381  1.33.2.1    bouyer 	if (sc->sc_iid != 0) {
    382       1.1  augustss 		if (*ibuf++ != sc->sc_iid)
    383       1.1  augustss 			return;
    384       1.1  augustss 	}
    385       1.1  augustss 	dx =  hid_get_data(ibuf, &sc->sc_loc_x);
    386       1.1  augustss 	dy = -hid_get_data(ibuf, &sc->sc_loc_y);
    387       1.6  augustss 	dz =  hid_get_data(ibuf, &sc->sc_loc_z);
    388  1.33.2.1    bouyer 	if (sc->flags & UMS_REVZ)
    389      1.24  augustss 		dz = -dz;
    390      1.16  augustss 	for (i = 0; i < sc->nbuttons; i++)
    391      1.16  augustss 		if (hid_get_data(ibuf, &sc->sc_loc_btn[i]))
    392      1.16  augustss 			buttons |= (1 << UMS_BUT(i));
    393       1.4  augustss 
    394  1.33.2.1    bouyer 	if (dx != 0 || dy != 0 || dz != 0 || buttons != sc->sc_buttons) {
    395      1.16  augustss 		DPRINTFN(10, ("ums_intr: x:%d y:%d z:%d buttons:0x%x\n",
    396      1.16  augustss 			dx, dy, dz, buttons));
    397       1.4  augustss 		sc->sc_buttons = buttons;
    398  1.33.2.1    bouyer 		if (sc->sc_wsmousedev != NULL) {
    399      1.23  augustss 			s = spltty();
    400  1.33.2.1    bouyer 			wsmouse_input(sc->sc_wsmousedev, buttons, dx, dy, dz,
    401  1.33.2.1    bouyer 				      WSMOUSE_INPUT_DELTA);
    402      1.23  augustss 			splx(s);
    403      1.23  augustss 		}
    404       1.1  augustss 	}
    405       1.1  augustss }
    406       1.3  augustss 
    407  1.33.2.1    bouyer Static int
    408  1.33.2.1    bouyer ums_enable(void *v)
    409       1.3  augustss {
    410       1.3  augustss 	struct ums_softc *sc = v;
    411      1.16  augustss 
    412  1.33.2.1    bouyer 	usbd_status err;
    413       1.3  augustss 
    414      1.25  augustss 	DPRINTFN(1,("ums_enable: sc=%p\n", sc));
    415      1.28  augustss 
    416      1.28  augustss 	if (sc->sc_dying)
    417      1.28  augustss 		return (EIO);
    418      1.28  augustss 
    419       1.3  augustss 	if (sc->sc_enabled)
    420      1.28  augustss 		return (EBUSY);
    421       1.3  augustss 
    422       1.3  augustss 	sc->sc_enabled = 1;
    423       1.4  augustss 	sc->sc_buttons = 0;
    424       1.3  augustss 
    425       1.3  augustss 	/* Set up interrupt pipe. */
    426  1.33.2.1    bouyer 	err = usbd_open_pipe_intr(sc->sc_iface, sc->sc_ep_addr,
    427  1.33.2.1    bouyer 		  USBD_SHORT_XFER_OK, &sc->sc_intrpipe, sc,
    428  1.33.2.1    bouyer 		  sc->sc_ibuf, sc->sc_isize, ums_intr, USBD_DEFAULT_INTERVAL);
    429  1.33.2.1    bouyer 	if (err) {
    430       1.3  augustss 		DPRINTF(("ums_enable: usbd_open_pipe_intr failed, error=%d\n",
    431  1.33.2.1    bouyer 			 err));
    432       1.3  augustss 		sc->sc_enabled = 0;
    433       1.3  augustss 		return (EIO);
    434       1.3  augustss 	}
    435       1.3  augustss 	return (0);
    436       1.3  augustss }
    437       1.3  augustss 
    438  1.33.2.1    bouyer Static void
    439  1.33.2.1    bouyer ums_disable(void *v)
    440       1.3  augustss {
    441       1.3  augustss 	struct ums_softc *sc = v;
    442      1.25  augustss 
    443      1.25  augustss 	DPRINTFN(1,("ums_disable: sc=%p\n", sc));
    444      1.25  augustss #ifdef DIAGNOSTIC
    445      1.25  augustss 	if (!sc->sc_enabled) {
    446      1.25  augustss 		printf("ums_disable: not enabled\n");
    447      1.25  augustss 		return;
    448      1.25  augustss 	}
    449      1.25  augustss #endif
    450       1.3  augustss 
    451       1.3  augustss 	/* Disable interrupts. */
    452       1.3  augustss 	usbd_abort_pipe(sc->sc_intrpipe);
    453       1.3  augustss 	usbd_close_pipe(sc->sc_intrpipe);
    454       1.3  augustss 
    455       1.3  augustss 	sc->sc_enabled = 0;
    456       1.3  augustss }
    457       1.3  augustss 
    458  1.33.2.1    bouyer Static int
    459  1.33.2.1    bouyer ums_ioctl(void *v, u_long cmd, caddr_t data, int flag, struct proc *p)
    460      1.16  augustss 
    461       1.3  augustss {
    462       1.3  augustss 	switch (cmd) {
    463       1.3  augustss 	case WSMOUSEIO_GTYPE:
    464      1.17  augustss 		*(u_int *)data = WSMOUSE_TYPE_USB;
    465       1.3  augustss 		return (0);
    466       1.3  augustss 	}
    467      1.16  augustss 
    468       1.3  augustss 	return (-1);
    469       1.3  augustss }
    470