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