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 70b4dbc599SNathan Whitehorn int extended; 71b4dbc599SNathan Whitehorn uint16_t dpi; 72b4dbc599SNathan Whitehorn 73b4dbc599SNathan Whitehorn mousehw_t hw; 74b4dbc599SNathan Whitehorn mousemode_t mode; 75b4dbc599SNathan Whitehorn u_char id[4]; 76b4dbc599SNathan Whitehorn 77b4dbc599SNathan Whitehorn int buttons; 78b4dbc599SNathan Whitehorn int last_buttons; 79b4dbc599SNathan Whitehorn int xdelta, ydelta; 80b4dbc599SNathan Whitehorn 81b4dbc599SNathan Whitehorn int8_t packet[8]; 82b4dbc599SNathan Whitehorn size_t packet_read_len; 83b4dbc599SNathan Whitehorn 84b4dbc599SNathan Whitehorn struct cdev *cdev; 85b4dbc599SNathan Whitehorn struct selinfo rsel; 86b4dbc599SNathan Whitehorn }; 87b4dbc599SNathan Whitehorn 88b4dbc599SNathan Whitehorn static device_method_t adb_mouse_methods[] = { 89b4dbc599SNathan Whitehorn /* Device interface */ 90b4dbc599SNathan Whitehorn DEVMETHOD(device_probe, adb_mouse_probe), 91b4dbc599SNathan Whitehorn DEVMETHOD(device_attach, adb_mouse_attach), 92b4dbc599SNathan Whitehorn DEVMETHOD(device_detach, adb_mouse_detach), 93b4dbc599SNathan Whitehorn DEVMETHOD(device_shutdown, bus_generic_shutdown), 94b4dbc599SNathan Whitehorn DEVMETHOD(device_suspend, bus_generic_suspend), 95b4dbc599SNathan Whitehorn DEVMETHOD(device_resume, bus_generic_resume), 96b4dbc599SNathan Whitehorn 97b4dbc599SNathan Whitehorn /* ADB interface */ 98b4dbc599SNathan Whitehorn DEVMETHOD(adb_receive_packet, adb_mouse_receive_packet), 99b4dbc599SNathan Whitehorn 100b4dbc599SNathan Whitehorn { 0, 0 } 101b4dbc599SNathan Whitehorn }; 102b4dbc599SNathan Whitehorn 103b4dbc599SNathan Whitehorn static driver_t adb_mouse_driver = { 104b4dbc599SNathan Whitehorn "ams", 105b4dbc599SNathan Whitehorn adb_mouse_methods, 106b4dbc599SNathan Whitehorn sizeof(struct adb_mouse_softc), 107b4dbc599SNathan Whitehorn }; 108b4dbc599SNathan Whitehorn 109b4dbc599SNathan Whitehorn static devclass_t adb_mouse_devclass; 110b4dbc599SNathan Whitehorn 111b4dbc599SNathan Whitehorn DRIVER_MODULE(ams, adb, adb_mouse_driver, adb_mouse_devclass, 0, 0); 112b4dbc599SNathan Whitehorn 113b4dbc599SNathan Whitehorn static struct cdevsw ams_cdevsw = { 114b4dbc599SNathan Whitehorn .d_version = D_VERSION, 115b4dbc599SNathan Whitehorn .d_flags = 0, 116b4dbc599SNathan Whitehorn .d_open = ams_open, 117b4dbc599SNathan Whitehorn .d_close = ams_close, 118b4dbc599SNathan Whitehorn .d_read = ams_read, 119b4dbc599SNathan Whitehorn .d_ioctl = ams_ioctl, 120b4dbc599SNathan Whitehorn .d_poll = ams_poll, 121b4dbc599SNathan Whitehorn .d_name = "ams", 122b4dbc599SNathan Whitehorn }; 123b4dbc599SNathan Whitehorn 124b4dbc599SNathan Whitehorn static int 125b4dbc599SNathan Whitehorn adb_mouse_probe(device_t dev) 126b4dbc599SNathan Whitehorn { 127b4dbc599SNathan Whitehorn uint8_t type; 128b4dbc599SNathan Whitehorn 129b4dbc599SNathan Whitehorn type = adb_get_device_type(dev); 130b4dbc599SNathan Whitehorn 131b4dbc599SNathan Whitehorn if (type != ADB_DEVICE_MOUSE) 132b4dbc599SNathan Whitehorn return (ENXIO); 133b4dbc599SNathan Whitehorn 134b4dbc599SNathan Whitehorn device_set_desc(dev,"ADB Mouse"); 135b4dbc599SNathan Whitehorn return (0); 136b4dbc599SNathan Whitehorn } 137b4dbc599SNathan Whitehorn 138b4dbc599SNathan Whitehorn static int 139b4dbc599SNathan Whitehorn adb_mouse_attach(device_t dev) 140b4dbc599SNathan Whitehorn { 141b4dbc599SNathan Whitehorn struct adb_mouse_softc *sc; 142b4dbc599SNathan Whitehorn char *description = "Unknown Pointing Device"; 143b4dbc599SNathan Whitehorn 144b4dbc599SNathan Whitehorn size_t r1_len; 145b4dbc599SNathan Whitehorn u_char r1[8]; 146b4dbc599SNathan Whitehorn 147b4dbc599SNathan Whitehorn sc = device_get_softc(dev); 148b4dbc599SNathan Whitehorn sc->sc_dev = dev; 149b4dbc599SNathan Whitehorn 150b4dbc599SNathan Whitehorn mtx_init(&sc->sc_mtx,"ams",MTX_DEF,0); 151b4dbc599SNathan Whitehorn cv_init(&sc->sc_cv,"ams"); 152b4dbc599SNathan Whitehorn 153b4dbc599SNathan Whitehorn sc->extended = 0; 154b4dbc599SNathan Whitehorn 155b4dbc599SNathan Whitehorn sc->hw.buttons = 2; 156b4dbc599SNathan Whitehorn sc->hw.iftype = MOUSE_IF_UNKNOWN; 157b4dbc599SNathan Whitehorn sc->hw.type = MOUSE_UNKNOWN; 158b4dbc599SNathan Whitehorn sc->hw.model = sc->hw.hwid = 0; 159b4dbc599SNathan Whitehorn 160b4dbc599SNathan Whitehorn sc->mode.protocol = MOUSE_PROTO_SYSMOUSE; 161b4dbc599SNathan Whitehorn sc->mode.rate = -1; 162b4dbc599SNathan Whitehorn sc->mode.resolution = 100; 163b4dbc599SNathan Whitehorn sc->mode.accelfactor = 0; 164b4dbc599SNathan Whitehorn sc->mode.level = 0; 165b4dbc599SNathan Whitehorn sc->mode.packetsize = 5; 166b4dbc599SNathan Whitehorn 167b4dbc599SNathan Whitehorn sc->buttons = 0; 168b4dbc599SNathan Whitehorn sc->last_buttons = 0; 169b4dbc599SNathan Whitehorn sc->packet_read_len = 0; 170b4dbc599SNathan Whitehorn 171b4dbc599SNathan Whitehorn /* Try to switch to extended protocol */ 172b4dbc599SNathan Whitehorn adb_set_device_handler(dev,4); 173b4dbc599SNathan Whitehorn 174b4dbc599SNathan Whitehorn switch(adb_get_device_handler(dev)) { 175b4dbc599SNathan Whitehorn case 1: 176b4dbc599SNathan Whitehorn sc->mode.resolution = 100; 177b4dbc599SNathan Whitehorn break; 178b4dbc599SNathan Whitehorn case 2: 179b4dbc599SNathan Whitehorn sc->mode.resolution = 200; 180b4dbc599SNathan Whitehorn break; 181b4dbc599SNathan Whitehorn case 4: 182b4dbc599SNathan Whitehorn adb_read_register(dev,1,&r1_len,r1); 183b4dbc599SNathan Whitehorn if (r1_len < 8) 184b4dbc599SNathan Whitehorn break; 185b4dbc599SNathan Whitehorn 186b4dbc599SNathan Whitehorn sc->extended = 1; 187b4dbc599SNathan Whitehorn memcpy(&sc->hw.hwid,r1,4); 188b4dbc599SNathan Whitehorn sc->mode.resolution = (r1[4] << 8) | r1[5]; 189b4dbc599SNathan Whitehorn 190b4dbc599SNathan Whitehorn switch (r1[6]) { 191b4dbc599SNathan Whitehorn case 0: 192b4dbc599SNathan Whitehorn sc->hw.type = MOUSE_PAD; 193b4dbc599SNathan Whitehorn description = "Tablet"; 194b4dbc599SNathan Whitehorn break; 195b4dbc599SNathan Whitehorn case 1: 196b4dbc599SNathan Whitehorn sc->hw.type = MOUSE_MOUSE; 197b4dbc599SNathan Whitehorn description = "Mouse"; 198b4dbc599SNathan Whitehorn break; 199b4dbc599SNathan Whitehorn case 2: 200b4dbc599SNathan Whitehorn sc->hw.type = MOUSE_TRACKBALL; 201b4dbc599SNathan Whitehorn description = "Trackball"; 202b4dbc599SNathan Whitehorn break; 203b4dbc599SNathan Whitehorn } 204b4dbc599SNathan Whitehorn 205b4dbc599SNathan Whitehorn sc->hw.buttons = r1[7]; 206b4dbc599SNathan Whitehorn 207b4dbc599SNathan Whitehorn device_printf(dev,"%d-button %d-dpi %s\n", 208b4dbc599SNathan Whitehorn sc->hw.buttons, sc->mode.resolution,description); 209b4dbc599SNathan Whitehorn 210b4dbc599SNathan Whitehorn /* 211b4dbc599SNathan Whitehorn * Check for one of MacAlly's non-compliant 2-button mice. 212b4dbc599SNathan Whitehorn * These claim to speak the extended mouse protocol, but 213b4dbc599SNathan Whitehorn * instead speak the standard protocol and only when their 214b4dbc599SNathan Whitehorn * handler is set to 0x42. 215b4dbc599SNathan Whitehorn */ 216b4dbc599SNathan Whitehorn 217b4dbc599SNathan Whitehorn if (sc->hw.hwid == 0x4b4f4954) { 218b4dbc599SNathan Whitehorn adb_set_device_handler(dev,0x42); 219b4dbc599SNathan Whitehorn 220b4dbc599SNathan Whitehorn if (adb_get_device_handler(dev) == 0x42) { 221b4dbc599SNathan Whitehorn device_printf(dev, "MacAlly 2-Button Mouse\n"); 222b4dbc599SNathan Whitehorn sc->extended = 0; 223b4dbc599SNathan Whitehorn } 224b4dbc599SNathan Whitehorn } 225b4dbc599SNathan Whitehorn 226b4dbc599SNathan Whitehorn break; 227b4dbc599SNathan Whitehorn } 228b4dbc599SNathan Whitehorn 229b4dbc599SNathan Whitehorn sc->cdev = make_dev(&ams_cdevsw, device_get_unit(dev), 230b4dbc599SNathan Whitehorn UID_ROOT, GID_OPERATOR, 0644, "ams%d", 231b4dbc599SNathan Whitehorn device_get_unit(dev)); 232b4dbc599SNathan Whitehorn 233b4dbc599SNathan Whitehorn adb_set_autopoll(dev,1); 234b4dbc599SNathan Whitehorn 235b4dbc599SNathan Whitehorn return (0); 236b4dbc599SNathan Whitehorn } 237b4dbc599SNathan Whitehorn 238b4dbc599SNathan Whitehorn static int 239b4dbc599SNathan Whitehorn adb_mouse_detach(device_t dev) 240b4dbc599SNathan Whitehorn { 241b4dbc599SNathan Whitehorn struct adb_mouse_softc *sc; 242b4dbc599SNathan Whitehorn 243b4dbc599SNathan Whitehorn adb_set_autopoll(dev,0); 244b4dbc599SNathan Whitehorn 245b4dbc599SNathan Whitehorn sc = device_get_softc(dev); 246b4dbc599SNathan Whitehorn destroy_dev(sc->cdev); 247b4dbc599SNathan Whitehorn 248b4dbc599SNathan Whitehorn mtx_destroy(&sc->sc_mtx); 249b4dbc599SNathan Whitehorn cv_destroy(&sc->sc_cv); 250b4dbc599SNathan Whitehorn 251b4dbc599SNathan Whitehorn return (0); 252b4dbc599SNathan Whitehorn } 253b4dbc599SNathan Whitehorn 254b4dbc599SNathan Whitehorn static u_int 255b4dbc599SNathan Whitehorn adb_mouse_receive_packet(device_t dev, u_char status, u_char command, 256b4dbc599SNathan Whitehorn u_char reg, int len, u_char *data) 257b4dbc599SNathan Whitehorn { 258b4dbc599SNathan Whitehorn struct adb_mouse_softc *sc; 259b4dbc599SNathan Whitehorn int i = 0; 260b4dbc599SNathan Whitehorn int xdelta, ydelta; 261b4dbc599SNathan Whitehorn int buttons; 262b4dbc599SNathan Whitehorn 263b4dbc599SNathan Whitehorn sc = device_get_softc(dev); 264b4dbc599SNathan Whitehorn 265b4dbc599SNathan Whitehorn if (command != ADB_COMMAND_TALK || reg != 0 || len < 2) 266b4dbc599SNathan Whitehorn return (0); 267b4dbc599SNathan Whitehorn 268b4dbc599SNathan Whitehorn ydelta = data[0] & 0x7f; 269b4dbc599SNathan Whitehorn xdelta = data[1] & 0x7f; 270b4dbc599SNathan Whitehorn 271b4dbc599SNathan Whitehorn buttons = 0; 272b4dbc599SNathan Whitehorn buttons |= !(data[0] & 0x80); 273b4dbc599SNathan Whitehorn buttons |= !(data[1] & 0x80) << 1; 274b4dbc599SNathan Whitehorn 275b4dbc599SNathan Whitehorn if (sc->extended) { 276b4dbc599SNathan Whitehorn for (i = 2; i < len && i < 5; i++) { 277b4dbc599SNathan Whitehorn xdelta |= (data[i] & 0x07) << (3*i + 1); 278b4dbc599SNathan Whitehorn ydelta |= (data[i] & 0x70) << (3*i - 3); 279b4dbc599SNathan Whitehorn 280b4dbc599SNathan Whitehorn buttons |= !(data[i] & 0x08) << (2*i - 2); 281b4dbc599SNathan Whitehorn buttons |= !(data[i] & 0x80) << (2*i - 1); 282b4dbc599SNathan Whitehorn } 283b4dbc599SNathan Whitehorn } else { 284b4dbc599SNathan Whitehorn len = 2; /* Ignore extra data */ 285b4dbc599SNathan Whitehorn } 286b4dbc599SNathan Whitehorn 287b4dbc599SNathan Whitehorn /* Do sign extension as necessary */ 288b4dbc599SNathan Whitehorn if (xdelta & (0x40 << 3*(len-2))) 289b4dbc599SNathan Whitehorn xdelta |= 0xffffffc0 << 3*(len - 2); 290b4dbc599SNathan Whitehorn if (ydelta & (0x40 << 3*(len-2))) 291b4dbc599SNathan Whitehorn ydelta |= 0xffffffc0 << 3*(len - 2); 292b4dbc599SNathan Whitehorn 293b4dbc599SNathan Whitehorn /* 294b4dbc599SNathan Whitehorn * Some mice report high-numbered buttons on the wrong button number, 295b4dbc599SNathan Whitehorn * so set the highest-numbered real button as pressed if there are 296b4dbc599SNathan Whitehorn * mysterious high-numbered ones set. 297b4dbc599SNathan Whitehorn */ 298b4dbc599SNathan Whitehorn 299b4dbc599SNathan Whitehorn if (buttons & ~((1 << sc->hw.buttons) - 1)) { 300b4dbc599SNathan Whitehorn buttons |= 1 << (sc->hw.buttons - 1); 301b4dbc599SNathan Whitehorn buttons &= (1 << sc->hw.buttons) - 1; 302b4dbc599SNathan Whitehorn } 303b4dbc599SNathan Whitehorn 304b4dbc599SNathan Whitehorn mtx_lock(&sc->sc_mtx); 305b4dbc599SNathan Whitehorn 306b4dbc599SNathan Whitehorn /* Add in our new deltas, and take into account 307b4dbc599SNathan Whitehorn Apple's opposite meaning for Y axis motion */ 308b4dbc599SNathan Whitehorn 309b4dbc599SNathan Whitehorn sc->xdelta += xdelta; 310b4dbc599SNathan Whitehorn sc->ydelta -= ydelta; 311b4dbc599SNathan Whitehorn 312b4dbc599SNathan Whitehorn sc->buttons = buttons; 313b4dbc599SNathan Whitehorn 314b4dbc599SNathan Whitehorn mtx_unlock(&sc->sc_mtx); 315b4dbc599SNathan Whitehorn 316b4dbc599SNathan Whitehorn cv_broadcast(&sc->sc_cv); 317b4dbc599SNathan Whitehorn selwakeuppri(&sc->rsel, PZERO); 318b4dbc599SNathan Whitehorn 319b4dbc599SNathan Whitehorn return (0); 320b4dbc599SNathan Whitehorn } 321b4dbc599SNathan Whitehorn 322b4dbc599SNathan Whitehorn static int 323b4dbc599SNathan Whitehorn ams_open(struct cdev *dev, int flag, int fmt, struct thread *p) 324b4dbc599SNathan Whitehorn { 325b4dbc599SNathan Whitehorn struct adb_mouse_softc *sc; 326b4dbc599SNathan Whitehorn 327b4dbc599SNathan Whitehorn sc = CDEV_GET_SOFTC(dev); 328b4dbc599SNathan Whitehorn if (sc == NULL) 329b4dbc599SNathan Whitehorn return (ENXIO); 330b4dbc599SNathan Whitehorn 331b4dbc599SNathan Whitehorn mtx_lock(&sc->sc_mtx); 332b4dbc599SNathan Whitehorn sc->packet_read_len = 0; 333b4dbc599SNathan Whitehorn sc->xdelta = 0; 334b4dbc599SNathan Whitehorn sc->ydelta = 0; 335b4dbc599SNathan Whitehorn sc->buttons = 0; 336b4dbc599SNathan Whitehorn mtx_unlock(&sc->sc_mtx); 337b4dbc599SNathan Whitehorn 338b4dbc599SNathan Whitehorn return (0); 339b4dbc599SNathan Whitehorn } 340b4dbc599SNathan Whitehorn 341b4dbc599SNathan Whitehorn static int 342b4dbc599SNathan Whitehorn ams_close(struct cdev *dev, int flag, int fmt, struct thread *p) 343b4dbc599SNathan Whitehorn { 344b4dbc599SNathan Whitehorn struct adb_mouse_softc *sc; 345b4dbc599SNathan Whitehorn 346b4dbc599SNathan Whitehorn sc = CDEV_GET_SOFTC(dev); 347b4dbc599SNathan Whitehorn 348b4dbc599SNathan Whitehorn cv_broadcast(&sc->sc_cv); 349b4dbc599SNathan Whitehorn selwakeuppri(&sc->rsel, PZERO); 350b4dbc599SNathan Whitehorn return (0); 351b4dbc599SNathan Whitehorn } 352b4dbc599SNathan Whitehorn 353b4dbc599SNathan Whitehorn static int 354b4dbc599SNathan Whitehorn ams_poll(struct cdev *dev, int events, struct thread *p) 355b4dbc599SNathan Whitehorn { 356b4dbc599SNathan Whitehorn struct adb_mouse_softc *sc; 357b4dbc599SNathan Whitehorn 358b4dbc599SNathan Whitehorn sc = CDEV_GET_SOFTC(dev); 359b4dbc599SNathan Whitehorn if (sc == NULL) 360b4dbc599SNathan Whitehorn return (EIO); 361b4dbc599SNathan Whitehorn 362b4dbc599SNathan Whitehorn if (events & (POLLIN | POLLRDNORM)) { 363b4dbc599SNathan Whitehorn mtx_lock(&sc->sc_mtx); 364b4dbc599SNathan Whitehorn 365b4dbc599SNathan Whitehorn if (sc->xdelta == 0 && sc->ydelta == 0 && 366b4dbc599SNathan Whitehorn sc->buttons == sc->last_buttons) { 367b4dbc599SNathan Whitehorn selrecord(p, &sc->rsel); 368b4dbc599SNathan Whitehorn events = 0; 369b4dbc599SNathan Whitehorn } else { 370b4dbc599SNathan Whitehorn events &= (POLLIN | POLLRDNORM); 371b4dbc599SNathan Whitehorn } 372b4dbc599SNathan Whitehorn 373b4dbc599SNathan Whitehorn mtx_unlock(&sc->sc_mtx); 374b4dbc599SNathan Whitehorn } 375b4dbc599SNathan Whitehorn 376b4dbc599SNathan Whitehorn return events; 377b4dbc599SNathan Whitehorn } 378b4dbc599SNathan Whitehorn 379b4dbc599SNathan Whitehorn static int 380b4dbc599SNathan Whitehorn ams_read(struct cdev *dev, struct uio *uio, int flag) 381b4dbc599SNathan Whitehorn { 382b4dbc599SNathan Whitehorn struct adb_mouse_softc *sc; 383b4dbc599SNathan Whitehorn size_t len; 384b4dbc599SNathan Whitehorn int8_t outpacket[8]; 385b75d1970SEd Schouten int error; 386b4dbc599SNathan Whitehorn 387b4dbc599SNathan Whitehorn sc = CDEV_GET_SOFTC(dev); 388b4dbc599SNathan Whitehorn if (sc == NULL) 389b4dbc599SNathan Whitehorn return (EIO); 390b4dbc599SNathan Whitehorn 391b4dbc599SNathan Whitehorn if (uio->uio_resid <= 0) 392b4dbc599SNathan Whitehorn return (0); 393b4dbc599SNathan Whitehorn 394b4dbc599SNathan Whitehorn mtx_lock(&sc->sc_mtx); 395b4dbc599SNathan Whitehorn 396b4dbc599SNathan Whitehorn if (!sc->packet_read_len) { 397b4dbc599SNathan Whitehorn if (sc->xdelta == 0 && sc->ydelta == 0 && 398b4dbc599SNathan Whitehorn sc->buttons == sc->last_buttons) { 399b4dbc599SNathan Whitehorn 400b4dbc599SNathan Whitehorn if (flag & O_NONBLOCK) { 401b4dbc599SNathan Whitehorn mtx_unlock(&sc->sc_mtx); 402b4dbc599SNathan Whitehorn return EWOULDBLOCK; 403b4dbc599SNathan Whitehorn } 404b4dbc599SNathan Whitehorn 405b4dbc599SNathan Whitehorn 406b4dbc599SNathan Whitehorn /* Otherwise, block on new data */ 407b75d1970SEd Schouten error = cv_wait_sig(&sc->sc_cv, &sc->sc_mtx); 408b75d1970SEd Schouten if (error) { 409b75d1970SEd Schouten mtx_unlock(&sc->sc_mtx); 410b75d1970SEd Schouten return (error); 411b75d1970SEd Schouten } 412b4dbc599SNathan Whitehorn } 413b4dbc599SNathan Whitehorn 414b4dbc599SNathan Whitehorn sc->packet[0] = 1 << 7; 415b4dbc599SNathan Whitehorn sc->packet[0] |= (!(sc->buttons & 1)) << 2; 416b4dbc599SNathan Whitehorn sc->packet[0] |= (!(sc->buttons & 4)) << 1; 417b4dbc599SNathan Whitehorn sc->packet[0] |= (!(sc->buttons & 2)); 418b4dbc599SNathan Whitehorn 419b4dbc599SNathan Whitehorn if (sc->xdelta > 127) { 420b4dbc599SNathan Whitehorn sc->packet[1] = 127; 421b4dbc599SNathan Whitehorn sc->packet[3] = sc->xdelta - 127; 422b4dbc599SNathan Whitehorn } else if (sc->xdelta < -127) { 423b4dbc599SNathan Whitehorn sc->packet[1] = -127; 424b4dbc599SNathan Whitehorn sc->packet[3] = sc->xdelta + 127; 425b4dbc599SNathan Whitehorn } else { 426b4dbc599SNathan Whitehorn sc->packet[1] = sc->xdelta; 427b4dbc599SNathan Whitehorn sc->packet[3] = 0; 428b4dbc599SNathan Whitehorn } 429b4dbc599SNathan Whitehorn 430b4dbc599SNathan Whitehorn if (sc->ydelta > 127) { 431b4dbc599SNathan Whitehorn sc->packet[2] = 127; 432b4dbc599SNathan Whitehorn sc->packet[4] = sc->ydelta - 127; 433b4dbc599SNathan Whitehorn } else if (sc->ydelta < -127) { 434b4dbc599SNathan Whitehorn sc->packet[2] = -127; 435b4dbc599SNathan Whitehorn sc->packet[4] = sc->ydelta + 127; 436b4dbc599SNathan Whitehorn } else { 437b4dbc599SNathan Whitehorn sc->packet[2] = sc->ydelta; 438b4dbc599SNathan Whitehorn sc->packet[4] = 0; 439b4dbc599SNathan Whitehorn } 440b4dbc599SNathan Whitehorn 441b4dbc599SNathan Whitehorn /* No Z movement */ 442b4dbc599SNathan Whitehorn sc->packet[5] = 0; 443b4dbc599SNathan Whitehorn sc->packet[6] = 0; 444b4dbc599SNathan Whitehorn 445b4dbc599SNathan Whitehorn sc->packet[7] = ~((uint8_t)(sc->buttons >> 3)) & 0x7f; 446b4dbc599SNathan Whitehorn 447b4dbc599SNathan Whitehorn 448b4dbc599SNathan Whitehorn sc->last_buttons = sc->buttons; 449b4dbc599SNathan Whitehorn sc->xdelta = 0; 450b4dbc599SNathan Whitehorn sc->ydelta = 0; 451b4dbc599SNathan Whitehorn 452b4dbc599SNathan Whitehorn sc->packet_read_len = sc->mode.packetsize; 453b4dbc599SNathan Whitehorn } 454b4dbc599SNathan Whitehorn 455b4dbc599SNathan Whitehorn len = (sc->packet_read_len > uio->uio_resid) ? 456b4dbc599SNathan Whitehorn uio->uio_resid : sc->packet_read_len; 457b4dbc599SNathan Whitehorn 458b4dbc599SNathan Whitehorn memcpy(outpacket,sc->packet + 459b4dbc599SNathan Whitehorn (sc->mode.packetsize - sc->packet_read_len),len); 460b4dbc599SNathan Whitehorn sc->packet_read_len -= len; 461b4dbc599SNathan Whitehorn 462b4dbc599SNathan Whitehorn mtx_unlock(&sc->sc_mtx); 463b4dbc599SNathan Whitehorn 464b4dbc599SNathan Whitehorn uiomove(outpacket,len,uio); 465b4dbc599SNathan Whitehorn 466b4dbc599SNathan Whitehorn return (0); 467b4dbc599SNathan Whitehorn } 468b4dbc599SNathan Whitehorn 469b4dbc599SNathan Whitehorn 470b4dbc599SNathan Whitehorn static int 471b4dbc599SNathan Whitehorn ams_ioctl(struct cdev *dev, u_long cmd, caddr_t addr, int flag, 472b4dbc599SNathan Whitehorn struct thread *p) 473b4dbc599SNathan Whitehorn { 474b4dbc599SNathan Whitehorn struct adb_mouse_softc *sc; 475b4dbc599SNathan Whitehorn mousemode_t mode; 476b4dbc599SNathan Whitehorn 477b4dbc599SNathan Whitehorn sc = CDEV_GET_SOFTC(dev); 478b4dbc599SNathan Whitehorn if (sc == NULL) 479b4dbc599SNathan Whitehorn return (EIO); 480b4dbc599SNathan Whitehorn 481b4dbc599SNathan Whitehorn switch (cmd) { 482b4dbc599SNathan Whitehorn case MOUSE_GETHWINFO: 483b4dbc599SNathan Whitehorn *(mousehw_t *)addr = sc->hw; 484b4dbc599SNathan Whitehorn break; 485b4dbc599SNathan Whitehorn case MOUSE_GETMODE: 486b4dbc599SNathan Whitehorn *(mousemode_t *)addr = sc->mode; 487b4dbc599SNathan Whitehorn break; 488b4dbc599SNathan Whitehorn case MOUSE_SETMODE: 489b4dbc599SNathan Whitehorn mode = *(mousemode_t *)addr; 490b4dbc599SNathan Whitehorn addr = (caddr_t)&mode.level; 491b4dbc599SNathan Whitehorn 492b4dbc599SNathan Whitehorn /* Fallthrough */ 493b4dbc599SNathan Whitehorn 494b4dbc599SNathan Whitehorn case MOUSE_SETLEVEL: 495b4dbc599SNathan Whitehorn if (*(int *)addr == -1) 496b4dbc599SNathan Whitehorn break; 497b4dbc599SNathan Whitehorn else if (*(int *)addr == 1) { 498b4dbc599SNathan Whitehorn sc->mode.level = 1; 499b4dbc599SNathan Whitehorn sc->mode.packetsize = 8; 500b4dbc599SNathan Whitehorn break; 501b4dbc599SNathan Whitehorn } else if (*(int *)addr == 0) { 502b4dbc599SNathan Whitehorn sc->mode.level = 0; 503b4dbc599SNathan Whitehorn sc->mode.packetsize = 5; 504b4dbc599SNathan Whitehorn break; 505b4dbc599SNathan Whitehorn } 506b4dbc599SNathan Whitehorn 507b4dbc599SNathan Whitehorn return EINVAL; 508b4dbc599SNathan Whitehorn case MOUSE_GETLEVEL: 509b4dbc599SNathan Whitehorn *(int *)addr = sc->mode.level; 510b4dbc599SNathan Whitehorn break; 511b4dbc599SNathan Whitehorn 512b4dbc599SNathan Whitehorn case MOUSE_GETSTATUS: { 513b4dbc599SNathan Whitehorn mousestatus_t *status = (mousestatus_t *) addr; 514b4dbc599SNathan Whitehorn 515b4dbc599SNathan Whitehorn mtx_lock(&sc->sc_mtx); 516b4dbc599SNathan Whitehorn 517b4dbc599SNathan Whitehorn status->button = sc->buttons; 518b4dbc599SNathan Whitehorn status->obutton = sc->last_buttons; 519b4dbc599SNathan Whitehorn 520b4dbc599SNathan Whitehorn status->flags = status->button ^ status->obutton; 521b4dbc599SNathan Whitehorn 522b4dbc599SNathan Whitehorn if (sc->xdelta != 0 || sc->ydelta) 523b4dbc599SNathan Whitehorn status->flags |= MOUSE_POSCHANGED; 524b4dbc599SNathan Whitehorn if (status->button != status->obutton) 525b4dbc599SNathan Whitehorn status->flags |= MOUSE_BUTTONSCHANGED; 526b4dbc599SNathan Whitehorn 527b4dbc599SNathan Whitehorn status->dx = sc->xdelta; 528b4dbc599SNathan Whitehorn status->dy = sc->ydelta; 529b4dbc599SNathan Whitehorn status->dz = 0; 530b4dbc599SNathan Whitehorn 531b4dbc599SNathan Whitehorn sc->xdelta = 0; 532b4dbc599SNathan Whitehorn sc->ydelta = 0; 533b4dbc599SNathan Whitehorn sc->last_buttons = sc->buttons; 534b4dbc599SNathan Whitehorn 535b4dbc599SNathan Whitehorn mtx_unlock(&sc->sc_mtx); 536b4dbc599SNathan Whitehorn 537b4dbc599SNathan Whitehorn break; } 538b4dbc599SNathan Whitehorn default: 539b4dbc599SNathan Whitehorn return ENOTTY; 540b4dbc599SNathan Whitehorn } 541b4dbc599SNathan Whitehorn 542b4dbc599SNathan Whitehorn return (0); 543b4dbc599SNathan Whitehorn } 544b4dbc599SNathan Whitehorn 545