Home | History | Annotate | Line # | Download | only in usb
ums.c revision 1.19
      1  1.19  augustss /*	$NetBSD: ums.c,v 1.19 1999/01/08 11:58:25 augustss Exp $	*/
      2   1.1  augustss 
      3   1.1  augustss /*
      4   1.1  augustss  * Copyright (c) 1998 The NetBSD Foundation, Inc.
      5   1.1  augustss  * All rights reserved.
      6   1.1  augustss  *
      7  1.11  augustss  * This code is derived from software contributed to The NetBSD Foundation
      8  1.11  augustss  * by Lennart Augustsson (augustss (at) carlstedt.se) 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.1  augustss  */
     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.16  augustss #if defined(__NetBSD__)
     45   1.1  augustss #include <sys/device.h>
     46   1.1  augustss #include <sys/ioctl.h>
     47  1.16  augustss #elif defined(__FreeBSD__)
     48  1.16  augustss #include <sys/module.h>
     49  1.16  augustss #include <sys/bus.h>
     50  1.16  augustss #include <sys/ioccom.h>
     51  1.16  augustss #include <sys/conf.h>
     52  1.16  augustss #endif
     53   1.1  augustss #include <sys/tty.h>
     54   1.1  augustss #include <sys/file.h>
     55   1.1  augustss #include <sys/select.h>
     56   1.1  augustss #include <sys/proc.h>
     57   1.1  augustss #include <sys/vnode.h>
     58   1.1  augustss #include <sys/poll.h>
     59   1.1  augustss 
     60   1.1  augustss #include <dev/usb/usb.h>
     61   1.1  augustss #include <dev/usb/usbhid.h>
     62   1.1  augustss 
     63   1.1  augustss #include <dev/usb/usbdi.h>
     64   1.1  augustss #include <dev/usb/usbdi_util.h>
     65   1.1  augustss #include <dev/usb/usbdevs.h>
     66   1.1  augustss #include <dev/usb/usb_quirks.h>
     67   1.1  augustss #include <dev/usb/hid.h>
     68   1.1  augustss 
     69  1.16  augustss #if defined(__NetBSD__)
     70   1.3  augustss #include <dev/wscons/wsconsio.h>
     71   1.3  augustss #include <dev/wscons/wsmousevar.h>
     72  1.16  augustss #elif defined(__FreeBSD__)
     73  1.16  augustss #include <machine/mouse.h>
     74  1.16  augustss #endif
     75   1.3  augustss 
     76   1.1  augustss #ifdef USB_DEBUG
     77   1.1  augustss #define DPRINTF(x)	if (umsdebug) printf x
     78   1.1  augustss #define DPRINTFN(n,x)	if (umsdebug>(n)) printf x
     79   1.1  augustss int	umsdebug = 0;
     80   1.1  augustss #else
     81   1.1  augustss #define DPRINTF(x)
     82   1.1  augustss #define DPRINTFN(n,x)
     83   1.1  augustss #endif
     84   1.1  augustss 
     85  1.16  augustss #define UMSUNIT(s)	(minor(s)&0x1f)
     86  1.16  augustss 
     87  1.16  augustss #define PS2LBUTMASK	x01
     88  1.16  augustss #define PS2RBUTMASK	x02
     89  1.16  augustss #define PS2MBUTMASK	x04
     90   1.1  augustss #define PS2BUTMASK 0x0f
     91   1.1  augustss 
     92  1.16  augustss #define QUEUE_BUFSIZE	240	/* MUST be divisible by 3 _and_ 4 */
     93  1.16  augustss 
     94   1.1  augustss struct ums_softc {
     95  1.16  augustss 	bdevice sc_dev;			/* base device */
     96   1.1  augustss 	usbd_interface_handle sc_iface;	/* interface */
     97   1.1  augustss 	usbd_pipe_handle sc_intrpipe;	/* interrupt pipe */
     98   1.1  augustss 	int sc_ep_addr;
     99   1.1  augustss 
    100   1.1  augustss 	u_char *sc_ibuf;
    101   1.1  augustss 	u_int8_t sc_iid;
    102   1.1  augustss 	int sc_isize;
    103  1.16  augustss 	struct hid_location sc_loc_x, sc_loc_y, sc_loc_z;
    104  1.16  augustss 	struct hid_location *sc_loc_btn;
    105   1.1  augustss 
    106  1.16  augustss 	int sc_enabled;
    107   1.1  augustss 	int sc_disconnected;	/* device is gone */
    108   1.3  augustss 
    109  1.16  augustss 	int flags;		/* device configuration */
    110  1.16  augustss #define UMS_Z		0x01	/* z direction available */
    111  1.16  augustss 	int nbuttons;
    112  1.16  augustss 
    113  1.16  augustss #if defined(__NetBSD__)
    114  1.16  augustss 	u_char sc_buttons;	/* mouse button status */
    115   1.3  augustss 	struct device *sc_wsmousedev;
    116  1.16  augustss #elif defined(__FreeBSD__)
    117  1.16  augustss 	u_char		qbuf[QUEUE_BUFSIZE];
    118  1.16  augustss 	u_char		dummy[100];		/* just for safety and for now */
    119  1.16  augustss 	int		qcount, qhead, qtail;
    120  1.16  augustss 	mousehw_t	hw;
    121  1.16  augustss 	mousemode_t	mode;
    122  1.16  augustss 	mousestatus_t	status;
    123  1.16  augustss 
    124  1.16  augustss 	int		state;
    125  1.16  augustss #	  define	UMS_ASLEEP	0x01	/* readFromDevice is waiting */
    126  1.16  augustss #	  define	UMS_SELECT	0x02	/* select is waiting */
    127  1.16  augustss 	struct selinfo	rsel;		/* process waiting in select */
    128  1.16  augustss #endif
    129   1.1  augustss };
    130   1.1  augustss 
    131   1.2  augustss #define MOUSE_FLAGS_MASK (HIO_CONST|HIO_RELATIVE)
    132   1.2  augustss #define MOUSE_FLAGS (HIO_RELATIVE)
    133   1.2  augustss 
    134   1.1  augustss void ums_intr __P((usbd_request_handle, usbd_private_handle, usbd_status));
    135   1.1  augustss void ums_disco __P((void *));
    136   1.1  augustss 
    137  1.16  augustss static int	ums_enable __P((void *));
    138  1.16  augustss static void	ums_disable __P((void *));
    139  1.16  augustss 
    140  1.16  augustss #if defined(__NetBSD__)
    141  1.16  augustss static int	ums_ioctl __P((void *, u_long, caddr_t, int, struct proc *));
    142   1.3  augustss 
    143   1.3  augustss const struct wsmouse_accessops ums_accessops = {
    144   1.3  augustss 	ums_enable,
    145   1.3  augustss 	ums_ioctl,
    146   1.3  augustss 	ums_disable,
    147   1.3  augustss };
    148   1.3  augustss 
    149  1.16  augustss #elif defined(__FreeBSD__)
    150  1.16  augustss static d_open_t ums_open;
    151  1.16  augustss static d_close_t ums_close;
    152  1.16  augustss static d_read_t ums_read;
    153  1.16  augustss static d_ioctl_t ums_ioctl;
    154  1.16  augustss static d_poll_t ums_poll;
    155  1.16  augustss 
    156  1.19  augustss #define UMS_CDEV_MAJOR	111
    157  1.16  augustss 
    158  1.16  augustss static struct  cdevsw ums_cdevsw = {
    159  1.16  augustss 	ums_open,	ums_close,	ums_read,	nowrite,
    160  1.16  augustss 	ums_ioctl,	nostop,		nullreset,	nodevtotty,
    161  1.16  augustss 	ums_poll,	nommap,
    162  1.19  augustss 	NULL,		"ums",		NULL,		-1
    163  1.16  augustss };
    164  1.16  augustss #endif
    165   1.1  augustss 
    166  1.16  augustss USB_DECLARE_DRIVER(ums);
    167   1.1  augustss 
    168  1.16  augustss USB_MATCH(ums)
    169   1.1  augustss {
    170  1.16  augustss 	USB_MATCH_START(ums, uaa);
    171   1.1  augustss 	usb_interface_descriptor_t *id;
    172   1.1  augustss 	int size, ret;
    173   1.1  augustss 	void *desc;
    174   1.1  augustss 	usbd_status r;
    175   1.1  augustss 
    176   1.1  augustss 	if (!uaa->iface)
    177   1.1  augustss 		return (UMATCH_NONE);
    178   1.1  augustss 	id = usbd_get_interface_descriptor(uaa->iface);
    179  1.14  augustss 	if (!id || id->bInterfaceClass != UCLASS_HID)
    180   1.1  augustss 		return (UMATCH_NONE);
    181   1.1  augustss 
    182   1.1  augustss 	r = usbd_alloc_report_desc(uaa->iface, &desc, &size, M_TEMP);
    183   1.1  augustss 	if (r != USBD_NORMAL_COMPLETION)
    184   1.1  augustss 		return (UMATCH_NONE);
    185   1.1  augustss 
    186   1.1  augustss 	if (hid_is_collection(desc, size,
    187   1.1  augustss 			      HID_USAGE2(HUP_GENERIC_DESKTOP, HUG_MOUSE)))
    188   1.1  augustss 		ret = UMATCH_IFACECLASS;
    189   1.1  augustss 	else
    190   1.1  augustss 		ret = UMATCH_NONE;
    191   1.1  augustss 
    192   1.1  augustss 	free(desc, M_TEMP);
    193   1.1  augustss 	return (ret);
    194   1.1  augustss }
    195   1.1  augustss 
    196  1.16  augustss USB_ATTACH(ums)
    197   1.1  augustss {
    198  1.16  augustss 	USB_ATTACH_START(ums, sc, uaa);
    199   1.1  augustss 	usbd_interface_handle iface = uaa->iface;
    200   1.1  augustss 	usb_interface_descriptor_t *id;
    201   1.1  augustss 	usb_endpoint_descriptor_t *ed;
    202  1.19  augustss #if defined(__NetBSD__)
    203   1.3  augustss 	struct wsmousedev_attach_args a;
    204  1.19  augustss #endif
    205   1.1  augustss 	int size;
    206   1.1  augustss 	void *desc;
    207   1.1  augustss 	usbd_status r;
    208   1.1  augustss 	char devinfo[1024];
    209   1.2  augustss 	u_int32_t flags;
    210  1.16  augustss 	int i;
    211  1.16  augustss 	struct hid_location loc_btn;
    212   1.1  augustss 
    213   1.1  augustss 	sc->sc_disconnected = 1;
    214   1.1  augustss 	sc->sc_iface = iface;
    215   1.1  augustss 	id = usbd_get_interface_descriptor(iface);
    216   1.1  augustss 	usbd_devinfo(uaa->device, 0, devinfo);
    217  1.16  augustss 	USB_ATTACH_SETUP;
    218  1.16  augustss 	printf("%s: %s, iclass %d/%d\n", USBDEVNAME(sc->sc_dev),
    219  1.12  augustss 	       devinfo, id->bInterfaceClass, id->bInterfaceSubClass);
    220   1.1  augustss 	ed = usbd_interface2endpoint_descriptor(iface, 0);
    221   1.1  augustss 	if (!ed) {
    222   1.1  augustss 		printf("%s: could not read endpoint descriptor\n",
    223  1.16  augustss 		       USBDEVNAME(sc->sc_dev));
    224  1.16  augustss 		USB_ATTACH_ERROR_RETURN;
    225   1.1  augustss 	}
    226   1.1  augustss 
    227  1.15  augustss 	DPRINTFN(10,("ums_attach: bLength=%d bDescriptorType=%d "
    228  1.15  augustss 		     "bEndpointAddress=%d-%s bmAttributes=%d wMaxPacketSize=%d"
    229  1.15  augustss 		     " bInterval=%d\n",
    230  1.15  augustss 		     ed->bLength, ed->bDescriptorType,
    231  1.15  augustss 		     ed->bEndpointAddress & UE_ADDR,
    232  1.15  augustss 		     ed->bEndpointAddress & UE_IN ? "in" : "out",
    233  1.15  augustss 		     ed->bmAttributes & UE_XFERTYPE,
    234  1.15  augustss 		     UGETW(ed->wMaxPacketSize), ed->bInterval));
    235   1.1  augustss 
    236   1.1  augustss 	if ((ed->bEndpointAddress & UE_IN) != UE_IN ||
    237   1.1  augustss 	    (ed->bmAttributes & UE_XFERTYPE) != UE_INTERRUPT) {
    238   1.1  augustss 		printf("%s: unexpected endpoint\n",
    239  1.16  augustss 		       USBDEVNAME(sc->sc_dev));
    240  1.16  augustss 		USB_ATTACH_ERROR_RETURN;
    241   1.1  augustss 	}
    242   1.1  augustss 
    243   1.1  augustss 	r = usbd_alloc_report_desc(uaa->iface, &desc, &size, M_TEMP);
    244   1.1  augustss 	if (r != USBD_NORMAL_COMPLETION)
    245  1.16  augustss 		USB_ATTACH_ERROR_RETURN;
    246  1.16  augustss 
    247   1.2  augustss 	if (!hid_locate(desc, size, HID_USAGE2(HUP_GENERIC_DESKTOP, HUG_X),
    248   1.2  augustss 		       hid_input, &sc->sc_loc_x, &flags)) {
    249  1.16  augustss 		printf("%s: mouse has no X report\n", USBDEVNAME(sc->sc_dev));
    250  1.16  augustss 		USB_ATTACH_ERROR_RETURN;
    251  1.16  augustss 	}
    252  1.16  augustss 	if ((flags & MOUSE_FLAGS_MASK) != MOUSE_FLAGS) {
    253  1.16  augustss 		printf("%s: X report 0x%04x not supported\n",
    254  1.16  augustss 		       USBDEVNAME(sc->sc_dev), flags);
    255  1.16  augustss 		USB_ATTACH_ERROR_RETURN;
    256   1.1  augustss 	}
    257  1.10  augustss 
    258   1.2  augustss 	if (!hid_locate(desc, size, HID_USAGE2(HUP_GENERIC_DESKTOP, HUG_Y),
    259   1.2  augustss 		       hid_input, &sc->sc_loc_y, &flags)) {
    260  1.16  augustss 		printf("%s: mouse has no Y report\n", USBDEVNAME(sc->sc_dev));
    261  1.16  augustss 		USB_ATTACH_ERROR_RETURN;
    262  1.16  augustss 	}
    263  1.16  augustss 	if ((flags & MOUSE_FLAGS_MASK) != MOUSE_FLAGS) {
    264  1.16  augustss 		printf("%s: Y report 0x%04x not supported\n",
    265  1.16  augustss 		       USBDEVNAME(sc->sc_dev), flags);
    266  1.16  augustss 		USB_ATTACH_ERROR_RETURN;
    267   1.1  augustss 	}
    268  1.10  augustss 
    269  1.16  augustss 	/* try to guess the Z activator: first check Z, then WHEEL */
    270   1.6  augustss 	if (hid_locate(desc, size, HID_USAGE2(HUP_GENERIC_DESKTOP, HUG_Z),
    271   1.6  augustss 		       hid_input, &sc->sc_loc_z, &flags) ||
    272   1.6  augustss 	    hid_locate(desc, size, HID_USAGE2(HUP_GENERIC_DESKTOP, HUG_WHEEL),
    273   1.6  augustss 		       hid_input, &sc->sc_loc_z, &flags)) {
    274  1.16  augustss 		if ((flags & MOUSE_FLAGS_MASK) != MOUSE_FLAGS) {
    275  1.16  augustss 			sc->sc_loc_z.size = 0;	/* Bad Z coord, ignore it */
    276  1.16  augustss 		} else {
    277  1.16  augustss 			sc->flags |= UMS_Z;
    278  1.16  augustss 		}
    279   1.6  augustss 	}
    280   1.6  augustss 
    281  1.16  augustss 	/* figure out the number of buttons, 7 is an arbitrary limit */
    282  1.16  augustss 	for (i = 1; i <= 7; i++)
    283  1.16  augustss 		if (!hid_locate(desc, size, HID_USAGE2(HUP_BUTTON, i),
    284  1.16  augustss 				hid_input, &loc_btn, 0))
    285  1.16  augustss 			break;
    286  1.16  augustss 	sc->nbuttons = i - 1;
    287  1.16  augustss 	sc->sc_loc_btn = malloc(sizeof(struct hid_location)*sc->nbuttons,
    288  1.16  augustss 				M_USBDEV, M_NOWAIT);
    289  1.16  augustss 	if (!sc->sc_loc_btn)
    290  1.16  augustss 		USB_ATTACH_ERROR_RETURN;
    291  1.16  augustss 
    292  1.16  augustss 	printf("%s: %d buttons%s\n", USBDEVNAME(sc->sc_dev),
    293  1.16  augustss 	       sc->nbuttons, (sc->flags & UMS_Z? " and Z dir." : ""));
    294  1.16  augustss 
    295  1.16  augustss 	for (i = 1; i <= sc->nbuttons; i++)
    296  1.16  augustss 		hid_locate(desc, size, HID_USAGE2(HUP_BUTTON, i),
    297  1.16  augustss 				hid_input, &sc->sc_loc_btn[i-1], 0);
    298   1.1  augustss 
    299   1.1  augustss 	sc->sc_isize = hid_report_size(desc, size, hid_input, &sc->sc_iid);
    300   1.1  augustss 	sc->sc_ibuf = malloc(sc->sc_isize, M_USB, M_NOWAIT);
    301  1.16  augustss 	if (!sc->sc_ibuf) {
    302  1.16  augustss 		free(sc->sc_loc_btn, M_USB);
    303  1.16  augustss 		USB_ATTACH_ERROR_RETURN;
    304  1.16  augustss 	}
    305   1.1  augustss 
    306   1.1  augustss 	sc->sc_ep_addr = ed->bEndpointAddress;
    307   1.1  augustss 	sc->sc_disconnected = 0;
    308   1.1  augustss 	free(desc, M_TEMP);
    309   1.3  augustss 
    310  1.16  augustss #ifdef USB_DEBUG
    311  1.16  augustss 	DPRINTF(("ums_attach: sc=%p\n", sc));
    312  1.16  augustss 	DPRINTF(("ums_attach: X\t%d/%d\n",
    313  1.16  augustss 		 sc->sc_loc_x.pos, sc->sc_loc_x.size));
    314  1.16  augustss 	DPRINTF(("ums_attach: Y\t%d/%d\n",
    315  1.16  augustss 		 sc->sc_loc_x.pos, sc->sc_loc_x.size));
    316  1.16  augustss 	if (sc->flags & UMS_Z)
    317  1.16  augustss 		DPRINTF(("ums_attach: Z\t%d/%d\n",
    318  1.16  augustss 			 sc->sc_loc_z.pos, sc->sc_loc_z.size));
    319  1.16  augustss 	for (i = 1; i <= sc->nbuttons; i++) {
    320  1.16  augustss 		DPRINTF(("ums_attach: B%d\t%d/%d\n",
    321  1.16  augustss 			 i, sc->sc_loc_btn[i-1].pos,sc->sc_loc_btn[i-1].size));
    322  1.16  augustss 	}
    323  1.16  augustss 	DPRINTF(("ums_attach: size=%d, id=%d\n", sc->sc_isize, sc->sc_iid));
    324  1.16  augustss #endif
    325  1.16  augustss 
    326  1.16  augustss #if defined(__NetBSD__)
    327   1.3  augustss 	a.accessops = &ums_accessops;
    328   1.3  augustss 	a.accesscookie = sc;
    329   1.3  augustss 
    330   1.3  augustss 	sc->sc_wsmousedev = config_found(self, &a, wsmousedevprint);
    331  1.16  augustss #elif defined(__FreeBSD__)
    332  1.16  augustss 	sc->hw.buttons = 2;		/* XXX hw&mode values are bogus */
    333  1.16  augustss 	sc->hw.iftype = MOUSE_IF_PS2;
    334  1.16  augustss 	sc->hw.type = MOUSE_MOUSE;
    335  1.16  augustss 	if (sc->flags & UMS_Z)
    336  1.16  augustss 		sc->hw.model = MOUSE_MODEL_INTELLI;
    337  1.16  augustss 	else
    338  1.16  augustss 		sc->hw.model = MOUSE_MODEL_GENERIC;
    339  1.16  augustss 	sc->hw.hwid = 0;
    340  1.16  augustss 	sc->mode.protocol = MOUSE_PROTO_PS2;
    341  1.16  augustss 	sc->mode.rate = -1;
    342  1.16  augustss 	sc->mode.resolution = MOUSE_RES_DEFAULT;
    343  1.16  augustss 	sc->mode.accelfactor = 1;
    344  1.16  augustss 	sc->mode.level = 0;
    345  1.16  augustss 	if (sc->flags & UMS_Z) {
    346  1.16  augustss 		sc->mode.packetsize = MOUSE_INTELLI_PACKETSIZE;
    347  1.16  augustss 		sc->mode.syncmask[0] = 0xc8;
    348  1.16  augustss 	} else {
    349  1.16  augustss 		sc->mode.packetsize = MOUSE_PS2_PACKETSIZE;
    350  1.16  augustss 		sc->mode.syncmask[0] = 0xc0;
    351  1.16  augustss 	}
    352  1.16  augustss 	sc->mode.syncmask[1] = 0;
    353  1.16  augustss 
    354  1.16  augustss 	sc->status.flags = 0;
    355  1.16  augustss 	sc->status.button = sc->status.obutton = 0;
    356  1.16  augustss 	sc->status.dx = sc->status.dy = sc->status.dz = 0;
    357  1.16  augustss 
    358  1.16  augustss 	sc->rsel.si_flags = 0;
    359  1.16  augustss 	sc->rsel.si_pid = 0;
    360  1.16  augustss #endif
    361  1.16  augustss 
    362  1.16  augustss 	USB_ATTACH_SUCCESS_RETURN;
    363  1.16  augustss }
    364  1.16  augustss 
    365  1.16  augustss 
    366  1.16  augustss #if defined(__FreeBSD__)
    367  1.16  augustss static int
    368  1.16  augustss ums_detach(device_t self)
    369  1.16  augustss {
    370  1.16  augustss 	struct ums_softc *sc = device_get_softc(self);
    371  1.16  augustss 	char *devinfo = (char *) device_get_desc(self);
    372  1.16  augustss 
    373  1.16  augustss 	if (devinfo) {
    374  1.16  augustss 		device_set_desc(self, NULL);
    375  1.16  augustss 		free(devinfo, M_USB);
    376  1.16  augustss 	}
    377  1.16  augustss 	free(sc->sc_loc_btn, M_USB);
    378  1.16  augustss 	free(sc->sc_ibuf, M_USB);
    379  1.16  augustss 
    380  1.16  augustss 	return 0;
    381   1.1  augustss }
    382  1.16  augustss #endif
    383   1.1  augustss 
    384   1.1  augustss void
    385   1.1  augustss ums_disco(p)
    386   1.1  augustss 	void *p;
    387   1.1  augustss {
    388   1.1  augustss 	struct ums_softc *sc = p;
    389   1.8  augustss 
    390   1.8  augustss 	DPRINTF(("ums_disco: sc=%p\n", sc));
    391   1.8  augustss 	usbd_abort_pipe(sc->sc_intrpipe);
    392   1.1  augustss 	sc->sc_disconnected = 1;
    393   1.1  augustss }
    394   1.1  augustss 
    395   1.1  augustss void
    396   1.1  augustss ums_intr(reqh, addr, status)
    397   1.1  augustss 	usbd_request_handle reqh;
    398   1.1  augustss 	usbd_private_handle addr;
    399   1.1  augustss 	usbd_status status;
    400   1.1  augustss {
    401   1.1  augustss 	struct ums_softc *sc = addr;
    402   1.1  augustss 	u_char *ibuf;
    403   1.6  augustss 	int dx, dy, dz;
    404  1.16  augustss 	u_char buttons = 0;
    405  1.16  augustss 	int i;
    406  1.16  augustss #if defined(__NetBSD__)
    407  1.16  augustss #define UMS_BUT(i) ((i) == 1 || (i) == 2 ? 3 - (i) : i)
    408  1.16  augustss #elif defined(__FreeBSD__)
    409  1.16  augustss #define UMS_BUT(i) (i)
    410  1.16  augustss #endif
    411   1.1  augustss 
    412   1.1  augustss 	DPRINTFN(5, ("ums_intr: sc=%p status=%d\n", sc, status));
    413   1.1  augustss 	DPRINTFN(5, ("ums_intr: data = %02x %02x %02x\n",
    414   1.1  augustss 		     sc->sc_ibuf[0], sc->sc_ibuf[1], sc->sc_ibuf[2]));
    415   1.1  augustss 
    416   1.1  augustss 	if (status == USBD_CANCELLED)
    417   1.1  augustss 		return;
    418   1.1  augustss 
    419   1.1  augustss 	if (status != USBD_NORMAL_COMPLETION) {
    420   1.1  augustss 		DPRINTF(("ums_intr: status=%d\n", status));
    421   1.7  augustss 		usbd_clear_endpoint_stall_async(sc->sc_intrpipe);
    422   1.1  augustss 		return;
    423   1.1  augustss 	}
    424   1.1  augustss 
    425   1.1  augustss 	ibuf = sc->sc_ibuf;
    426   1.1  augustss 	if (sc->sc_iid) {
    427   1.1  augustss 		if (*ibuf++ != sc->sc_iid)
    428   1.1  augustss 			return;
    429   1.1  augustss 	}
    430   1.1  augustss 	dx =  hid_get_data(ibuf, &sc->sc_loc_x);
    431   1.1  augustss 	dy = -hid_get_data(ibuf, &sc->sc_loc_y);
    432   1.6  augustss 	dz =  hid_get_data(ibuf, &sc->sc_loc_z);
    433  1.16  augustss 	/* NWH Why are you modifying the button assignments here?
    434  1.16  augustss 	 * That's the purpose of a high level mouse driver
    435  1.16  augustss 	 */
    436  1.16  augustss 	for (i = 0; i < sc->nbuttons; i++)
    437  1.16  augustss 		if (hid_get_data(ibuf, &sc->sc_loc_btn[i]))
    438  1.16  augustss 			buttons |= (1 << UMS_BUT(i));
    439   1.4  augustss 
    440  1.16  augustss #if defined(__NetBSD__)
    441   1.4  augustss 	if (dx || dy || buttons != sc->sc_buttons) {
    442  1.16  augustss 		DPRINTFN(10, ("ums_intr: x:%d y:%d z:%d buttons:0x%x\n",
    443  1.16  augustss 			dx, dy, dz, buttons));
    444   1.4  augustss 		sc->sc_buttons = buttons;
    445   1.4  augustss 		if (sc->sc_wsmousedev)
    446   1.6  augustss 			wsmouse_input(sc->sc_wsmousedev, buttons, dx, dy, dz);
    447  1.16  augustss #elif defined(__FreeBSD__)
    448  1.16  augustss 	if (dx || dy || buttons != sc->status.button) {
    449  1.16  augustss 		DPRINTFN(10, ("ums_intr: x:%d y:%d z:%d buttons:0x%x\n",
    450  1.16  augustss 			dx, dy, dz, buttons));
    451  1.16  augustss 
    452  1.16  augustss 		sc->status.button = buttons;
    453  1.16  augustss 		sc->status.dx += dx;
    454  1.16  augustss 		sc->status.dy += dy;
    455  1.16  augustss 		sc->status.dz += dz;
    456  1.16  augustss 
    457  1.16  augustss 		/* Discard data in case of full buffer */
    458  1.16  augustss 		if (sc->qcount == sizeof(sc->qbuf)) {
    459  1.16  augustss 			DPRINTF(("Buffer full, discarded packet"));
    460  1.16  augustss 			return;
    461  1.16  augustss 		}
    462  1.16  augustss 
    463  1.16  augustss 		sc->qbuf[sc->qhead] = MOUSE_PS2_SYNC;
    464  1.16  augustss 		if (dx < 0)
    465  1.16  augustss 			sc->qbuf[sc->qhead] |= MOUSE_PS2_XNEG;
    466  1.16  augustss 		if (dx > 255 || dx < -255)
    467  1.16  augustss 			sc->qbuf[sc->qhead] |= MOUSE_PS2_XOVERFLOW;
    468  1.16  augustss 		if (dy < 0)
    469  1.16  augustss 			sc->qbuf[sc->qhead] |= MOUSE_PS2_YNEG;
    470  1.16  augustss 		if (dy > 255 || dy < -255)
    471  1.16  augustss 			sc->qbuf[sc->qhead] |= MOUSE_PS2_YOVERFLOW;
    472  1.16  augustss 		sc->qbuf[sc->qhead++] |= buttons;
    473  1.16  augustss 		sc->qbuf[sc->qhead++] = dx;
    474  1.16  augustss 		sc->qbuf[sc->qhead++] = dy;
    475  1.16  augustss 		sc->qcount += 3;
    476  1.16  augustss 		if (sc->flags & UMS_Z) {
    477  1.16  augustss 			sc->qbuf[sc->qhead++] = dz;
    478  1.16  augustss 			sc->qcount++;
    479  1.16  augustss 		}
    480  1.16  augustss #ifdef USB_DEBUG
    481  1.16  augustss 		if (sc->qhead > sizeof(sc->qbuf))
    482  1.16  augustss 			DPRINTF(("Buffer overrun! %d %d\n",
    483  1.16  augustss 				 sc->qhead, sizeof(sc->qbuf)));
    484  1.16  augustss #endif
    485  1.16  augustss 		/* wrap round at end of buffer */
    486  1.16  augustss 		if (sc->qhead >= sizeof(sc->qbuf))
    487  1.16  augustss 			sc->qhead = 0;
    488  1.16  augustss 
    489  1.16  augustss 		/* someone waiting for data */
    490  1.16  augustss 		if (sc->state & UMS_ASLEEP)
    491  1.16  augustss 			wakeup(sc);
    492  1.16  augustss 		/* wake up any pending selects */
    493  1.16  augustss 		selwakeup(&sc->rsel);
    494  1.16  augustss 		sc->state &= ~UMS_SELECT;
    495  1.16  augustss #endif
    496   1.1  augustss 	}
    497   1.1  augustss }
    498   1.3  augustss 
    499  1.16  augustss 
    500  1.16  augustss static int
    501   1.3  augustss ums_enable(v)
    502   1.3  augustss 	void *v;
    503   1.3  augustss {
    504   1.3  augustss 	struct ums_softc *sc = v;
    505  1.16  augustss 
    506   1.3  augustss 	usbd_status r;
    507   1.3  augustss 
    508   1.3  augustss 	if (sc->sc_enabled)
    509   1.3  augustss 		return EBUSY;
    510   1.3  augustss 
    511   1.3  augustss 	sc->sc_enabled = 1;
    512  1.16  augustss #if defined(__NetBSD__)
    513   1.4  augustss 	sc->sc_buttons = 0;
    514  1.16  augustss #elif defined(__FreeBSD__)
    515  1.16  augustss 	sc->qcount = 0;
    516  1.16  augustss 	sc->qhead = sc->qtail = 0;
    517  1.16  augustss #ifdef USB_DEBUG
    518  1.16  augustss 	if (sizeof(sc->qbuf) % 4 || sizeof(sc->qbuf) % 3) {
    519  1.16  augustss 		DPRINTF(("Buffer size not divisible by 3 or 4\n"));
    520  1.16  augustss 		return ENXIO;
    521  1.16  augustss 	}
    522  1.16  augustss #endif
    523  1.16  augustss 	sc->status.flags = 0;
    524  1.16  augustss 	sc->status.button = sc->status.obutton = 0;
    525  1.16  augustss 	sc->status.dx = sc->status.dy = sc->status.dz = 0;
    526  1.16  augustss #endif
    527   1.3  augustss 
    528   1.3  augustss 	/* Set up interrupt pipe. */
    529   1.3  augustss 	r = usbd_open_pipe_intr(sc->sc_iface, sc->sc_ep_addr,
    530   1.3  augustss 				USBD_SHORT_XFER_OK, &sc->sc_intrpipe, sc,
    531   1.3  augustss 				sc->sc_ibuf, sc->sc_isize, ums_intr);
    532   1.3  augustss 	if (r != USBD_NORMAL_COMPLETION) {
    533   1.3  augustss 		DPRINTF(("ums_enable: usbd_open_pipe_intr failed, error=%d\n",
    534   1.3  augustss 			 r));
    535   1.3  augustss 		sc->sc_enabled = 0;
    536   1.3  augustss 		return (EIO);
    537   1.3  augustss 	}
    538   1.3  augustss 	usbd_set_disco(sc->sc_intrpipe, ums_disco, sc);
    539   1.3  augustss 	return (0);
    540   1.3  augustss }
    541   1.3  augustss 
    542  1.16  augustss static void
    543   1.3  augustss ums_disable(v)
    544   1.3  augustss 	void *v;
    545   1.3  augustss {
    546   1.3  augustss 	struct ums_softc *sc = v;
    547   1.3  augustss 
    548   1.3  augustss 	/* Disable interrupts. */
    549   1.3  augustss 	usbd_abort_pipe(sc->sc_intrpipe);
    550   1.3  augustss 	usbd_close_pipe(sc->sc_intrpipe);
    551   1.3  augustss 
    552   1.3  augustss 	sc->sc_enabled = 0;
    553  1.16  augustss 
    554  1.16  augustss #if defined(USBVERBOSE) && defined(__FreeBSD__)
    555  1.16  augustss 	if (sc->qcount != 0)
    556  1.16  augustss 		DPRINTF(("Discarded %d bytes in queue\n", sc->qcount));
    557  1.16  augustss #endif
    558   1.3  augustss }
    559   1.3  augustss 
    560  1.16  augustss #if defined(__NetBSD__)
    561  1.16  augustss static int
    562   1.3  augustss ums_ioctl(v, cmd, data, flag, p)
    563   1.3  augustss 	void *v;
    564   1.3  augustss 	u_long cmd;
    565   1.3  augustss 	caddr_t data;
    566   1.3  augustss 	int flag;
    567   1.3  augustss 	struct proc *p;
    568  1.16  augustss 
    569   1.3  augustss {
    570   1.3  augustss 	switch (cmd) {
    571   1.3  augustss 	case WSMOUSEIO_GTYPE:
    572  1.17  augustss 		*(u_int *)data = WSMOUSE_TYPE_USB;
    573   1.3  augustss 		return (0);
    574   1.3  augustss 	}
    575  1.16  augustss 
    576   1.3  augustss 	return (-1);
    577   1.3  augustss }
    578  1.16  augustss 
    579  1.16  augustss #elif defined(__FreeBSD__)
    580  1.16  augustss static int
    581  1.16  augustss ums_open(dev_t dev, int flag, int fmt, struct proc *p)
    582  1.16  augustss {
    583  1.16  augustss 	struct ums_softc *sc = devclass_get_softc(ums_devclass, UMSUNIT(dev));
    584  1.16  augustss 
    585  1.16  augustss 	if (!sc) {
    586  1.16  augustss 		DPRINTF(("sc not found at open"));
    587  1.16  augustss 		return EINVAL;
    588  1.16  augustss 	}
    589  1.16  augustss 
    590  1.16  augustss 	return ums_enable(sc);
    591  1.16  augustss }
    592  1.16  augustss 
    593  1.16  augustss static int
    594  1.16  augustss ums_close(dev_t dev, int flag, int fmt, struct proc *p)
    595  1.16  augustss {
    596  1.16  augustss 	struct ums_softc *sc = devclass_get_softc(ums_devclass, UMSUNIT(dev));
    597  1.16  augustss 
    598  1.16  augustss 	if (!sc) {
    599  1.16  augustss 		DPRINTF(("sc not found at close"));
    600  1.16  augustss 		return EINVAL;
    601  1.16  augustss 	}
    602  1.16  augustss 
    603  1.16  augustss 	if (sc->sc_enabled)
    604  1.16  augustss 		ums_disable(sc);
    605  1.16  augustss 	return 0;
    606  1.16  augustss }
    607  1.16  augustss 
    608  1.16  augustss static int
    609  1.16  augustss ums_read(dev_t dev, struct uio *uio, int flag)
    610  1.16  augustss {
    611  1.16  augustss 	struct ums_softc *sc = devclass_get_softc(ums_devclass, UMSUNIT(dev));
    612  1.16  augustss 	int s;
    613  1.16  augustss 	char buf[sizeof(sc->qbuf)];
    614  1.16  augustss 	int l = 0;
    615  1.16  augustss 	int error;
    616  1.16  augustss 
    617  1.16  augustss 	if (!sc || !sc->sc_enabled) {
    618  1.16  augustss 		DPRINTF(("sc not found at read"));
    619  1.16  augustss 		return EINVAL;
    620  1.16  augustss 	}
    621  1.16  augustss 
    622  1.16  augustss 	s = splusb();
    623  1.16  augustss 	while (sc->qcount == 0 )  {
    624  1.16  augustss 		/* NWH XXX non blocking I/O ??
    625  1.16  augustss 		if (non blocking I/O ) {
    626  1.16  augustss 			splx(s);
    627  1.16  augustss 			return EWOULDBLOCK;
    628  1.16  augustss 		} else {
    629  1.16  augustss 		*/
    630  1.16  augustss 		sc->state |= UMS_ASLEEP;
    631  1.16  augustss 		error = tsleep(sc, PZERO | PCATCH, "umsrea", 0);
    632  1.16  augustss 		sc->state &= ~UMS_ASLEEP;
    633  1.16  augustss 		if (error) {
    634  1.16  augustss 			splx(s);
    635  1.16  augustss 			return error;
    636  1.16  augustss 		}
    637  1.16  augustss 	}
    638  1.16  augustss 
    639  1.16  augustss 	while ((sc->qcount > 0) && (uio->uio_resid > 0)) {
    640  1.16  augustss 		l = (sc->qcount < uio->uio_resid? sc->qcount:uio->uio_resid);
    641  1.16  augustss 		if (l > sizeof(buf))
    642  1.16  augustss 			l = sizeof(buf);
    643  1.16  augustss 		if (l > sizeof(sc->qbuf) - sc->qtail)		/* transfer till end of buf */
    644  1.16  augustss 			l = sizeof(sc->qbuf) - sc->qtail;
    645  1.16  augustss 
    646  1.16  augustss 		splx(s);
    647  1.16  augustss 		uiomove(&sc->qbuf[sc->qtail], l, uio);
    648  1.16  augustss 		s = splusb();
    649  1.16  augustss 
    650  1.16  augustss 		if ( sc->qcount - l < 0 ) {
    651  1.16  augustss 			DPRINTF(("qcount below 0, count=%d l=%d\n", sc->qcount, l));
    652  1.16  augustss 			sc->qcount = l;
    653  1.16  augustss 		}
    654  1.16  augustss 		sc->qcount -= l;	/* remove the bytes from the buffer */
    655  1.16  augustss 		sc->qtail = (sc->qtail + l) % sizeof(sc->qbuf);
    656  1.16  augustss 	}
    657  1.16  augustss 	splx(s);
    658  1.16  augustss 
    659  1.16  augustss 	return 0;
    660  1.16  augustss }
    661  1.16  augustss 
    662  1.16  augustss static int
    663  1.16  augustss ums_poll(dev_t dev, int events, struct proc *p)
    664  1.16  augustss {
    665  1.16  augustss 	struct ums_softc *sc = devclass_get_softc(ums_devclass, UMSUNIT(dev));
    666  1.16  augustss 	int revents = 0;
    667  1.16  augustss 	int s;
    668  1.16  augustss 
    669  1.16  augustss 	if (!sc) {
    670  1.16  augustss 		DPRINTF(("sc not found at poll"));
    671  1.16  augustss 		return 0;	/* just to make sure */
    672  1.16  augustss 	}
    673  1.16  augustss 
    674  1.16  augustss 	s = splusb();
    675  1.16  augustss 	if (events & (POLLIN | POLLRDNORM))
    676  1.16  augustss 		if (sc->qcount) {
    677  1.16  augustss 			revents = events & (POLLIN | POLLRDNORM);
    678  1.16  augustss 		} else {
    679  1.16  augustss 			sc->state |= UMS_SELECT;
    680  1.16  augustss 			selrecord(p, &sc->rsel);
    681  1.16  augustss 		}
    682  1.16  augustss 	splx(s);
    683  1.16  augustss 
    684  1.16  augustss 	return revents;
    685  1.16  augustss }
    686  1.16  augustss 
    687  1.16  augustss int
    688  1.16  augustss ums_ioctl(dev_t dev, u_long cmd, caddr_t addr, int flag, struct proc *p)
    689  1.16  augustss {
    690  1.16  augustss 	struct ums_softc *sc = devclass_get_softc(ums_devclass, UMSUNIT(dev));
    691  1.16  augustss 	int error = 0;
    692  1.16  augustss 	int s;
    693  1.16  augustss 
    694  1.16  augustss 	if (!sc) {
    695  1.16  augustss 		DPRINTF(("sc not found at ioctl"));
    696  1.16  augustss 		return ENOENT;
    697  1.16  augustss 	}
    698  1.16  augustss 
    699  1.16  augustss 	switch(cmd) {
    700  1.16  augustss 	case MOUSE_GETHWINFO:
    701  1.16  augustss 		*(mousehw_t *)addr = sc->hw;
    702  1.16  augustss 		break;
    703  1.16  augustss 	case MOUSE_GETMODE:
    704  1.16  augustss 		*(mousemode_t *)addr = sc->mode;
    705  1.16  augustss 		break;
    706  1.16  augustss 	case MOUSE_GETLEVEL:
    707  1.16  augustss 		*(int *)addr = sc->mode.level;
    708  1.16  augustss 		break;
    709  1.16  augustss 	case MOUSE_GETSTATUS: {
    710  1.16  augustss 		mousestatus_t *status = (mousestatus_t *) addr;
    711  1.16  augustss 
    712  1.16  augustss 		s = splusb();
    713  1.16  augustss 		*status = sc->status;
    714  1.16  augustss 		sc->status.obutton = sc->status.button;
    715  1.16  augustss 		sc->status.button = 0;
    716  1.16  augustss 		sc->status.dx = sc->status.dy = sc->status.dz = 0;
    717  1.16  augustss 		splx(s);
    718  1.16  augustss 
    719  1.16  augustss 		if (status->dx || status->dy || status->dz)
    720  1.16  augustss 			status->flags |= MOUSE_POSCHANGED;
    721  1.16  augustss 		if (status->button != status->obutton)
    722  1.16  augustss 			status->flags |= MOUSE_BUTTONSCHANGED;
    723  1.16  augustss 		break;
    724  1.16  augustss 		}
    725  1.16  augustss 	default:
    726  1.16  augustss 		error = ENOTTY;
    727  1.16  augustss 	}
    728  1.16  augustss 
    729  1.16  augustss 	return error;
    730  1.16  augustss }
    731  1.16  augustss #endif
    732  1.16  augustss 
    733  1.16  augustss #if defined(__FreeBSD__)
    734  1.16  augustss CDEV_DRIVER_MODULE(ums, usb, ums_driver, ums_devclass,
    735  1.19  augustss 			UMS_CDEV_MAJOR, ums_cdevsw, usbd_driver_load, 0);
    736  1.16  augustss #endif
    737   1.3  augustss 
    738