2 * Copyright (C) 2008 Nathan Whitehorn
5 * Redistribution and use in source and binary forms, with or without
6 * modification, are permitted provided that the following conditions
8 * 1. Redistributions of source code must retain the above copyright
9 * notice, this list of conditions and the following disclaimer.
10 * 2. Redistributions in binary form must reproduce the above copyright
11 * notice, this list of conditions and the following disclaimer in the
12 * documentation and/or other materials provided with the distribution.
14 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
15 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
16 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
17 * IN NO EVENT SHALL TOOLS GMBH BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
18 * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
19 * PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS;
20 * OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
21 * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR
22 * OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF
23 * ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
28 #include <sys/cdefs.h>
29 #include <sys/param.h>
30 #include <sys/systm.h>
31 #include <sys/module.h>
34 #include <sys/mouse.h>
36 #include <sys/condvar.h>
37 #include <sys/selinfo.h>
39 #include <sys/fcntl.h>
40 #include <sys/kernel.h>
42 #include <machine/bus.h>
49 #define CDEV_GET_SOFTC(x) (x)->si_drv1
51 static int adb_mouse_probe(device_t dev);
52 static int adb_mouse_attach(device_t dev);
53 static int adb_mouse_detach(device_t dev);
55 static d_open_t ams_open;
56 static d_close_t ams_close;
57 static d_read_t ams_read;
58 static d_ioctl_t ams_ioctl;
59 static d_poll_t ams_poll;
61 static u_int adb_mouse_receive_packet(device_t dev, u_char status,
62 u_char command, u_char reg, int len, u_char *data);
64 struct adb_mouse_softc {
71 #define AMS_EXTENDED 0x1
72 #define AMS_TOUCHPAD 0x2
84 size_t packet_read_len;
90 static device_method_t adb_mouse_methods[] = {
91 /* Device interface */
92 DEVMETHOD(device_probe, adb_mouse_probe),
93 DEVMETHOD(device_attach, adb_mouse_attach),
94 DEVMETHOD(device_detach, adb_mouse_detach),
95 DEVMETHOD(device_shutdown, bus_generic_shutdown),
96 DEVMETHOD(device_suspend, bus_generic_suspend),
97 DEVMETHOD(device_resume, bus_generic_resume),
100 DEVMETHOD(adb_receive_packet, adb_mouse_receive_packet),
105 static driver_t adb_mouse_driver = {
108 sizeof(struct adb_mouse_softc),
111 static devclass_t adb_mouse_devclass;
113 DRIVER_MODULE(ams, adb, adb_mouse_driver, adb_mouse_devclass, 0, 0);
115 static struct cdevsw ams_cdevsw = {
116 .d_version = D_VERSION,
119 .d_close = ams_close,
121 .d_ioctl = ams_ioctl,
127 adb_mouse_probe(device_t dev)
131 type = adb_get_device_type(dev);
133 if (type != ADB_DEVICE_MOUSE)
136 device_set_desc(dev,"ADB Mouse");
141 adb_mouse_attach(device_t dev)
143 struct adb_mouse_softc *sc;
144 char *description = "Unknown Pointing Device";
149 sc = device_get_softc(dev);
152 mtx_init(&sc->sc_mtx,"ams",MTX_DEF,0);
153 cv_init(&sc->sc_cv,"ams");
158 sc->hw.iftype = MOUSE_IF_UNKNOWN;
159 sc->hw.type = MOUSE_UNKNOWN;
160 sc->hw.model = sc->hw.hwid = 0;
162 sc->mode.protocol = MOUSE_PROTO_SYSMOUSE;
164 sc->mode.resolution = 100;
165 sc->mode.accelfactor = 0;
167 sc->mode.packetsize = 5;
170 sc->last_buttons = 0;
171 sc->packet_read_len = 0;
173 /* Try to switch to extended protocol */
174 adb_set_device_handler(dev,4);
176 switch(adb_get_device_handler(dev)) {
178 sc->mode.resolution = 100;
181 sc->mode.resolution = 200;
184 r1_len = adb_read_register(dev,1,r1);
188 sc->flags |= AMS_EXTENDED;
189 memcpy(&sc->hw.hwid,r1,4);
190 sc->mode.resolution = (r1[4] << 8) | r1[5];
194 sc->hw.type = MOUSE_PAD;
195 description = "Tablet";
198 sc->hw.type = MOUSE_MOUSE;
199 description = "Mouse";
202 sc->hw.type = MOUSE_TRACKBALL;
203 description = "Trackball";
206 sc->flags |= AMS_TOUCHPAD;
207 sc->hw.type = MOUSE_PAD;
208 description = "Touchpad";
212 sc->hw.buttons = r1[7];
214 device_printf(dev,"%d-button %d-dpi %s\n",
215 sc->hw.buttons, sc->mode.resolution,description);
218 * Check for one of MacAlly's non-compliant 2-button mice.
219 * These claim to speak the extended mouse protocol, but
220 * instead speak the standard protocol and only when their
221 * handler is set to 0x42.
224 if (sc->hw.hwid == 0x4b4f4954) {
225 adb_set_device_handler(dev,0x42);
227 if (adb_get_device_handler(dev) == 0x42) {
228 device_printf(dev, "MacAlly 2-Button Mouse\n");
229 sc->flags &= ~AMS_EXTENDED;
236 sc->cdev = make_dev(&ams_cdevsw, device_get_unit(dev),
237 UID_ROOT, GID_OPERATOR, 0644, "ams%d",
238 device_get_unit(dev));
239 sc->cdev->si_drv1 = sc;
241 adb_set_autopoll(dev,1);
247 adb_mouse_detach(device_t dev)
249 struct adb_mouse_softc *sc;
251 adb_set_autopoll(dev,0);
253 sc = device_get_softc(dev);
254 destroy_dev(sc->cdev);
256 mtx_destroy(&sc->sc_mtx);
257 cv_destroy(&sc->sc_cv);
263 adb_mouse_receive_packet(device_t dev, u_char status, u_char command,
264 u_char reg, int len, u_char *data)
266 struct adb_mouse_softc *sc;
271 sc = device_get_softc(dev);
273 if (command != ADB_COMMAND_TALK || reg != 0 || len < 2)
276 ydelta = data[0] & 0x7f;
277 xdelta = data[1] & 0x7f;
280 buttons |= !(data[0] & 0x80);
281 buttons |= !(data[1] & 0x80) << 1;
283 if (sc->flags & AMS_EXTENDED) {
284 for (i = 2; i < len && i < 5; i++) {
285 xdelta |= (data[i] & 0x07) << (3*i + 1);
286 ydelta |= (data[i] & 0x70) << (3*i - 3);
288 buttons |= !(data[i] & 0x08) << (2*i - 2);
289 buttons |= !(data[i] & 0x80) << (2*i - 1);
292 len = 2; /* Ignore extra data */
295 /* Do sign extension as necessary */
296 if (xdelta & (0x40 << 3*(len-2)))
297 xdelta |= 0xffffffc0 << 3*(len - 2);
298 if (ydelta & (0x40 << 3*(len-2)))
299 ydelta |= 0xffffffc0 << 3*(len - 2);
302 * Some mice report high-numbered buttons on the wrong button number,
303 * so set the highest-numbered real button as pressed if there are
304 * mysterious high-numbered ones set.
306 * Don't do this for touchpads, because touchpads also trigger
307 * high button events when they are touched.
310 if (buttons & ~((1 << sc->hw.buttons) - 1)
311 && !(sc->flags & AMS_TOUCHPAD)) {
312 buttons |= 1 << (sc->hw.buttons - 1);
314 buttons &= (1 << sc->hw.buttons) - 1;
316 mtx_lock(&sc->sc_mtx);
318 /* Add in our new deltas, and take into account
319 Apple's opposite meaning for Y axis motion */
321 sc->xdelta += xdelta;
322 sc->ydelta -= ydelta;
324 sc->buttons = buttons;
326 mtx_unlock(&sc->sc_mtx);
328 cv_broadcast(&sc->sc_cv);
329 selwakeuppri(&sc->rsel, PZERO);
335 ams_open(struct cdev *dev, int flag, int fmt, struct thread *p)
337 struct adb_mouse_softc *sc;
339 sc = CDEV_GET_SOFTC(dev);
343 mtx_lock(&sc->sc_mtx);
344 sc->packet_read_len = 0;
348 mtx_unlock(&sc->sc_mtx);
354 ams_close(struct cdev *dev, int flag, int fmt, struct thread *p)
356 struct adb_mouse_softc *sc;
358 sc = CDEV_GET_SOFTC(dev);
360 cv_broadcast(&sc->sc_cv);
361 selwakeuppri(&sc->rsel, PZERO);
366 ams_poll(struct cdev *dev, int events, struct thread *p)
368 struct adb_mouse_softc *sc;
370 sc = CDEV_GET_SOFTC(dev);
374 if (events & (POLLIN | POLLRDNORM)) {
375 mtx_lock(&sc->sc_mtx);
377 if (sc->xdelta == 0 && sc->ydelta == 0 &&
378 sc->buttons == sc->last_buttons) {
379 selrecord(p, &sc->rsel);
382 events &= (POLLIN | POLLRDNORM);
385 mtx_unlock(&sc->sc_mtx);
392 ams_read(struct cdev *dev, struct uio *uio, int flag)
394 struct adb_mouse_softc *sc;
399 sc = CDEV_GET_SOFTC(dev);
403 if (uio->uio_resid <= 0)
406 mtx_lock(&sc->sc_mtx);
408 if (!sc->packet_read_len) {
409 if (sc->xdelta == 0 && sc->ydelta == 0 &&
410 sc->buttons == sc->last_buttons) {
412 if (flag & O_NONBLOCK) {
413 mtx_unlock(&sc->sc_mtx);
418 /* Otherwise, block on new data */
419 error = cv_wait_sig(&sc->sc_cv, &sc->sc_mtx);
421 mtx_unlock(&sc->sc_mtx);
426 sc->packet[0] = 1 << 7;
427 sc->packet[0] |= (!(sc->buttons & 1)) << 2;
428 sc->packet[0] |= (!(sc->buttons & 4)) << 1;
429 sc->packet[0] |= (!(sc->buttons & 2));
431 if (sc->xdelta > 127) {
433 sc->packet[3] = sc->xdelta - 127;
434 } else if (sc->xdelta < -127) {
435 sc->packet[1] = -127;
436 sc->packet[3] = sc->xdelta + 127;
438 sc->packet[1] = sc->xdelta;
442 if (sc->ydelta > 127) {
444 sc->packet[4] = sc->ydelta - 127;
445 } else if (sc->ydelta < -127) {
446 sc->packet[2] = -127;
447 sc->packet[4] = sc->ydelta + 127;
449 sc->packet[2] = sc->ydelta;
457 sc->packet[7] = ~((uint8_t)(sc->buttons >> 3)) & 0x7f;
460 sc->last_buttons = sc->buttons;
464 sc->packet_read_len = sc->mode.packetsize;
467 len = (sc->packet_read_len > uio->uio_resid) ?
468 uio->uio_resid : sc->packet_read_len;
470 memcpy(outpacket,sc->packet +
471 (sc->mode.packetsize - sc->packet_read_len),len);
472 sc->packet_read_len -= len;
474 mtx_unlock(&sc->sc_mtx);
476 uiomove(outpacket,len,uio);
483 ams_ioctl(struct cdev *dev, u_long cmd, caddr_t addr, int flag,
486 struct adb_mouse_softc *sc;
489 sc = CDEV_GET_SOFTC(dev);
494 case MOUSE_GETHWINFO:
495 *(mousehw_t *)addr = sc->hw;
498 *(mousemode_t *)addr = sc->mode;
501 mode = *(mousemode_t *)addr;
502 addr = (caddr_t)&mode.level;
507 if (*(int *)addr == -1)
509 else if (*(int *)addr == 1) {
511 sc->mode.packetsize = 8;
513 } else if (*(int *)addr == 0) {
515 sc->mode.packetsize = 5;
521 *(int *)addr = sc->mode.level;
524 case MOUSE_GETSTATUS: {
525 mousestatus_t *status = (mousestatus_t *) addr;
527 mtx_lock(&sc->sc_mtx);
529 status->button = sc->buttons;
530 status->obutton = sc->last_buttons;
532 status->flags = status->button ^ status->obutton;
534 if (sc->xdelta != 0 || sc->ydelta)
535 status->flags |= MOUSE_POSCHANGED;
536 if (status->button != status->obutton)
537 status->flags |= MOUSE_BUTTONSCHANGED;
539 status->dx = sc->xdelta;
540 status->dy = sc->ydelta;
545 sc->last_buttons = sc->buttons;
547 mtx_unlock(&sc->sc_mtx);