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