1b4dbc599SNathan Whitehorn /*- 2b4dbc599SNathan Whitehorn * Copyright (C) 2008 Nathan Whitehorn 3b4dbc599SNathan Whitehorn * All rights reserved. 4b4dbc599SNathan Whitehorn * 5b4dbc599SNathan Whitehorn * Redistribution and use in source and binary forms, with or without 6b4dbc599SNathan Whitehorn * modification, are permitted provided that the following conditions 7b4dbc599SNathan Whitehorn * are met: 8b4dbc599SNathan Whitehorn * 1. Redistributions of source code must retain the above copyright 9b4dbc599SNathan Whitehorn * notice, this list of conditions and the following disclaimer. 10b4dbc599SNathan Whitehorn * 2. Redistributions in binary form must reproduce the above copyright 11b4dbc599SNathan Whitehorn * notice, this list of conditions and the following disclaimer in the 12b4dbc599SNathan Whitehorn * documentation and/or other materials provided with the distribution. 13b4dbc599SNathan Whitehorn * 14b4dbc599SNathan Whitehorn * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR 15b4dbc599SNathan Whitehorn * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES 16b4dbc599SNathan Whitehorn * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 17b4dbc599SNathan Whitehorn * IN NO EVENT SHALL TOOLS GMBH BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, 18b4dbc599SNathan Whitehorn * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, 19b4dbc599SNathan Whitehorn * PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; 20b4dbc599SNathan Whitehorn * OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, 21b4dbc599SNathan Whitehorn * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR 22b4dbc599SNathan Whitehorn * OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF 23b4dbc599SNathan Whitehorn * ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 24b4dbc599SNathan Whitehorn * 25b4dbc599SNathan Whitehorn * $FreeBSD$ 26b4dbc599SNathan Whitehorn */ 27b4dbc599SNathan Whitehorn 28b4dbc599SNathan Whitehorn #include <sys/cdefs.h> 29b4dbc599SNathan Whitehorn #include <sys/param.h> 30b4dbc599SNathan Whitehorn #include <sys/systm.h> 31b4dbc599SNathan Whitehorn #include <sys/module.h> 32b4dbc599SNathan Whitehorn #include <sys/bus.h> 33b4dbc599SNathan Whitehorn #include <sys/conf.h> 34b4dbc599SNathan Whitehorn #include <sys/mouse.h> 35b4dbc599SNathan Whitehorn #include <sys/poll.h> 36b4dbc599SNathan Whitehorn #include <sys/condvar.h> 37b4dbc599SNathan Whitehorn #include <sys/selinfo.h> 38b4dbc599SNathan Whitehorn #include <sys/uio.h> 39b4dbc599SNathan Whitehorn #include <sys/fcntl.h> 40b4dbc599SNathan Whitehorn #include <sys/kernel.h> 41b4dbc599SNathan Whitehorn 42b4dbc599SNathan Whitehorn #include <machine/bus.h> 43b4dbc599SNathan Whitehorn 44b4dbc599SNathan Whitehorn #include <vm/vm.h> 45b4dbc599SNathan Whitehorn #include <vm/pmap.h> 46b4dbc599SNathan Whitehorn 47b4dbc599SNathan Whitehorn #include "adb.h" 48b4dbc599SNathan Whitehorn 49b4dbc599SNathan Whitehorn #define CDEV_GET_SOFTC(x) devclass_get_softc(adb_mouse_devclass, minor(x) & 0x1f) 50b4dbc599SNathan Whitehorn 51b4dbc599SNathan Whitehorn static int adb_mouse_probe(device_t dev); 52b4dbc599SNathan Whitehorn static int adb_mouse_attach(device_t dev); 53b4dbc599SNathan Whitehorn static int adb_mouse_detach(device_t dev); 54b4dbc599SNathan Whitehorn 55b4dbc599SNathan Whitehorn static d_open_t ams_open; 56b4dbc599SNathan Whitehorn static d_close_t ams_close; 57b4dbc599SNathan Whitehorn static d_read_t ams_read; 58b4dbc599SNathan Whitehorn static d_ioctl_t ams_ioctl; 59b4dbc599SNathan Whitehorn static d_poll_t ams_poll; 60b4dbc599SNathan Whitehorn 61b4dbc599SNathan Whitehorn static u_int adb_mouse_receive_packet(device_t dev, u_char status, 62b4dbc599SNathan Whitehorn u_char command, u_char reg, int len, u_char *data); 63b4dbc599SNathan Whitehorn 64b4dbc599SNathan Whitehorn struct adb_mouse_softc { 65b4dbc599SNathan Whitehorn device_t sc_dev; 66b4dbc599SNathan Whitehorn 67b4dbc599SNathan Whitehorn struct mtx sc_mtx; 68b4dbc599SNathan Whitehorn struct cv sc_cv; 69b4dbc599SNathan Whitehorn 703c5f535bSEd Schouten int flags; 713c5f535bSEd Schouten #define AMS_EXTENDED 0x1 723c5f535bSEd Schouten #define AMS_TOUCHPAD 0x2 73b4dbc599SNathan Whitehorn uint16_t dpi; 74b4dbc599SNathan Whitehorn 75b4dbc599SNathan Whitehorn mousehw_t hw; 76b4dbc599SNathan Whitehorn mousemode_t mode; 77b4dbc599SNathan Whitehorn u_char id[4]; 78b4dbc599SNathan Whitehorn 79b4dbc599SNathan Whitehorn int buttons; 80b4dbc599SNathan Whitehorn int last_buttons; 81b4dbc599SNathan Whitehorn int xdelta, ydelta; 82b4dbc599SNathan Whitehorn 83b4dbc599SNathan Whitehorn int8_t packet[8]; 84b4dbc599SNathan Whitehorn size_t packet_read_len; 85b4dbc599SNathan Whitehorn 86b4dbc599SNathan Whitehorn struct cdev *cdev; 87b4dbc599SNathan Whitehorn struct selinfo rsel; 88b4dbc599SNathan Whitehorn }; 89b4dbc599SNathan Whitehorn 90b4dbc599SNathan Whitehorn static device_method_t adb_mouse_methods[] = { 91b4dbc599SNathan Whitehorn /* Device interface */ 92b4dbc599SNathan Whitehorn DEVMETHOD(device_probe, adb_mouse_probe), 93b4dbc599SNathan Whitehorn DEVMETHOD(device_attach, adb_mouse_attach), 94b4dbc599SNathan Whitehorn DEVMETHOD(device_detach, adb_mouse_detach), 95b4dbc599SNathan Whitehorn DEVMETHOD(device_shutdown, bus_generic_shutdown), 96b4dbc599SNathan Whitehorn DEVMETHOD(device_suspend, bus_generic_suspend), 97b4dbc599SNathan Whitehorn DEVMETHOD(device_resume, bus_generic_resume), 98b4dbc599SNathan Whitehorn 99b4dbc599SNathan Whitehorn /* ADB interface */ 100b4dbc599SNathan Whitehorn DEVMETHOD(adb_receive_packet, adb_mouse_receive_packet), 101b4dbc599SNathan Whitehorn 102b4dbc599SNathan Whitehorn { 0, 0 } 103b4dbc599SNathan Whitehorn }; 104b4dbc599SNathan Whitehorn 105b4dbc599SNathan Whitehorn static driver_t adb_mouse_driver = { 106b4dbc599SNathan Whitehorn "ams", 107b4dbc599SNathan Whitehorn adb_mouse_methods, 108b4dbc599SNathan Whitehorn sizeof(struct adb_mouse_softc), 109b4dbc599SNathan Whitehorn }; 110b4dbc599SNathan Whitehorn 111b4dbc599SNathan Whitehorn static devclass_t adb_mouse_devclass; 112b4dbc599SNathan Whitehorn 113b4dbc599SNathan Whitehorn DRIVER_MODULE(ams, adb, adb_mouse_driver, adb_mouse_devclass, 0, 0); 114b4dbc599SNathan Whitehorn 115b4dbc599SNathan Whitehorn static struct cdevsw ams_cdevsw = { 116b4dbc599SNathan Whitehorn .d_version = D_VERSION, 117b4dbc599SNathan Whitehorn .d_flags = 0, 118b4dbc599SNathan Whitehorn .d_open = ams_open, 119b4dbc599SNathan Whitehorn .d_close = ams_close, 120b4dbc599SNathan Whitehorn .d_read = ams_read, 121b4dbc599SNathan Whitehorn .d_ioctl = ams_ioctl, 122b4dbc599SNathan Whitehorn .d_poll = ams_poll, 123b4dbc599SNathan Whitehorn .d_name = "ams", 124b4dbc599SNathan Whitehorn }; 125b4dbc599SNathan Whitehorn 126b4dbc599SNathan Whitehorn static int 127b4dbc599SNathan Whitehorn adb_mouse_probe(device_t dev) 128b4dbc599SNathan Whitehorn { 129b4dbc599SNathan Whitehorn uint8_t type; 130b4dbc599SNathan Whitehorn 131b4dbc599SNathan Whitehorn type = adb_get_device_type(dev); 132b4dbc599SNathan Whitehorn 133b4dbc599SNathan Whitehorn if (type != ADB_DEVICE_MOUSE) 134b4dbc599SNathan Whitehorn return (ENXIO); 135b4dbc599SNathan Whitehorn 136b4dbc599SNathan Whitehorn device_set_desc(dev,"ADB Mouse"); 137b4dbc599SNathan Whitehorn return (0); 138b4dbc599SNathan Whitehorn } 139b4dbc599SNathan Whitehorn 140b4dbc599SNathan Whitehorn static int 141b4dbc599SNathan Whitehorn adb_mouse_attach(device_t dev) 142b4dbc599SNathan Whitehorn { 143b4dbc599SNathan Whitehorn struct adb_mouse_softc *sc; 144b4dbc599SNathan Whitehorn char *description = "Unknown Pointing Device"; 145b4dbc599SNathan Whitehorn 146b4dbc599SNathan Whitehorn size_t r1_len; 147b4dbc599SNathan Whitehorn u_char r1[8]; 148b4dbc599SNathan Whitehorn 149b4dbc599SNathan Whitehorn sc = device_get_softc(dev); 150b4dbc599SNathan Whitehorn sc->sc_dev = dev; 151b4dbc599SNathan Whitehorn 152b4dbc599SNathan Whitehorn mtx_init(&sc->sc_mtx,"ams",MTX_DEF,0); 153b4dbc599SNathan Whitehorn cv_init(&sc->sc_cv,"ams"); 154b4dbc599SNathan Whitehorn 1553c5f535bSEd Schouten sc->flags = 0; 156b4dbc599SNathan Whitehorn 157b4dbc599SNathan Whitehorn sc->hw.buttons = 2; 158b4dbc599SNathan Whitehorn sc->hw.iftype = MOUSE_IF_UNKNOWN; 159b4dbc599SNathan Whitehorn sc->hw.type = MOUSE_UNKNOWN; 160b4dbc599SNathan Whitehorn sc->hw.model = sc->hw.hwid = 0; 161b4dbc599SNathan Whitehorn 162b4dbc599SNathan Whitehorn sc->mode.protocol = MOUSE_PROTO_SYSMOUSE; 163b4dbc599SNathan Whitehorn sc->mode.rate = -1; 164b4dbc599SNathan Whitehorn sc->mode.resolution = 100; 165b4dbc599SNathan Whitehorn sc->mode.accelfactor = 0; 166b4dbc599SNathan Whitehorn sc->mode.level = 0; 167b4dbc599SNathan Whitehorn sc->mode.packetsize = 5; 168b4dbc599SNathan Whitehorn 169b4dbc599SNathan Whitehorn sc->buttons = 0; 170b4dbc599SNathan Whitehorn sc->last_buttons = 0; 171b4dbc599SNathan Whitehorn sc->packet_read_len = 0; 172b4dbc599SNathan Whitehorn 173b4dbc599SNathan Whitehorn /* Try to switch to extended protocol */ 174b4dbc599SNathan Whitehorn adb_set_device_handler(dev,4); 175b4dbc599SNathan Whitehorn 176b4dbc599SNathan Whitehorn switch(adb_get_device_handler(dev)) { 177b4dbc599SNathan Whitehorn case 1: 178b4dbc599SNathan Whitehorn sc->mode.resolution = 100; 179b4dbc599SNathan Whitehorn break; 180b4dbc599SNathan Whitehorn case 2: 181b4dbc599SNathan Whitehorn sc->mode.resolution = 200; 182b4dbc599SNathan Whitehorn break; 183b4dbc599SNathan Whitehorn case 4: 184582434bdSNathan Whitehorn r1_len = adb_read_register(dev,1,r1); 185b4dbc599SNathan Whitehorn if (r1_len < 8) 186b4dbc599SNathan Whitehorn break; 187b4dbc599SNathan Whitehorn 1883c5f535bSEd Schouten sc->flags |= AMS_EXTENDED; 189b4dbc599SNathan Whitehorn memcpy(&sc->hw.hwid,r1,4); 190b4dbc599SNathan Whitehorn sc->mode.resolution = (r1[4] << 8) | r1[5]; 191b4dbc599SNathan Whitehorn 192b4dbc599SNathan Whitehorn switch (r1[6]) { 193b4dbc599SNathan Whitehorn case 0: 194b4dbc599SNathan Whitehorn sc->hw.type = MOUSE_PAD; 195b4dbc599SNathan Whitehorn description = "Tablet"; 196b4dbc599SNathan Whitehorn break; 197b4dbc599SNathan Whitehorn case 1: 198b4dbc599SNathan Whitehorn sc->hw.type = MOUSE_MOUSE; 199b4dbc599SNathan Whitehorn description = "Mouse"; 200b4dbc599SNathan Whitehorn break; 201b4dbc599SNathan Whitehorn case 2: 202b4dbc599SNathan Whitehorn sc->hw.type = MOUSE_TRACKBALL; 203b4dbc599SNathan Whitehorn description = "Trackball"; 204b4dbc599SNathan Whitehorn break; 2053c5f535bSEd Schouten case 3: 2063c5f535bSEd Schouten sc->flags |= AMS_TOUCHPAD; 2073c5f535bSEd Schouten sc->hw.type = MOUSE_PAD; 2083c5f535bSEd Schouten description = "Touchpad"; 2093c5f535bSEd Schouten break; 210b4dbc599SNathan Whitehorn } 211b4dbc599SNathan Whitehorn 212b4dbc599SNathan Whitehorn sc->hw.buttons = r1[7]; 213b4dbc599SNathan Whitehorn 214b4dbc599SNathan Whitehorn device_printf(dev,"%d-button %d-dpi %s\n", 215b4dbc599SNathan Whitehorn sc->hw.buttons, sc->mode.resolution,description); 216b4dbc599SNathan Whitehorn 217b4dbc599SNathan Whitehorn /* 218b4dbc599SNathan Whitehorn * Check for one of MacAlly's non-compliant 2-button mice. 219b4dbc599SNathan Whitehorn * These claim to speak the extended mouse protocol, but 220b4dbc599SNathan Whitehorn * instead speak the standard protocol and only when their 221b4dbc599SNathan Whitehorn * handler is set to 0x42. 222b4dbc599SNathan Whitehorn */ 223b4dbc599SNathan Whitehorn 224b4dbc599SNathan Whitehorn if (sc->hw.hwid == 0x4b4f4954) { 225b4dbc599SNathan Whitehorn adb_set_device_handler(dev,0x42); 226b4dbc599SNathan Whitehorn 227b4dbc599SNathan Whitehorn if (adb_get_device_handler(dev) == 0x42) { 228b4dbc599SNathan Whitehorn device_printf(dev, "MacAlly 2-Button Mouse\n"); 2293c5f535bSEd Schouten sc->flags &= ~AMS_EXTENDED; 230b4dbc599SNathan Whitehorn } 231b4dbc599SNathan Whitehorn } 232b4dbc599SNathan Whitehorn 233b4dbc599SNathan Whitehorn break; 234b4dbc599SNathan Whitehorn } 235b4dbc599SNathan Whitehorn 236b4dbc599SNathan Whitehorn sc->cdev = make_dev(&ams_cdevsw, device_get_unit(dev), 237b4dbc599SNathan Whitehorn UID_ROOT, GID_OPERATOR, 0644, "ams%d", 238b4dbc599SNathan Whitehorn device_get_unit(dev)); 239b4dbc599SNathan Whitehorn 240b4dbc599SNathan Whitehorn adb_set_autopoll(dev,1); 241b4dbc599SNathan Whitehorn 242b4dbc599SNathan Whitehorn return (0); 243b4dbc599SNathan Whitehorn } 244b4dbc599SNathan Whitehorn 245b4dbc599SNathan Whitehorn static int 246b4dbc599SNathan Whitehorn adb_mouse_detach(device_t dev) 247b4dbc599SNathan Whitehorn { 248b4dbc599SNathan Whitehorn struct adb_mouse_softc *sc; 249b4dbc599SNathan Whitehorn 250b4dbc599SNathan Whitehorn adb_set_autopoll(dev,0); 251b4dbc599SNathan Whitehorn 252b4dbc599SNathan Whitehorn sc = device_get_softc(dev); 253b4dbc599SNathan Whitehorn destroy_dev(sc->cdev); 254b4dbc599SNathan Whitehorn 255b4dbc599SNathan Whitehorn mtx_destroy(&sc->sc_mtx); 256b4dbc599SNathan Whitehorn cv_destroy(&sc->sc_cv); 257b4dbc599SNathan Whitehorn 258b4dbc599SNathan Whitehorn return (0); 259b4dbc599SNathan Whitehorn } 260b4dbc599SNathan Whitehorn 261b4dbc599SNathan Whitehorn static u_int 262b4dbc599SNathan Whitehorn adb_mouse_receive_packet(device_t dev, u_char status, u_char command, 263b4dbc599SNathan Whitehorn u_char reg, int len, u_char *data) 264b4dbc599SNathan Whitehorn { 265b4dbc599SNathan Whitehorn struct adb_mouse_softc *sc; 266b4dbc599SNathan Whitehorn int i = 0; 267b4dbc599SNathan Whitehorn int xdelta, ydelta; 268b4dbc599SNathan Whitehorn int buttons; 269b4dbc599SNathan Whitehorn 270b4dbc599SNathan Whitehorn sc = device_get_softc(dev); 271b4dbc599SNathan Whitehorn 272b4dbc599SNathan Whitehorn if (command != ADB_COMMAND_TALK || reg != 0 || len < 2) 273b4dbc599SNathan Whitehorn return (0); 274b4dbc599SNathan Whitehorn 275b4dbc599SNathan Whitehorn ydelta = data[0] & 0x7f; 276b4dbc599SNathan Whitehorn xdelta = data[1] & 0x7f; 277b4dbc599SNathan Whitehorn 278b4dbc599SNathan Whitehorn buttons = 0; 279b4dbc599SNathan Whitehorn buttons |= !(data[0] & 0x80); 280b4dbc599SNathan Whitehorn buttons |= !(data[1] & 0x80) << 1; 281b4dbc599SNathan Whitehorn 2823c5f535bSEd Schouten if (sc->flags & AMS_EXTENDED) { 283b4dbc599SNathan Whitehorn for (i = 2; i < len && i < 5; i++) { 284b4dbc599SNathan Whitehorn xdelta |= (data[i] & 0x07) << (3*i + 1); 285b4dbc599SNathan Whitehorn ydelta |= (data[i] & 0x70) << (3*i - 3); 286b4dbc599SNathan Whitehorn 287b4dbc599SNathan Whitehorn buttons |= !(data[i] & 0x08) << (2*i - 2); 288b4dbc599SNathan Whitehorn buttons |= !(data[i] & 0x80) << (2*i - 1); 289b4dbc599SNathan Whitehorn } 290b4dbc599SNathan Whitehorn } else { 291b4dbc599SNathan Whitehorn len = 2; /* Ignore extra data */ 292b4dbc599SNathan Whitehorn } 293b4dbc599SNathan Whitehorn 294b4dbc599SNathan Whitehorn /* Do sign extension as necessary */ 295b4dbc599SNathan Whitehorn if (xdelta & (0x40 << 3*(len-2))) 296b4dbc599SNathan Whitehorn xdelta |= 0xffffffc0 << 3*(len - 2); 297b4dbc599SNathan Whitehorn if (ydelta & (0x40 << 3*(len-2))) 298b4dbc599SNathan Whitehorn ydelta |= 0xffffffc0 << 3*(len - 2); 299b4dbc599SNathan Whitehorn 300b4dbc599SNathan Whitehorn /* 301b4dbc599SNathan Whitehorn * Some mice report high-numbered buttons on the wrong button number, 302b4dbc599SNathan Whitehorn * so set the highest-numbered real button as pressed if there are 303b4dbc599SNathan Whitehorn * mysterious high-numbered ones set. 3043c5f535bSEd Schouten * 3053c5f535bSEd Schouten * Don't do this for touchpads, because touchpads also trigger 3063c5f535bSEd Schouten * high button events when they are touched. 307b4dbc599SNathan Whitehorn */ 308b4dbc599SNathan Whitehorn 3093c5f535bSEd Schouten if (buttons & ~((1 << sc->hw.buttons) - 1) 3103c5f535bSEd Schouten && !(sc->flags & AMS_TOUCHPAD)) { 311b4dbc599SNathan Whitehorn buttons |= 1 << (sc->hw.buttons - 1); 312b4dbc599SNathan Whitehorn } 3133c5f535bSEd Schouten buttons &= (1 << sc->hw.buttons) - 1; 314b4dbc599SNathan Whitehorn 315b4dbc599SNathan Whitehorn mtx_lock(&sc->sc_mtx); 316b4dbc599SNathan Whitehorn 317b4dbc599SNathan Whitehorn /* Add in our new deltas, and take into account 318b4dbc599SNathan Whitehorn Apple's opposite meaning for Y axis motion */ 319b4dbc599SNathan Whitehorn 320b4dbc599SNathan Whitehorn sc->xdelta += xdelta; 321b4dbc599SNathan Whitehorn sc->ydelta -= ydelta; 322b4dbc599SNathan Whitehorn 323b4dbc599SNathan Whitehorn sc->buttons = buttons; 324b4dbc599SNathan Whitehorn 325b4dbc599SNathan Whitehorn mtx_unlock(&sc->sc_mtx); 326b4dbc599SNathan Whitehorn 327b4dbc599SNathan Whitehorn cv_broadcast(&sc->sc_cv); 328b4dbc599SNathan Whitehorn selwakeuppri(&sc->rsel, PZERO); 329b4dbc599SNathan Whitehorn 330b4dbc599SNathan Whitehorn return (0); 331b4dbc599SNathan Whitehorn } 332b4dbc599SNathan Whitehorn 333b4dbc599SNathan Whitehorn static int 334b4dbc599SNathan Whitehorn ams_open(struct cdev *dev, int flag, int fmt, struct thread *p) 335b4dbc599SNathan Whitehorn { 336b4dbc599SNathan Whitehorn struct adb_mouse_softc *sc; 337b4dbc599SNathan Whitehorn 338b4dbc599SNathan Whitehorn sc = CDEV_GET_SOFTC(dev); 339b4dbc599SNathan Whitehorn if (sc == NULL) 340b4dbc599SNathan Whitehorn return (ENXIO); 341b4dbc599SNathan Whitehorn 342b4dbc599SNathan Whitehorn mtx_lock(&sc->sc_mtx); 343b4dbc599SNathan Whitehorn sc->packet_read_len = 0; 344b4dbc599SNathan Whitehorn sc->xdelta = 0; 345b4dbc599SNathan Whitehorn sc->ydelta = 0; 346b4dbc599SNathan Whitehorn sc->buttons = 0; 347b4dbc599SNathan Whitehorn mtx_unlock(&sc->sc_mtx); 348b4dbc599SNathan Whitehorn 349b4dbc599SNathan Whitehorn return (0); 350b4dbc599SNathan Whitehorn } 351b4dbc599SNathan Whitehorn 352b4dbc599SNathan Whitehorn static int 353b4dbc599SNathan Whitehorn ams_close(struct cdev *dev, int flag, int fmt, struct thread *p) 354b4dbc599SNathan Whitehorn { 355b4dbc599SNathan Whitehorn struct adb_mouse_softc *sc; 356b4dbc599SNathan Whitehorn 357b4dbc599SNathan Whitehorn sc = CDEV_GET_SOFTC(dev); 358b4dbc599SNathan Whitehorn 359b4dbc599SNathan Whitehorn cv_broadcast(&sc->sc_cv); 360b4dbc599SNathan Whitehorn selwakeuppri(&sc->rsel, PZERO); 361b4dbc599SNathan Whitehorn return (0); 362b4dbc599SNathan Whitehorn } 363b4dbc599SNathan Whitehorn 364b4dbc599SNathan Whitehorn static int 365b4dbc599SNathan Whitehorn ams_poll(struct cdev *dev, int events, struct thread *p) 366b4dbc599SNathan Whitehorn { 367b4dbc599SNathan Whitehorn struct adb_mouse_softc *sc; 368b4dbc599SNathan Whitehorn 369b4dbc599SNathan Whitehorn sc = CDEV_GET_SOFTC(dev); 370b4dbc599SNathan Whitehorn if (sc == NULL) 371b4dbc599SNathan Whitehorn return (EIO); 372b4dbc599SNathan Whitehorn 373b4dbc599SNathan Whitehorn if (events & (POLLIN | POLLRDNORM)) { 374b4dbc599SNathan Whitehorn mtx_lock(&sc->sc_mtx); 375b4dbc599SNathan Whitehorn 376b4dbc599SNathan Whitehorn if (sc->xdelta == 0 && sc->ydelta == 0 && 377b4dbc599SNathan Whitehorn sc->buttons == sc->last_buttons) { 378b4dbc599SNathan Whitehorn selrecord(p, &sc->rsel); 379b4dbc599SNathan Whitehorn events = 0; 380b4dbc599SNathan Whitehorn } else { 381b4dbc599SNathan Whitehorn events &= (POLLIN | POLLRDNORM); 382b4dbc599SNathan Whitehorn } 383b4dbc599SNathan Whitehorn 384b4dbc599SNathan Whitehorn mtx_unlock(&sc->sc_mtx); 385b4dbc599SNathan Whitehorn } 386b4dbc599SNathan Whitehorn 387b4dbc599SNathan Whitehorn return events; 388b4dbc599SNathan Whitehorn } 389b4dbc599SNathan Whitehorn 390b4dbc599SNathan Whitehorn static int 391b4dbc599SNathan Whitehorn ams_read(struct cdev *dev, struct uio *uio, int flag) 392b4dbc599SNathan Whitehorn { 393b4dbc599SNathan Whitehorn struct adb_mouse_softc *sc; 394b4dbc599SNathan Whitehorn size_t len; 395b4dbc599SNathan Whitehorn int8_t outpacket[8]; 396b75d1970SEd Schouten int error; 397b4dbc599SNathan Whitehorn 398b4dbc599SNathan Whitehorn sc = CDEV_GET_SOFTC(dev); 399b4dbc599SNathan Whitehorn if (sc == NULL) 400b4dbc599SNathan Whitehorn return (EIO); 401b4dbc599SNathan Whitehorn 402b4dbc599SNathan Whitehorn if (uio->uio_resid <= 0) 403b4dbc599SNathan Whitehorn return (0); 404b4dbc599SNathan Whitehorn 405b4dbc599SNathan Whitehorn mtx_lock(&sc->sc_mtx); 406b4dbc599SNathan Whitehorn 407b4dbc599SNathan Whitehorn if (!sc->packet_read_len) { 408b4dbc599SNathan Whitehorn if (sc->xdelta == 0 && sc->ydelta == 0 && 409b4dbc599SNathan Whitehorn sc->buttons == sc->last_buttons) { 410b4dbc599SNathan Whitehorn 411b4dbc599SNathan Whitehorn if (flag & O_NONBLOCK) { 412b4dbc599SNathan Whitehorn mtx_unlock(&sc->sc_mtx); 413b4dbc599SNathan Whitehorn return EWOULDBLOCK; 414b4dbc599SNathan Whitehorn } 415b4dbc599SNathan Whitehorn 416b4dbc599SNathan Whitehorn 417b4dbc599SNathan Whitehorn /* Otherwise, block on new data */ 418b75d1970SEd Schouten error = cv_wait_sig(&sc->sc_cv, &sc->sc_mtx); 419b75d1970SEd Schouten if (error) { 420b75d1970SEd Schouten mtx_unlock(&sc->sc_mtx); 421b75d1970SEd Schouten return (error); 422b75d1970SEd Schouten } 423b4dbc599SNathan Whitehorn } 424b4dbc599SNathan Whitehorn 425b4dbc599SNathan Whitehorn sc->packet[0] = 1 << 7; 426b4dbc599SNathan Whitehorn sc->packet[0] |= (!(sc->buttons & 1)) << 2; 427b4dbc599SNathan Whitehorn sc->packet[0] |= (!(sc->buttons & 4)) << 1; 428b4dbc599SNathan Whitehorn sc->packet[0] |= (!(sc->buttons & 2)); 429b4dbc599SNathan Whitehorn 430b4dbc599SNathan Whitehorn if (sc->xdelta > 127) { 431b4dbc599SNathan Whitehorn sc->packet[1] = 127; 432b4dbc599SNathan Whitehorn sc->packet[3] = sc->xdelta - 127; 433b4dbc599SNathan Whitehorn } else if (sc->xdelta < -127) { 434b4dbc599SNathan Whitehorn sc->packet[1] = -127; 435b4dbc599SNathan Whitehorn sc->packet[3] = sc->xdelta + 127; 436b4dbc599SNathan Whitehorn } else { 437b4dbc599SNathan Whitehorn sc->packet[1] = sc->xdelta; 438b4dbc599SNathan Whitehorn sc->packet[3] = 0; 439b4dbc599SNathan Whitehorn } 440b4dbc599SNathan Whitehorn 441b4dbc599SNathan Whitehorn if (sc->ydelta > 127) { 442b4dbc599SNathan Whitehorn sc->packet[2] = 127; 443b4dbc599SNathan Whitehorn sc->packet[4] = sc->ydelta - 127; 444b4dbc599SNathan Whitehorn } else if (sc->ydelta < -127) { 445b4dbc599SNathan Whitehorn sc->packet[2] = -127; 446b4dbc599SNathan Whitehorn sc->packet[4] = sc->ydelta + 127; 447b4dbc599SNathan Whitehorn } else { 448b4dbc599SNathan Whitehorn sc->packet[2] = sc->ydelta; 449b4dbc599SNathan Whitehorn sc->packet[4] = 0; 450b4dbc599SNathan Whitehorn } 451b4dbc599SNathan Whitehorn 452b4dbc599SNathan Whitehorn /* No Z movement */ 453b4dbc599SNathan Whitehorn sc->packet[5] = 0; 454b4dbc599SNathan Whitehorn sc->packet[6] = 0; 455b4dbc599SNathan Whitehorn 456b4dbc599SNathan Whitehorn sc->packet[7] = ~((uint8_t)(sc->buttons >> 3)) & 0x7f; 457b4dbc599SNathan Whitehorn 458b4dbc599SNathan Whitehorn 459b4dbc599SNathan Whitehorn sc->last_buttons = sc->buttons; 460b4dbc599SNathan Whitehorn sc->xdelta = 0; 461b4dbc599SNathan Whitehorn sc->ydelta = 0; 462b4dbc599SNathan Whitehorn 463b4dbc599SNathan Whitehorn sc->packet_read_len = sc->mode.packetsize; 464b4dbc599SNathan Whitehorn } 465b4dbc599SNathan Whitehorn 466b4dbc599SNathan Whitehorn len = (sc->packet_read_len > uio->uio_resid) ? 467b4dbc599SNathan Whitehorn uio->uio_resid : sc->packet_read_len; 468b4dbc599SNathan Whitehorn 469b4dbc599SNathan Whitehorn memcpy(outpacket,sc->packet + 470b4dbc599SNathan Whitehorn (sc->mode.packetsize - sc->packet_read_len),len); 471b4dbc599SNathan Whitehorn sc->packet_read_len -= len; 472b4dbc599SNathan Whitehorn 473b4dbc599SNathan Whitehorn mtx_unlock(&sc->sc_mtx); 474b4dbc599SNathan Whitehorn 475b4dbc599SNathan Whitehorn uiomove(outpacket,len,uio); 476b4dbc599SNathan Whitehorn 477b4dbc599SNathan Whitehorn return (0); 478b4dbc599SNathan Whitehorn } 479b4dbc599SNathan Whitehorn 480b4dbc599SNathan Whitehorn 481b4dbc599SNathan Whitehorn static int 482b4dbc599SNathan Whitehorn ams_ioctl(struct cdev *dev, u_long cmd, caddr_t addr, int flag, 483b4dbc599SNathan Whitehorn struct thread *p) 484b4dbc599SNathan Whitehorn { 485b4dbc599SNathan Whitehorn struct adb_mouse_softc *sc; 486b4dbc599SNathan Whitehorn mousemode_t mode; 487b4dbc599SNathan Whitehorn 488b4dbc599SNathan Whitehorn sc = CDEV_GET_SOFTC(dev); 489b4dbc599SNathan Whitehorn if (sc == NULL) 490b4dbc599SNathan Whitehorn return (EIO); 491b4dbc599SNathan Whitehorn 492b4dbc599SNathan Whitehorn switch (cmd) { 493b4dbc599SNathan Whitehorn case MOUSE_GETHWINFO: 494b4dbc599SNathan Whitehorn *(mousehw_t *)addr = sc->hw; 495b4dbc599SNathan Whitehorn break; 496b4dbc599SNathan Whitehorn case MOUSE_GETMODE: 497b4dbc599SNathan Whitehorn *(mousemode_t *)addr = sc->mode; 498b4dbc599SNathan Whitehorn break; 499b4dbc599SNathan Whitehorn case MOUSE_SETMODE: 500b4dbc599SNathan Whitehorn mode = *(mousemode_t *)addr; 501b4dbc599SNathan Whitehorn addr = (caddr_t)&mode.level; 502b4dbc599SNathan Whitehorn 503b4dbc599SNathan Whitehorn /* Fallthrough */ 504b4dbc599SNathan Whitehorn 505b4dbc599SNathan Whitehorn case MOUSE_SETLEVEL: 506b4dbc599SNathan Whitehorn if (*(int *)addr == -1) 507b4dbc599SNathan Whitehorn break; 508b4dbc599SNathan Whitehorn else if (*(int *)addr == 1) { 509b4dbc599SNathan Whitehorn sc->mode.level = 1; 510b4dbc599SNathan Whitehorn sc->mode.packetsize = 8; 511b4dbc599SNathan Whitehorn break; 512b4dbc599SNathan Whitehorn } else if (*(int *)addr == 0) { 513b4dbc599SNathan Whitehorn sc->mode.level = 0; 514b4dbc599SNathan Whitehorn sc->mode.packetsize = 5; 515b4dbc599SNathan Whitehorn break; 516b4dbc599SNathan Whitehorn } 517b4dbc599SNathan Whitehorn 518b4dbc599SNathan Whitehorn return EINVAL; 519b4dbc599SNathan Whitehorn case MOUSE_GETLEVEL: 520b4dbc599SNathan Whitehorn *(int *)addr = sc->mode.level; 521b4dbc599SNathan Whitehorn break; 522b4dbc599SNathan Whitehorn 523b4dbc599SNathan Whitehorn case MOUSE_GETSTATUS: { 524b4dbc599SNathan Whitehorn mousestatus_t *status = (mousestatus_t *) addr; 525b4dbc599SNathan Whitehorn 526b4dbc599SNathan Whitehorn mtx_lock(&sc->sc_mtx); 527b4dbc599SNathan Whitehorn 528b4dbc599SNathan Whitehorn status->button = sc->buttons; 529b4dbc599SNathan Whitehorn status->obutton = sc->last_buttons; 530b4dbc599SNathan Whitehorn 531b4dbc599SNathan Whitehorn status->flags = status->button ^ status->obutton; 532b4dbc599SNathan Whitehorn 533b4dbc599SNathan Whitehorn if (sc->xdelta != 0 || sc->ydelta) 534b4dbc599SNathan Whitehorn status->flags |= MOUSE_POSCHANGED; 535b4dbc599SNathan Whitehorn if (status->button != status->obutton) 536b4dbc599SNathan Whitehorn status->flags |= MOUSE_BUTTONSCHANGED; 537b4dbc599SNathan Whitehorn 538b4dbc599SNathan Whitehorn status->dx = sc->xdelta; 539b4dbc599SNathan Whitehorn status->dy = sc->ydelta; 540b4dbc599SNathan Whitehorn status->dz = 0; 541b4dbc599SNathan Whitehorn 542b4dbc599SNathan Whitehorn sc->xdelta = 0; 543b4dbc599SNathan Whitehorn sc->ydelta = 0; 544b4dbc599SNathan Whitehorn sc->last_buttons = sc->buttons; 545b4dbc599SNathan Whitehorn 546b4dbc599SNathan Whitehorn mtx_unlock(&sc->sc_mtx); 547b4dbc599SNathan Whitehorn 548b4dbc599SNathan Whitehorn break; } 549b4dbc599SNathan Whitehorn default: 550b4dbc599SNathan Whitehorn return ENOTTY; 551b4dbc599SNathan Whitehorn } 552b4dbc599SNathan Whitehorn 553b4dbc599SNathan Whitehorn return (0); 554b4dbc599SNathan Whitehorn } 555b4dbc599SNathan Whitehorn 556