usr.sbin/moused/moused.c

   1 /**
   2  ** SPDX-License-Identifier: BSD-4-Clause
   3  **
   4  ** Copyright (c) 1995 Michael Smith, All rights reserved.
   5  **
   6  ** Redistribution and use in source and binary forms, with or without
   7  ** modification, are permitted provided that the following conditions
   8  ** are met:
   9  ** 1. Redistributions of source code must retain the above copyright
  10  **    notice, this list of conditions and the following disclaimer as
  11  **    the first lines of this file unmodified.
  12  ** 2. Redistributions in binary form must reproduce the above copyright
  13  **    notice, this list of conditions and the following disclaimer in the
  14  **    documentation and/or other materials provided with the distribution.
  15  ** 3. All advertising materials mentioning features or use of this software
  16  **    must display the following acknowledgment:
  17  **      This product includes software developed by Michael Smith.
  18  ** 4. The name of the author may not be used to endorse or promote products
  19  **    derived from this software without specific prior written permission.
  20  **
  21  **
  22  ** THIS SOFTWARE IS PROVIDED BY Michael Smith ``AS IS'' AND ANY
  23  ** EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
  24  ** IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
  25  ** PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL Michael Smith BE LIABLE FOR
  26  ** ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
  27  ** CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
  28  ** SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR
  29  ** BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
  30  ** WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE
  31  ** OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
  32  ** EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  33  **
  34  **/
  35
  36 /**
  37  ** MOUSED.C
  38  **
  39  ** Mouse daemon : listens to a serial port, the bus mouse interface, or
  40  ** the PS/2 mouse port for mouse data stream, interprets data and passes
  41  ** ioctls off to the console driver.
  42  **
  43  ** The mouse interface functions are derived closely from the mouse
  44  ** handler in the XFree86 X server.  Many thanks to the XFree86 people
  45  ** for their great work!
  46  **
  47  **/
  48
  49 #include <sys/param.h>
  50 #include <sys/consio.h>
  51 #include <sys/mouse.h>
  52 #include <sys/socket.h>
  53 #include <sys/stat.h>
  54 #include <sys/time.h>
  55 #include <sys/un.h>
  56
  57 #include <ctype.h>
  58 #include <err.h>
  59 #include <errno.h>
  60 #include <fcntl.h>
  61 #include <libutil.h>
  62 #include <limits.h>
  63 #include <setjmp.h>
  64 #include <signal.h>
  65 #include <stdarg.h>
  66 #include <stdint.h>
  67 #include <stdio.h>
  68 #include <stdlib.h>
  69 #include <string.h>
  70 #include <syslog.h>
  71 #include <termios.h>
  72 #include <unistd.h>
  73 #include <math.h>
  74
  75 #define MAX_CLICKTHRESHOLD      2000    /* 2 seconds */
  76 #define MAX_BUTTON2TIMEOUT      2000    /* 2 seconds */
  77 #define DFLT_CLICKTHRESHOLD      500    /* 0.5 second */
  78 #define DFLT_BUTTON2TIMEOUT      100    /* 0.1 second */
  79 #define DFLT_SCROLLTHRESHOLD       3    /* 3 pixels */
  80 #define DFLT_SCROLLSPEED           2    /* 2 pixels */
  81
  82 /* Abort 3-button emulation delay after this many movement events. */
  83 #define BUTTON2_MAXMOVE 3
  84
  85 #define TRUE            1
  86 #define FALSE           0
  87
  88 #define MOUSE_XAXIS     (-1)
  89 #define MOUSE_YAXIS     (-2)
  90
  91 /* Logitech PS2++ protocol */
  92 #define MOUSE_PS2PLUS_CHECKBITS(b)      \
  93                         ((((b[2] & 0x03) << 2) | 0x02) == (b[1] & 0x0f))
  94 #define MOUSE_PS2PLUS_PACKET_TYPE(b)    \
  95                         (((b[0] & 0x30) >> 2) | ((b[1] & 0x30) >> 4))
  96
  97 #define ChordMiddle     0x0001
  98 #define Emulate3Button  0x0002
  99 #define ClearDTR        0x0004
 100 #define ClearRTS        0x0008
 101 #define NoPnP           0x0010
 102 #define VirtualScroll   0x0020
 103 #define HVirtualScroll  0x0040
 104 #define ExponentialAcc  0x0080
 105
 106 #define ID_NONE         0
 107 #define ID_PORT         1
 108 #define ID_IF           2
 109 #define ID_TYPE         4
 110 #define ID_MODEL        8
 111 #define ID_ALL          (ID_PORT | ID_IF | ID_TYPE | ID_MODEL)
 112
 113 /* Operations on timespecs */
 114 #define tsclr(tvp)      ((tvp)->tv_sec = (tvp)->tv_nsec = 0)
 115 #define tscmp(tvp, uvp, cmp)                                            \
 116         (((tvp)->tv_sec == (uvp)->tv_sec) ?                             \
 117             ((tvp)->tv_nsec cmp (uvp)->tv_nsec) :                       \
 118             ((tvp)->tv_sec cmp (uvp)->tv_sec))
 119 #define tssub(tvp, uvp, vvp)                                            \
 120         do {                                                            \
 121                 (vvp)->tv_sec = (tvp)->tv_sec - (uvp)->tv_sec;          \
 122                 (vvp)->tv_nsec = (tvp)->tv_nsec - (uvp)->tv_nsec;       \
 123                 if ((vvp)->tv_nsec < 0) {                               \
 124                         (vvp)->tv_sec--;                                \
 125                         (vvp)->tv_nsec += 1000000000;                   \
 126                 }                                                       \
 127         } while (0)
 128
 129 #define debug(...) do {                                         \
 130         if (debug && nodaemon)                                  \
 131                 warnx(__VA_ARGS__);                             \
 132 } while (0)
 133
 134 #define logerr(e, ...) do {                                     \
 135         log_or_warn(LOG_DAEMON | LOG_ERR, errno, __VA_ARGS__);  \
 136         exit(e);                                                \
 137 } while (0)
 138
 139 #define logerrx(e, ...) do {                                    \
 140         log_or_warn(LOG_DAEMON | LOG_ERR, 0, __VA_ARGS__);      \
 141         exit(e);                                                \
 142 } while (0)
 143
 144 #define logwarn(...)                                            \
 145         log_or_warn(LOG_DAEMON | LOG_WARNING, errno, __VA_ARGS__)
 146
 147 #define logwarnx(...)                                           \
 148         log_or_warn(LOG_DAEMON | LOG_WARNING, 0, __VA_ARGS__)
 149
 150 /* structures */
 151
 152 /* symbol table entry */
 153 typedef struct {
 154     const char *name;
 155     int val;
 156     int val2;
 157 } symtab_t;
 158
 159 /* serial PnP ID string */
 160 typedef struct {
 161     int revision;       /* PnP revision, 100 for 1.00 */
 162     const char *eisaid; /* EISA ID including mfr ID and product ID */
 163     char *serial;       /* serial No, optional */
 164     const char *class;  /* device class, optional */
 165     char *compat;       /* list of compatible drivers, optional */
 166     char *description;  /* product description, optional */
 167     int neisaid;        /* length of the above fields... */
 168     int nserial;
 169     int nclass;
 170     int ncompat;
 171     int ndescription;
 172 } pnpid_t;
 173
 174 /* global variables */
 175
 176 static int      debug = 0;
 177 static int      nodaemon = FALSE;
 178 static int      background = FALSE;
 179 static int      paused = FALSE;
 180 static int      identify = ID_NONE;
 181 static int      extioctl = FALSE;
 182 static const char *pidfile = "/var/run/moused.pid";
 183 static struct pidfh *pfh;
 184
 185 #define SCROLL_NOTSCROLLING     0
 186 #define SCROLL_PREPARE          1
 187 #define SCROLL_SCROLLING        2
 188
 189 static int      scroll_state;
 190 static int      scroll_movement;
 191 static int      hscroll_movement;
 192
 193 /* local variables */
 194
 195 /* interface (the table must be ordered by MOUSE_IF_XXX in mouse.h) */
 196 static symtab_t rifs[] = {
 197     { "serial",         MOUSE_IF_SERIAL,        0 },
 198     { "ps/2",           MOUSE_IF_PS2,           0 },
 199     { "sysmouse",       MOUSE_IF_SYSMOUSE,      0 },
 200     { "usb",            MOUSE_IF_USB,           0 },
 201     { NULL,             MOUSE_IF_UNKNOWN,       0 },
 202 };
 203
 204 /* types (the table must be ordered by MOUSE_PROTO_XXX in mouse.h) */
 205 static const char *rnames[] = {
 206     "microsoft",
 207     "mousesystems",
 208     "logitech",
 209     "mmseries",
 210     "mouseman",
 211     "wasbusmouse",
 212     "wasinportmouse",
 213     "ps/2",
 214     "mmhitab",
 215     "glidepoint",
 216     "intellimouse",
 217     "thinkingmouse",
 218     "sysmouse",
 219     "x10mouseremote",
 220     "kidspad",
 221     "versapad",
 222     "jogdial",
 223 #if notyet
 224     "mariqua",
 225 #endif
 226     "gtco_digipad",
 227     NULL
 228 };
 229
 230 /* models */
 231 static symtab_t rmodels[] = {
 232     { "NetScroll",              MOUSE_MODEL_NETSCROLL,          0 },
 233     { "NetMouse/NetScroll Optical", MOUSE_MODEL_NET,            0 },
 234     { "GlidePoint",             MOUSE_MODEL_GLIDEPOINT,         0 },
 235     { "ThinkingMouse",          MOUSE_MODEL_THINK,              0 },
 236     { "IntelliMouse",           MOUSE_MODEL_INTELLI,            0 },
 237     { "EasyScroll/SmartScroll", MOUSE_MODEL_EASYSCROLL,         0 },
 238     { "MouseMan+",              MOUSE_MODEL_MOUSEMANPLUS,       0 },
 239     { "Kidspad",                MOUSE_MODEL_KIDSPAD,            0 },
 240     { "VersaPad",               MOUSE_MODEL_VERSAPAD,           0 },
 241     { "IntelliMouse Explorer",  MOUSE_MODEL_EXPLORER,           0 },
 242     { "4D Mouse",               MOUSE_MODEL_4D,                 0 },
 243     { "4D+ Mouse",              MOUSE_MODEL_4DPLUS,             0 },
 244     { "Synaptics Touchpad",     MOUSE_MODEL_SYNAPTICS,          0 },
 245     { "TrackPoint",             MOUSE_MODEL_TRACKPOINT,         0 },
 246     { "Elantech Touchpad",      MOUSE_MODEL_ELANTECH,           0 },
 247     { "generic",                MOUSE_MODEL_GENERIC,            0 },
 248     { NULL,                     MOUSE_MODEL_UNKNOWN,            0 },
 249 };
 250
 251 /* PnP EISA/product IDs */
 252 static symtab_t pnpprod[] = {
 253     /* Kensignton ThinkingMouse */
 254     { "KML0001",        MOUSE_PROTO_THINK,      MOUSE_MODEL_THINK },
 255     /* MS IntelliMouse */
 256     { "MSH0001",        MOUSE_PROTO_INTELLI,    MOUSE_MODEL_INTELLI },
 257     /* MS IntelliMouse TrackBall */
 258     { "MSH0004",        MOUSE_PROTO_INTELLI,    MOUSE_MODEL_INTELLI },
 259     /* Tremon Wheel Mouse MUSD */
 260     { "HTK0001",        MOUSE_PROTO_INTELLI,    MOUSE_MODEL_INTELLI },
 261     /* Genius PnP Mouse */
 262     { "KYE0001",        MOUSE_PROTO_MS,         MOUSE_MODEL_GENERIC },
 263     /* MouseSystems SmartScroll Mouse (OEM from Genius?) */
 264     { "KYE0002",        MOUSE_PROTO_MS,         MOUSE_MODEL_EASYSCROLL },
 265     /* Genius NetMouse */
 266     { "KYE0003",        MOUSE_PROTO_INTELLI,    MOUSE_MODEL_NET },
 267     /* Genius Kidspad, Easypad and other tablets */
 268     { "KYE0005",        MOUSE_PROTO_KIDSPAD,    MOUSE_MODEL_KIDSPAD },
 269     /* Genius EZScroll */
 270     { "KYEEZ00",        MOUSE_PROTO_MS,         MOUSE_MODEL_EASYSCROLL },
 271     /* Logitech Cordless MouseMan Wheel */
 272     { "LGI8033",        MOUSE_PROTO_INTELLI,    MOUSE_MODEL_MOUSEMANPLUS },
 273     /* Logitech MouseMan (new 4 button model) */
 274     { "LGI800C",        MOUSE_PROTO_INTELLI,    MOUSE_MODEL_MOUSEMANPLUS },
 275     /* Logitech MouseMan+ */
 276     { "LGI8050",        MOUSE_PROTO_INTELLI,    MOUSE_MODEL_MOUSEMANPLUS },
 277     /* Logitech FirstMouse+ */
 278     { "LGI8051",        MOUSE_PROTO_INTELLI,    MOUSE_MODEL_MOUSEMANPLUS },
 279     /* Logitech serial */
 280     { "LGI8001",        MOUSE_PROTO_LOGIMOUSEMAN, MOUSE_MODEL_GENERIC },
 281     /* A4 Tech 4D/4D+ Mouse */
 282     { "A4W0005",        MOUSE_PROTO_INTELLI,    MOUSE_MODEL_4D },
 283     /* 8D Scroll Mouse */
 284     { "PEC9802",        MOUSE_PROTO_INTELLI,    MOUSE_MODEL_INTELLI },
 285     /* Mitsumi Wireless Scroll Mouse */
 286     { "MTM6401",        MOUSE_PROTO_INTELLI,    MOUSE_MODEL_INTELLI },
 287
 288     /* MS serial */
 289     { "PNP0F01",        MOUSE_PROTO_MS,         MOUSE_MODEL_GENERIC },
 290     /* MS PS/2 */
 291     { "PNP0F03",        MOUSE_PROTO_PS2,        MOUSE_MODEL_GENERIC },
 292     /*
 293      * EzScroll returns PNP0F04 in the compatible device field; but it
 294      * doesn't look compatible... XXX
 295      */
 296     /* MouseSystems */
 297     { "PNP0F04",        MOUSE_PROTO_MSC,        MOUSE_MODEL_GENERIC },
 298     /* MouseSystems */
 299     { "PNP0F05",        MOUSE_PROTO_MSC,        MOUSE_MODEL_GENERIC },
 300 #if notyet
 301     /* Genius Mouse */
 302     { "PNP0F06",        MOUSE_PROTO_XXX,        MOUSE_MODEL_GENERIC },
 303     /* Genius Mouse */
 304     { "PNP0F07",        MOUSE_PROTO_XXX,        MOUSE_MODEL_GENERIC },
 305 #endif
 306     /* Logitech serial */
 307     { "PNP0F08",        MOUSE_PROTO_LOGIMOUSEMAN, MOUSE_MODEL_GENERIC },
 308     /* MS BallPoint serial */
 309     { "PNP0F09",        MOUSE_PROTO_MS,         MOUSE_MODEL_GENERIC },
 310     /* MS PnP serial */
 311     { "PNP0F0A",        MOUSE_PROTO_MS,         MOUSE_MODEL_GENERIC },
 312     /* MS PnP BallPoint serial */
 313     { "PNP0F0B",        MOUSE_PROTO_MS,         MOUSE_MODEL_GENERIC },
 314     /* MS serial compatible */
 315     { "PNP0F0C",        MOUSE_PROTO_MS,         MOUSE_MODEL_GENERIC },
 316     /* MS PS/2 compatible */
 317     { "PNP0F0E",        MOUSE_PROTO_PS2,        MOUSE_MODEL_GENERIC },
 318     /* MS BallPoint compatible */
 319     { "PNP0F0F",        MOUSE_PROTO_MS,         MOUSE_MODEL_GENERIC },
 320 #if notyet
 321     /* TI QuickPort */
 322     { "PNP0F10",        MOUSE_PROTO_XXX,        MOUSE_MODEL_GENERIC },
 323 #endif
 324     /* Logitech PS/2 */
 325     { "PNP0F12",        MOUSE_PROTO_PS2,        MOUSE_MODEL_GENERIC },
 326     /* PS/2 */
 327     { "PNP0F13",        MOUSE_PROTO_PS2,        MOUSE_MODEL_GENERIC },
 328 #if notyet
 329     /* MS Kids Mouse */
 330     { "PNP0F14",        MOUSE_PROTO_XXX,        MOUSE_MODEL_GENERIC },
 331 #endif
 332 #if notyet
 333     /* Logitech SWIFT */
 334     { "PNP0F16",        MOUSE_PROTO_XXX,        MOUSE_MODEL_GENERIC },
 335 #endif
 336     /* Logitech serial compat */
 337     { "PNP0F17",        MOUSE_PROTO_LOGIMOUSEMAN, MOUSE_MODEL_GENERIC },
 338     /* Logitech PS/2 compatible */
 339     { "PNP0F19",        MOUSE_PROTO_PS2,        MOUSE_MODEL_GENERIC },
 340 #if notyet
 341     /* Logitech SWIFT compatible */
 342     { "PNP0F1A",        MOUSE_PROTO_XXX,        MOUSE_MODEL_GENERIC },
 343     /* HP Omnibook */
 344     { "PNP0F1B",        MOUSE_PROTO_XXX,        MOUSE_MODEL_GENERIC },
 345     /* Compaq LTE TrackBall PS/2 */
 346     { "PNP0F1C",        MOUSE_PROTO_XXX,        MOUSE_MODEL_GENERIC },
 347     /* Compaq LTE TrackBall serial */
 348     { "PNP0F1D",        MOUSE_PROTO_XXX,        MOUSE_MODEL_GENERIC },
 349     /* MS Kidts Trackball */
 350     { "PNP0F1E",        MOUSE_PROTO_XXX,        MOUSE_MODEL_GENERIC },
 351 #endif
 352     /* Interlink VersaPad */
 353     { "LNK0001",        MOUSE_PROTO_VERSAPAD,   MOUSE_MODEL_VERSAPAD },
 354
 355     { NULL,             MOUSE_PROTO_UNKNOWN,    MOUSE_MODEL_GENERIC },
 356 };
 357
 358 /* the table must be ordered by MOUSE_PROTO_XXX in mouse.h */
 359 static unsigned short rodentcflags[] =
 360 {
 361     (CS7                   | CREAD | CLOCAL | HUPCL),   /* MicroSoft */
 362     (CS8 | CSTOPB          | CREAD | CLOCAL | HUPCL),   /* MouseSystems */
 363     (CS8 | CSTOPB          | CREAD | CLOCAL | HUPCL),   /* Logitech */
 364     (CS8 | PARENB | PARODD | CREAD | CLOCAL | HUPCL),   /* MMSeries */
 365     (CS7                   | CREAD | CLOCAL | HUPCL),   /* MouseMan */
 366     0,                                                  /* Bus */
 367     0,                                                  /* InPort */
 368     0,                                                  /* PS/2 */
 369     (CS8                   | CREAD | CLOCAL | HUPCL),   /* MM HitTablet */
 370     (CS7                   | CREAD | CLOCAL | HUPCL),   /* GlidePoint */
 371     (CS7                   | CREAD | CLOCAL | HUPCL),   /* IntelliMouse */
 372     (CS7                   | CREAD | CLOCAL | HUPCL),   /* Thinking Mouse */
 373     (CS8 | CSTOPB          | CREAD | CLOCAL | HUPCL),   /* sysmouse */
 374     (CS7                   | CREAD | CLOCAL | HUPCL),   /* X10 MouseRemote */
 375     (CS8 | PARENB | PARODD | CREAD | CLOCAL | HUPCL),   /* kidspad etc. */
 376     (CS8                   | CREAD | CLOCAL | HUPCL),   /* VersaPad */
 377     0,                                                  /* JogDial */
 378 #if notyet
 379     (CS8 | CSTOPB          | CREAD | CLOCAL | HUPCL),   /* Mariqua */
 380 #endif
 381     (CS8                   | CREAD |          HUPCL ),  /* GTCO Digi-Pad */
 382 };
 383
 384 static struct rodentparam {
 385     int flags;
 386     const char *portname;       /* /dev/XXX */
 387     int rtype;                  /* MOUSE_PROTO_XXX */
 388     int level;                  /* operation level: 0 or greater */
 389     int baudrate;
 390     int rate;                   /* report rate */
 391     int resolution;             /* MOUSE_RES_XXX or a positive number */
 392     int zmap[4];                /* MOUSE_{X|Y}AXIS or a button number */
 393     int wmode;                  /* wheel mode button number */
 394     int mfd;                    /* mouse file descriptor */
 395     int cfd;                    /* /dev/consolectl file descriptor */
 396     int mremsfd;                /* mouse remote server file descriptor */
 397     int mremcfd;                /* mouse remote client file descriptor */
 398     int is_removable;           /* set if device is removable, like USB */
 399     long clickthreshold;        /* double click speed in msec */
 400     long button2timeout;        /* 3 button emulation timeout */
 401     mousehw_t hw;               /* mouse device hardware information */
 402     mousemode_t mode;           /* protocol information */
 403     float accelx;               /* Acceleration in the X axis */
 404     float accely;               /* Acceleration in the Y axis */
 405     float expoaccel;            /* Exponential acceleration */
 406     float expoffset;            /* Movement offset for exponential accel. */
 407     float remainx;              /* Remainder on X and Y axis, respectively... */
 408     float remainy;              /*    ... to compensate for rounding errors. */
 409     int scrollthreshold;        /* Movement distance before virtual scrolling */
 410     int scrollspeed;            /* Movement distance to rate of scrolling */
 411 } rodent = {
 412     .flags = 0,
 413     .portname = NULL,
 414     .rtype = MOUSE_PROTO_UNKNOWN,
 415     .level = -1,
 416     .baudrate = 1200,
 417     .rate = 0,
 418     .resolution = MOUSE_RES_UNKNOWN,
 419     .zmap = { 0, 0, 0, 0 },
 420     .wmode = 0,
 421     .mfd = -1,
 422     .cfd = -1,
 423     .mremsfd = -1,
 424     .mremcfd = -1,
 425     .is_removable = 0,
 426     .clickthreshold = DFLT_CLICKTHRESHOLD,
 427     .button2timeout = DFLT_BUTTON2TIMEOUT,
 428     .accelx = 1.0,
 429     .accely = 1.0,
 430     .expoaccel = 1.0,
 431     .expoffset = 1.0,
 432     .remainx = 0.0,
 433     .remainy = 0.0,
 434     .scrollthreshold = DFLT_SCROLLTHRESHOLD,
 435     .scrollspeed = DFLT_SCROLLSPEED,
 436 };
 437
 438 /* button status */
 439 struct button_state {
 440     int count;          /* 0: up, 1: single click, 2: double click,... */
 441     struct timespec ts; /* timestamp on the last button event */
 442 };
 443 static struct button_state      bstate[MOUSE_MAXBUTTON];        /* button state */
 444 static struct button_state      *mstate[MOUSE_MAXBUTTON];/* mapped button st.*/
 445 static struct button_state      zstate[4];               /* Z/W axis state */
 446
 447 /* state machine for 3 button emulation */
 448
 449 #define S0      0       /* start */
 450 #define S1      1       /* button 1 delayed down */
 451 #define S2      2       /* button 3 delayed down */
 452 #define S3      3       /* both buttons down -> button 2 down */
 453 #define S4      4       /* button 1 delayed up */
 454 #define S5      5       /* button 1 down */
 455 #define S6      6       /* button 3 down */
 456 #define S7      7       /* both buttons down */
 457 #define S8      8       /* button 3 delayed up */
 458 #define S9      9       /* button 1 or 3 up after S3 */
 459
 460 #define A(b1, b3)       (((b1) ? 2 : 0) | ((b3) ? 1 : 0))
 461 #define A_TIMEOUT       4
 462 #define S_DELAYED(st)   (states[st].s[A_TIMEOUT] != (st))
 463
 464 static struct {
 465     int s[A_TIMEOUT + 1];
 466     int buttons;
 467     int mask;
 468     int timeout;
 469 } states[10] = {
 470     /* S0 */
 471     { { S0, S2, S1, S3, S0 }, 0, ~(MOUSE_BUTTON1DOWN | MOUSE_BUTTON3DOWN), FALSE },
 472     /* S1 */
 473     { { S4, S2, S1, S3, S5 }, 0, ~MOUSE_BUTTON1DOWN, FALSE },
 474     /* S2 */
 475     { { S8, S2, S1, S3, S6 }, 0, ~MOUSE_BUTTON3DOWN, FALSE },
 476     /* S3 */
 477     { { S0, S9, S9, S3, S3 }, MOUSE_BUTTON2DOWN, ~0, FALSE },
 478     /* S4 */
 479     { { S0, S2, S1, S3, S0 }, MOUSE_BUTTON1DOWN, ~0, TRUE },
 480     /* S5 */
 481     { { S0, S2, S5, S7, S5 }, MOUSE_BUTTON1DOWN, ~0, FALSE },
 482     /* S6 */
 483     { { S0, S6, S1, S7, S6 }, MOUSE_BUTTON3DOWN, ~0, FALSE },
 484     /* S7 */
 485     { { S0, S6, S5, S7, S7 }, MOUSE_BUTTON1DOWN | MOUSE_BUTTON3DOWN, ~0, FALSE },
 486     /* S8 */
 487     { { S0, S2, S1, S3, S0 }, MOUSE_BUTTON3DOWN, ~0, TRUE },
 488     /* S9 */
 489     { { S0, S9, S9, S3, S9 }, 0, ~(MOUSE_BUTTON1DOWN | MOUSE_BUTTON3DOWN), FALSE },
 490 };
 491 static int              mouse_button_state;
 492 static struct timespec  mouse_button_state_ts;
 493 static int              mouse_move_delayed;
 494
 495 static jmp_buf env;
 496
 497 struct drift_xy {
 498     int x;
 499     int y;
 500 };
 501 static int              drift_distance = 4;     /* max steps X+Y */
 502 static int              drift_time = 500;       /* in 0.5 sec */
 503 static struct timespec  drift_time_ts;
 504 static struct timespec  drift_2time_ts;         /* 2*drift_time */
 505 static int              drift_after = 4000;     /* 4 sec */
 506 static struct timespec  drift_after_ts;
 507 static int              drift_terminate = FALSE;
 508 static struct timespec  drift_current_ts;
 509 static struct timespec  drift_tmp;
 510 static struct timespec  drift_last_activity = {0, 0};
 511 static struct timespec  drift_since = {0, 0};
 512 static struct drift_xy  drift_last = {0, 0};    /* steps in last drift_time */
 513 static struct drift_xy  drift_previous = {0, 0};        /* steps in prev. drift_time */
 514
 515 /* function prototypes */
 516
 517 static void     linacc(int, int, int*, int*);
 518 static void     expoacc(int, int, int*, int*);
 519 static void     moused(void);
 520 static void     hup(int sig);
 521 static void     cleanup(int sig);
 522 static void     pause_mouse(int sig);
 523 static void     usage(void);
 524 static void     log_or_warn(int log_pri, int errnum, const char *fmt, ...)
 525                     __printflike(3, 4);
 526
 527 static int      r_identify(void);
 528 static const char *r_if(int type);
 529 static const char *r_name(int type);
 530 static const char *r_model(int model);
 531 static void     r_init(void);
 532 static int      r_protocol(u_char b, mousestatus_t *act);
 533 static int      r_statetrans(mousestatus_t *a1, mousestatus_t *a2, int trans);
 534 static int      r_installmap(char *arg);
 535 static void     r_map(mousestatus_t *act1, mousestatus_t *act2);
 536 static void     r_timestamp(mousestatus_t *act);
 537 static int      r_timeout(void);
 538 static void     r_click(mousestatus_t *act);
 539 static void     setmousespeed(int old, int new, unsigned cflag);
 540
 541 static int      pnpwakeup1(void);
 542 static int      pnpwakeup2(void);
 543 static int      pnpgets(char *buf);
 544 static int      pnpparse(pnpid_t *id, char *buf, int len);
 545 static symtab_t *pnpproto(pnpid_t *id);
 546
 547 static symtab_t *gettoken(symtab_t *tab, const char *s, int len);
 548 static const char *gettokenname(symtab_t *tab, int val);
 549
 550 static void     mremote_serversetup(void);
 551 static void     mremote_clientchg(int add);
 552
 553 static int      kidspad(u_char rxc, mousestatus_t *act);
 554 static int      gtco_digipad(u_char, mousestatus_t *);
 555
 556 int
 557 main(int argc, char *argv[])
 558 {
 559     int c;
 560     int i;
 561     int j;
 562
 563     for (i = 0; i < MOUSE_MAXBUTTON; ++i)
 564         mstate[i] = &bstate[i];
 565
 566     while ((c = getopt(argc, argv, "3A:C:DE:F:HI:L:PRS:T:VU:a:cdfhi:l:m:p:r:st:w:z:")) != -1)
 567         switch(c) {
 568
 569         case '3':
 570             rodent.flags |= Emulate3Button;
 571             break;
 572
 573         case 'E':
 574             rodent.button2timeout = atoi(optarg);
 575             if ((rodent.button2timeout < 0) ||
 576                 (rodent.button2timeout > MAX_BUTTON2TIMEOUT)) {
 577                 warnx("invalid argument `%s'", optarg);
 578                 usage();
 579             }
 580             break;
 581
 582         case 'a':
 583             i = sscanf(optarg, "%f,%f", &rodent.accelx, &rodent.accely);
 584             if (i == 0) {
 585                 warnx("invalid linear acceleration argument '%s'", optarg);
 586                 usage();
 587             }
 588
 589             if (i == 1)
 590                 rodent.accely = rodent.accelx;
 591
 592             break;
 593
 594         case 'A':
 595             rodent.flags |= ExponentialAcc;
 596             i = sscanf(optarg, "%f,%f", &rodent.expoaccel, &rodent.expoffset);
 597             if (i == 0) {
 598                 warnx("invalid exponential acceleration argument '%s'", optarg);
 599                 usage();
 600             }
 601
 602             if (i == 1)
 603                 rodent.expoffset = 1.0;
 604
 605             break;
 606
 607         case 'c':
 608             rodent.flags |= ChordMiddle;
 609             break;
 610
 611         case 'd':
 612             ++debug;
 613             break;
 614
 615         case 'f':
 616             nodaemon = TRUE;
 617             break;
 618
 619         case 'i':
 620             if (strcmp(optarg, "all") == 0)
 621                 identify = ID_ALL;
 622             else if (strcmp(optarg, "port") == 0)
 623                 identify = ID_PORT;
 624             else if (strcmp(optarg, "if") == 0)
 625                 identify = ID_IF;
 626             else if (strcmp(optarg, "type") == 0)
 627                 identify = ID_TYPE;
 628             else if (strcmp(optarg, "model") == 0)
 629                 identify = ID_MODEL;
 630             else {
 631                 warnx("invalid argument `%s'", optarg);
 632                 usage();
 633             }
 634             nodaemon = TRUE;
 635             break;
 636
 637         case 'l':
 638             rodent.level = atoi(optarg);
 639             if ((rodent.level < 0) || (rodent.level > 4)) {
 640                 warnx("invalid argument `%s'", optarg);
 641                 usage();
 642             }
 643             break;
 644
 645         case 'm':
 646             if (!r_installmap(optarg)) {
 647                 warnx("invalid argument `%s'", optarg);
 648                 usage();
 649             }
 650             break;
 651
 652         case 'p':
 653             rodent.portname = optarg;
 654             break;
 655
 656         case 'r':
 657             if (strcmp(optarg, "high") == 0)
 658                 rodent.resolution = MOUSE_RES_HIGH;
 659             else if (strcmp(optarg, "medium-high") == 0)
 660                 rodent.resolution = MOUSE_RES_HIGH;
 661             else if (strcmp(optarg, "medium-low") == 0)
 662                 rodent.resolution = MOUSE_RES_MEDIUMLOW;
 663             else if (strcmp(optarg, "low") == 0)
 664                 rodent.resolution = MOUSE_RES_LOW;
 665             else if (strcmp(optarg, "default") == 0)
 666                 rodent.resolution = MOUSE_RES_DEFAULT;
 667             else {
 668                 rodent.resolution = atoi(optarg);
 669                 if (rodent.resolution <= 0) {
 670                     warnx("invalid argument `%s'", optarg);
 671                     usage();
 672                 }
 673             }
 674             break;
 675
 676         case 's':
 677             rodent.baudrate = 9600;
 678             break;
 679
 680         case 'w':
 681             i = atoi(optarg);
 682             if ((i <= 0) || (i > MOUSE_MAXBUTTON)) {
 683                 warnx("invalid argument `%s'", optarg);
 684                 usage();
 685             }
 686             rodent.wmode = 1 << (i - 1);
 687             break;
 688
 689         case 'z':
 690             if (strcmp(optarg, "x") == 0)
 691                 rodent.zmap[0] = MOUSE_XAXIS;
 692             else if (strcmp(optarg, "y") == 0)
 693                 rodent.zmap[0] = MOUSE_YAXIS;
 694             else {
 695                 i = atoi(optarg);
 696                 /*
 697                  * Use button i for negative Z axis movement and
 698                  * button (i + 1) for positive Z axis movement.
 699                  */
 700                 if ((i <= 0) || (i > MOUSE_MAXBUTTON - 1)) {
 701                     warnx("invalid argument `%s'", optarg);
 702                     usage();
 703                 }
 704                 rodent.zmap[0] = i;
 705                 rodent.zmap[1] = i + 1;
 706                 debug("optind: %d, optarg: '%s'", optind, optarg);
 707                 for (j = 1; j < 4; ++j) {
 708                     if ((optind >= argc) || !isdigit(*argv[optind]))
 709                         break;
 710                     i = atoi(argv[optind]);
 711                     if ((i <= 0) || (i > MOUSE_MAXBUTTON - 1)) {
 712                         warnx("invalid argument `%s'", argv[optind]);
 713                         usage();
 714                     }
 715                     rodent.zmap[j] = i;
 716                     ++optind;
 717                 }
 718                 if ((rodent.zmap[2] != 0) && (rodent.zmap[3] == 0))
 719                     rodent.zmap[3] = rodent.zmap[2] + 1;
 720             }
 721             break;
 722
 723         case 'C':
 724             rodent.clickthreshold = atoi(optarg);
 725             if ((rodent.clickthreshold < 0) ||
 726                 (rodent.clickthreshold > MAX_CLICKTHRESHOLD)) {
 727                 warnx("invalid argument `%s'", optarg);
 728                 usage();
 729             }
 730             break;
 731
 732         case 'D':
 733             rodent.flags |= ClearDTR;
 734             break;
 735
 736         case 'F':
 737             rodent.rate = atoi(optarg);
 738             if (rodent.rate <= 0) {
 739                 warnx("invalid argument `%s'", optarg);
 740                 usage();
 741             }
 742             break;
 743
 744         case 'H':
 745             rodent.flags |= HVirtualScroll;
 746             break;
 747
 748         case 'I':
 749             pidfile = optarg;
 750             break;
 751
 752         case 'L':
 753             rodent.scrollspeed = atoi(optarg);
 754             if (rodent.scrollspeed < 0) {
 755                 warnx("invalid argument `%s'", optarg);
 756                 usage();
 757             }
 758             break;
 759
 760         case 'P':
 761             rodent.flags |= NoPnP;
 762             break;
 763
 764         case 'R':
 765             rodent.flags |= ClearRTS;
 766             break;
 767
 768         case 'S':
 769             rodent.baudrate = atoi(optarg);
 770             if (rodent.baudrate <= 0) {
 771                 warnx("invalid argument `%s'", optarg);
 772                 usage();
 773             }
 774             debug("rodent baudrate %d", rodent.baudrate);
 775             break;
 776
 777         case 'T':
 778             drift_terminate = TRUE;
 779             sscanf(optarg, "%d,%d,%d", &drift_distance, &drift_time,
 780                 &drift_after);
 781             if (drift_distance <= 0 || drift_time <= 0 || drift_after <= 0) {
 782                 warnx("invalid argument `%s'", optarg);
 783                 usage();
 784             }
 785             debug("terminate drift: distance %d, time %d, after %d",
 786                 drift_distance, drift_time, drift_after);
 787             drift_time_ts.tv_sec = drift_time / 1000;
 788             drift_time_ts.tv_nsec = (drift_time % 1000) * 1000000;
 789             drift_2time_ts.tv_sec = (drift_time *= 2) / 1000;
 790             drift_2time_ts.tv_nsec = (drift_time % 1000) * 1000000;
 791             drift_after_ts.tv_sec = drift_after / 1000;
 792             drift_after_ts.tv_nsec = (drift_after % 1000) * 1000000;
 793             break;
 794
 795         case 't':
 796             if (strcmp(optarg, "auto") == 0) {
 797                 rodent.rtype = MOUSE_PROTO_UNKNOWN;
 798                 rodent.flags &= ~NoPnP;
 799                 rodent.level = -1;
 800                 break;
 801             }
 802             for (i = 0; rnames[i] != NULL; i++)
 803                 if (strcmp(optarg, rnames[i]) == 0) {
 804                     rodent.rtype = i;
 805                     rodent.flags |= NoPnP;
 806                     rodent.level = (i == MOUSE_PROTO_SYSMOUSE) ? 1 : 0;
 807                     break;
 808                 }
 809             if (rnames[i] == NULL) {
 810                 warnx("no such mouse type `%s'", optarg);
 811                 usage();
 812             }
 813             break;
 814
 815         case 'V':
 816             rodent.flags |= VirtualScroll;
 817             break;
 818         case 'U':
 819             rodent.scrollthreshold = atoi(optarg);
 820             if (rodent.scrollthreshold < 0) {
 821                 warnx("invalid argument `%s'", optarg);
 822                 usage();
 823             }
 824             break;
 825
 826         case 'h':
 827         case '?':
 828         default:
 829             usage();
 830         }
 831
 832     /* fix Z axis mapping */
 833     for (i = 0; i < 4; ++i) {
 834         if (rodent.zmap[i] > 0) {
 835             for (j = 0; j < MOUSE_MAXBUTTON; ++j) {
 836                 if (mstate[j] == &bstate[rodent.zmap[i] - 1])
 837                     mstate[j] = &zstate[i];
 838             }
 839             rodent.zmap[i] = 1 << (rodent.zmap[i] - 1);
 840         }
 841     }
 842
 843     /* the default port name */
 844     switch(rodent.rtype) {
 845
 846     case MOUSE_PROTO_PS2:
 847         if (!rodent.portname)
 848             rodent.portname = "/dev/psm0";
 849         break;
 850
 851     default:
 852         if (rodent.portname)
 853             break;
 854         warnx("no port name specified");
 855         usage();
 856     }
 857
 858     if (strncmp(rodent.portname, "/dev/ums", 8) == 0)
 859         rodent.is_removable = 1;
 860
 861     for (;;) {
 862         if (setjmp(env) == 0) {
 863             signal(SIGHUP, hup);
 864             signal(SIGINT , cleanup);
 865             signal(SIGQUIT, cleanup);
 866             signal(SIGTERM, cleanup);
 867             signal(SIGUSR1, pause_mouse);
 868
 869             rodent.mfd = open(rodent.portname, O_RDWR | O_NONBLOCK);
 870             if (rodent.mfd == -1)
 871                 logerr(1, "unable to open %s", rodent.portname);
 872             if (r_identify() == MOUSE_PROTO_UNKNOWN) {
 873                 logwarnx("cannot determine mouse type on %s", rodent.portname);
 874                 close(rodent.mfd);
 875                 rodent.mfd = -1;
 876             }
 877
 878             /* print some information */
 879             if (identify != ID_NONE) {
 880                 if (identify == ID_ALL)
 881                     printf("%s %s %s %s\n",
 882                         rodent.portname, r_if(rodent.hw.iftype),
 883                         r_name(rodent.rtype), r_model(rodent.hw.model));
 884                 else if (identify & ID_PORT)
 885                     printf("%s\n", rodent.portname);
 886                 else if (identify & ID_IF)
 887                     printf("%s\n", r_if(rodent.hw.iftype));
 888                 else if (identify & ID_TYPE)
 889                     printf("%s\n", r_name(rodent.rtype));
 890                 else if (identify & ID_MODEL)
 891                     printf("%s\n", r_model(rodent.hw.model));
 892                 exit(0);
 893             } else {
 894                 debug("port: %s  interface: %s  type: %s  model: %s",
 895                     rodent.portname, r_if(rodent.hw.iftype),
 896                     r_name(rodent.rtype), r_model(rodent.hw.model));
 897             }
 898
 899             if (rodent.mfd == -1) {
 900                 /*
 901                  * We cannot continue because of error.  Exit if the
 902                  * program has not become a daemon.  Otherwise, block
 903                  * until the user corrects the problem and issues SIGHUP.
 904                  */
 905                 if (!background)
 906                     exit(1);
 907                 sigpause(0);
 908             }
 909
 910             r_init();                   /* call init function */
 911             moused();
 912         }
 913
 914         if (rodent.mfd != -1)
 915             close(rodent.mfd);
 916         if (rodent.cfd != -1)
 917             close(rodent.cfd);
 918         rodent.mfd = rodent.cfd = -1;
 919         if (rodent.is_removable)
 920                 exit(0);
 921     }
 922     /* NOT REACHED */
 923
 924     exit(0);
 925 }
 926
 927 /*
 928  * Function to calculate linear acceleration.
 929  *
 930  * If there are any rounding errors, the remainder
 931  * is stored in the remainx and remainy variables
 932  * and taken into account upon the next movement.
 933  */
 934
 935 static void
 936 linacc(int dx, int dy, int *movex, int *movey)
 937 {
 938     float fdx, fdy;
 939
 940     if (dx == 0 && dy == 0) {
 941         *movex = *movey = 0;
 942         return;
 943     }
 944     fdx = dx * rodent.accelx + rodent.remainx;
 945     fdy = dy * rodent.accely + rodent.remainy;
 946     *movex = lround(fdx);
 947     *movey = lround(fdy);
 948     rodent.remainx = fdx - *movex;
 949     rodent.remainy = fdy - *movey;
 950 }
 951
 952 /*
 953  * Function to calculate exponential acceleration.
 954  * (Also includes linear acceleration if enabled.)
 955  *
 956  * In order to give a smoother behaviour, we record the four
 957  * most recent non-zero movements and use their average value
 958  * to calculate the acceleration.
 959  */
 960
 961 static void
 962 expoacc(int dx, int dy, int *movex, int *movey)
 963 {
 964     static float lastlength[3] = {0.0, 0.0, 0.0};
 965     float fdx, fdy, length, lbase, accel;
 966
 967     if (dx == 0 && dy == 0) {
 968         *movex = *movey = 0;
 969         return;
 970     }
 971     fdx = dx * rodent.accelx;
 972     fdy = dy * rodent.accely;
 973     length = sqrtf((fdx * fdx) + (fdy * fdy));          /* Pythagoras */
 974     length = (length + lastlength[0] + lastlength[1] + lastlength[2]) / 4;
 975     lbase = length / rodent.expoffset;
 976     accel = powf(lbase, rodent.expoaccel) / lbase;
 977     fdx = fdx * accel + rodent.remainx;
 978     fdy = fdy * accel + rodent.remainy;
 979     *movex = lroundf(fdx);
 980     *movey = lroundf(fdy);
 981     rodent.remainx = fdx - *movex;
 982     rodent.remainy = fdy - *movey;
 983     lastlength[2] = lastlength[1];
 984     lastlength[1] = lastlength[0];
 985     lastlength[0] = length;     /* Insert new average, not original length! */
 986 }
 987
 988 static void
 989 moused(void)
 990 {
 991     struct mouse_info mouse;
 992     mousestatus_t action0;              /* original mouse action */
 993     mousestatus_t action;               /* interim buffer */
 994     mousestatus_t action2;              /* mapped action */
 995     struct timeval timeout;
 996     fd_set fds;
 997     u_char b;
 998     pid_t mpid;
 999     int flags;
1000     int c;
1001     int i;
1002
1003     if ((rodent.cfd = open("/dev/consolectl", O_RDWR, 0)) == -1)
1004         logerr(1, "cannot open /dev/consolectl");
1005
1006     if (!nodaemon && !background) {
1007         pfh = pidfile_open(pidfile, 0600, &mpid);
1008         if (pfh == NULL) {
1009             if (errno == EEXIST)
1010                 logerrx(1, "moused already running, pid: %d", mpid);
1011             logwarn("cannot open pid file");
1012         }
1013         if (daemon(0, 0)) {
1014             int saved_errno = errno;
1015             pidfile_remove(pfh);
1016             errno = saved_errno;
1017             logerr(1, "failed to become a daemon");
1018         } else {
1019             background = TRUE;
1020             pidfile_write(pfh);
1021         }
1022     }
1023
1024     /* clear mouse data */
1025     bzero(&action0, sizeof(action0));
1026     bzero(&action, sizeof(action));
1027     bzero(&action2, sizeof(action2));
1028     bzero(&mouse, sizeof(mouse));
1029     mouse_button_state = S0;
1030     clock_gettime(CLOCK_MONOTONIC_FAST, &mouse_button_state_ts);
1031     mouse_move_delayed = 0;
1032     for (i = 0; i < MOUSE_MAXBUTTON; ++i) {
1033         bstate[i].count = 0;
1034         bstate[i].ts = mouse_button_state_ts;
1035     }
1036     for (i = 0; i < (int)(sizeof(zstate) / sizeof(zstate[0])); ++i) {
1037         zstate[i].count = 0;
1038         zstate[i].ts = mouse_button_state_ts;
1039     }
1040
1041     /* choose which ioctl command to use */
1042     mouse.operation = MOUSE_MOTION_EVENT;
1043     extioctl = (ioctl(rodent.cfd, CONS_MOUSECTL, &mouse) == 0);
1044
1045     /* process mouse data */
1046     timeout.tv_sec = 0;
1047     timeout.tv_usec = 20000;            /* 20 msec */
1048     for (;;) {
1049
1050         FD_ZERO(&fds);
1051         FD_SET(rodent.mfd, &fds);
1052         if (rodent.mremsfd >= 0)
1053             FD_SET(rodent.mremsfd, &fds);
1054         if (rodent.mremcfd >= 0)
1055             FD_SET(rodent.mremcfd, &fds);
1056
1057         c = select(FD_SETSIZE, &fds, NULL, NULL,
1058                    ((rodent.flags & Emulate3Button) &&
1059                     S_DELAYED(mouse_button_state)) ? &timeout : NULL);
1060         if (c < 0) {                    /* error */
1061             logwarn("failed to read from mouse");
1062             continue;
1063         } else if (c == 0) {            /* timeout */
1064             /* assert(rodent.flags & Emulate3Button) */
1065             action0.button = action0.obutton;
1066             action0.dx = action0.dy = action0.dz = 0;
1067             action0.flags = flags = 0;
1068             if (r_timeout() && r_statetrans(&action0, &action, A_TIMEOUT)) {
1069                 if (debug > 2)
1070                     debug("flags:%08x buttons:%08x obuttons:%08x",
1071                           action.flags, action.button, action.obutton);
1072             } else {
1073                 action0.obutton = action0.button;
1074                 continue;
1075             }
1076         } else {
1077             /*  MouseRemote client connect/disconnect  */
1078             if ((rodent.mremsfd >= 0) && FD_ISSET(rodent.mremsfd, &fds)) {
1079                 mremote_clientchg(TRUE);
1080                 continue;
1081             }
1082             if ((rodent.mremcfd >= 0) && FD_ISSET(rodent.mremcfd, &fds)) {
1083                 mremote_clientchg(FALSE);
1084                 continue;
1085             }
1086             /* mouse movement */
1087             if (read(rodent.mfd, &b, 1) == -1) {
1088                 if (errno == EWOULDBLOCK)
1089                     continue;
1090                 else
1091                     return;
1092             }
1093             if ((flags = r_protocol(b, &action0)) == 0)
1094                 continue;
1095
1096             if ((rodent.flags & VirtualScroll) || (rodent.flags & HVirtualScroll)) {
1097                 /* Allow middle button drags to scroll up and down */
1098                 if (action0.button == MOUSE_BUTTON2DOWN) {
1099                     if (scroll_state == SCROLL_NOTSCROLLING) {
1100                         scroll_state = SCROLL_PREPARE;
1101                         scroll_movement = hscroll_movement = 0;
1102                         debug("PREPARING TO SCROLL");
1103                     }
1104                     debug("[BUTTON2] flags:%08x buttons:%08x obuttons:%08x",
1105                           action.flags, action.button, action.obutton);
1106                 } else {
1107                     debug("[NOTBUTTON2] flags:%08x buttons:%08x obuttons:%08x",
1108                           action.flags, action.button, action.obutton);
1109
1110                     /* This isn't a middle button down... move along... */
1111                     if (scroll_state == SCROLL_SCROLLING) {
1112                         /*
1113                          * We were scrolling, someone let go of button 2.
1114                          * Now turn autoscroll off.
1115                          */
1116                         scroll_state = SCROLL_NOTSCROLLING;
1117                         debug("DONE WITH SCROLLING / %d", scroll_state);
1118                     } else if (scroll_state == SCROLL_PREPARE) {
1119                         mousestatus_t newaction = action0;
1120
1121                         /* We were preparing to scroll, but we never moved... */
1122                         r_timestamp(&action0);
1123                         r_statetrans(&action0, &newaction,
1124                                      A(newaction.button & MOUSE_BUTTON1DOWN,
1125                                        action0.button & MOUSE_BUTTON3DOWN));
1126
1127                         /* Send middle down */
1128                         newaction.button = MOUSE_BUTTON2DOWN;
1129                         r_click(&newaction);
1130
1131                         /* Send middle up */
1132                         r_timestamp(&newaction);
1133                         newaction.obutton = newaction.button;
1134                         newaction.button = action0.button;
1135                         r_click(&newaction);
1136                     }
1137                 }
1138             }
1139
1140             r_timestamp(&action0);
1141             r_statetrans(&action0, &action,
1142                          A(action0.button & MOUSE_BUTTON1DOWN,
1143                            action0.button & MOUSE_BUTTON3DOWN));
1144             debug("flags:%08x buttons:%08x obuttons:%08x", action.flags,
1145                   action.button, action.obutton);
1146         }
1147         action0.obutton = action0.button;
1148         flags &= MOUSE_POSCHANGED;
1149         flags |= action.obutton ^ action.button;
1150         action.flags = flags;
1151
1152         if (flags) {                    /* handler detected action */
1153             r_map(&action, &action2);
1154             debug("activity : buttons 0x%08x  dx %d  dy %d  dz %d",
1155                 action2.button, action2.dx, action2.dy, action2.dz);
1156
1157             if ((rodent.flags & VirtualScroll) || (rodent.flags & HVirtualScroll)) {
1158                 /*
1159                  * If *only* the middle button is pressed AND we are moving
1160                  * the stick/trackpoint/nipple, scroll!
1161                  */
1162                 if (scroll_state == SCROLL_PREPARE) {
1163                         /* Middle button down, waiting for movement threshold */
1164                         if (action2.dy || action2.dx) {
1165                                 if (rodent.flags & VirtualScroll) {
1166                                         scroll_movement += action2.dy;
1167                                         if (scroll_movement < -rodent.scrollthreshold) {
1168                                                 scroll_state = SCROLL_SCROLLING;
1169                                         } else if (scroll_movement > rodent.scrollthreshold) {
1170                                                 scroll_state = SCROLL_SCROLLING;
1171                                         }
1172                                 }
1173                                 if (rodent.flags & HVirtualScroll) {
1174                                         hscroll_movement += action2.dx;
1175                                         if (hscroll_movement < -rodent.scrollthreshold) {
1176                                                 scroll_state = SCROLL_SCROLLING;
1177                                         } else if (hscroll_movement > rodent.scrollthreshold) {
1178                                                 scroll_state = SCROLL_SCROLLING;
1179                                         }
1180                                 }
1181                                 if (scroll_state == SCROLL_SCROLLING) scroll_movement = hscroll_movement = 0;
1182                         }
1183                 } else if (scroll_state == SCROLL_SCROLLING) {
1184                          if (rodent.flags & VirtualScroll) {
1185                                  scroll_movement += action2.dy;
1186                                  debug("SCROLL: %d", scroll_movement);
1187                             if (scroll_movement < -rodent.scrollspeed) {
1188                                 /* Scroll down */
1189                                 action2.dz = -1;
1190                                 scroll_movement = 0;
1191                             }
1192                             else if (scroll_movement > rodent.scrollspeed) {
1193                                 /* Scroll up */
1194                                 action2.dz = 1;
1195                                 scroll_movement = 0;
1196                             }
1197                          }
1198                          if (rodent.flags & HVirtualScroll) {
1199                                  hscroll_movement += action2.dx;
1200                                  debug("HORIZONTAL SCROLL: %d", hscroll_movement);
1201
1202                                  if (hscroll_movement < -rodent.scrollspeed) {
1203                                          action2.dz = -2;
1204                                          hscroll_movement = 0;
1205                                  }
1206                                  else if (hscroll_movement > rodent.scrollspeed) {
1207                                          action2.dz = 2;
1208                                          hscroll_movement = 0;
1209                                  }
1210                          }
1211
1212                     /* Don't move while scrolling */
1213                     action2.dx = action2.dy = 0;
1214                 }
1215             }
1216
1217             if (drift_terminate) {
1218                 if ((flags & MOUSE_POSCHANGED) == 0 || action.dz || action2.dz)
1219                     drift_last_activity = drift_current_ts;
1220                 else {
1221                     /* X or/and Y movement only - possibly drift */
1222                     tssub(&drift_current_ts, &drift_last_activity, &drift_tmp);
1223                     if (tscmp(&drift_tmp, &drift_after_ts, >)) {
1224                         tssub(&drift_current_ts, &drift_since, &drift_tmp);
1225                         if (tscmp(&drift_tmp, &drift_time_ts, <)) {
1226                             drift_last.x += action2.dx;
1227                             drift_last.y += action2.dy;
1228                         } else {
1229                             /* discard old accumulated steps (drift) */
1230                             if (tscmp(&drift_tmp, &drift_2time_ts, >))
1231                                 drift_previous.x = drift_previous.y = 0;
1232                             else
1233                                 drift_previous = drift_last;
1234                             drift_last.x = action2.dx;
1235                             drift_last.y = action2.dy;
1236                             drift_since = drift_current_ts;
1237                         }
1238                         if (abs(drift_last.x) + abs(drift_last.y)
1239                           > drift_distance) {
1240                             /* real movement, pass all accumulated steps */
1241                             action2.dx = drift_previous.x + drift_last.x;
1242                             action2.dy = drift_previous.y + drift_last.y;
1243                             /* and reset accumulators */
1244                             tsclr(&drift_since);
1245                             drift_last.x = drift_last.y = 0;
1246                             /* drift_previous will be cleared at next movement*/
1247                             drift_last_activity = drift_current_ts;
1248                         } else {
1249                             continue;   /* don't pass current movement to
1250                                          * console driver */
1251                         }
1252                     }
1253                 }
1254             }
1255
1256             if (extioctl) {
1257                 /* Defer clicks until we aren't VirtualScroll'ing. */
1258                 if (scroll_state == SCROLL_NOTSCROLLING)
1259                     r_click(&action2);
1260
1261                 if (action2.flags & MOUSE_POSCHANGED) {
1262                     mouse.operation = MOUSE_MOTION_EVENT;
1263                     mouse.u.data.buttons = action2.button;
1264                     if (rodent.flags & ExponentialAcc) {
1265                         expoacc(action2.dx, action2.dy,
1266                             &mouse.u.data.x, &mouse.u.data.y);
1267                     }
1268                     else {
1269                         linacc(action2.dx, action2.dy,
1270                             &mouse.u.data.x, &mouse.u.data.y);
1271                     }
1272                     mouse.u.data.z = action2.dz;
1273                     if (debug < 2)
1274                         if (!paused)
1275                                 ioctl(rodent.cfd, CONS_MOUSECTL, &mouse);
1276                 }
1277             } else {
1278                 mouse.operation = MOUSE_ACTION;
1279                 mouse.u.data.buttons = action2.button;
1280                 if (rodent.flags & ExponentialAcc) {
1281                     expoacc(action2.dx, action2.dy,
1282                         &mouse.u.data.x, &mouse.u.data.y);
1283                 }
1284                 else {
1285                     linacc(action2.dx, action2.dy,
1286                         &mouse.u.data.x, &mouse.u.data.y);
1287                 }
1288                 mouse.u.data.z = action2.dz;
1289                 if (debug < 2)
1290                     if (!paused)
1291                         ioctl(rodent.cfd, CONS_MOUSECTL, &mouse);
1292             }
1293
1294             /*
1295              * If the Z axis movement is mapped to an imaginary physical
1296              * button, we need to cook up a corresponding button `up' event
1297              * after sending a button `down' event.
1298              */
1299             if ((rodent.zmap[0] > 0) && (action.dz != 0)) {
1300                 action.obutton = action.button;
1301                 action.dx = action.dy = action.dz = 0;
1302                 r_map(&action, &action2);
1303                 debug("activity : buttons 0x%08x  dx %d  dy %d  dz %d",
1304                     action2.button, action2.dx, action2.dy, action2.dz);
1305
1306                 if (extioctl) {
1307                     r_click(&action2);
1308                 } else {
1309                     mouse.operation = MOUSE_ACTION;
1310                     mouse.u.data.buttons = action2.button;
1311                     mouse.u.data.x = mouse.u.data.y = mouse.u.data.z = 0;
1312                     if (debug < 2)
1313                         if (!paused)
1314                             ioctl(rodent.cfd, CONS_MOUSECTL, &mouse);
1315                 }
1316             }
1317         }
1318     }
1319     /* NOT REACHED */
1320 }
1321
1322 static void
1323 hup(__unused int sig)
1324 {
1325     longjmp(env, 1);
1326 }
1327
1328 static void
1329 cleanup(__unused int sig)
1330 {
1331     if (rodent.rtype == MOUSE_PROTO_X10MOUSEREM)
1332         unlink(_PATH_MOUSEREMOTE);
1333     exit(0);
1334 }
1335
1336 static void
1337 pause_mouse(__unused int sig)
1338 {
1339     paused = !paused;
1340 }
1341
1342 /**
1343  ** usage
1344  **
1345  ** Complain, and free the CPU for more worthy tasks
1346  **/
1347 static void
1348 usage(void)
1349 {
1350     fprintf(stderr, "%s\n%s\n%s\n%s\n%s\n",
1351         "usage: moused [-DRcdfs] [-I file] [-F rate] [-r resolution] [-S baudrate]",
1352         "              [-VH [-U threshold]] [-a X[,Y]] [-C threshold] [-m N=M] [-w N]",
1353         "              [-z N] [-t <mousetype>] [-l level] [-3 [-E timeout]]",
1354         "              [-T distance[,time[,after]]] -p <port>",
1355         "       moused [-d] -i <port|if|type|model|all> -p <port>");
1356     exit(1);
1357 }
1358
1359 /*
1360  * Output an error message to syslog or stderr as appropriate. If
1361  * `errnum' is non-zero, append its string form to the message.
1362  */
1363 static void
1364 log_or_warn(int log_pri, int errnum, const char *fmt, ...)
1365 {
1366         va_list ap;
1367         char buf[256];
1368
1369         va_start(ap, fmt);
1370         vsnprintf(buf, sizeof(buf), fmt, ap);
1371         va_end(ap);
1372         if (errnum) {
1373                 strlcat(buf, ": ", sizeof(buf));
1374                 strlcat(buf, strerror(errnum), sizeof(buf));
1375         }
1376
1377         if (background)
1378                 syslog(log_pri, "%s", buf);
1379         else
1380                 warnx("%s", buf);
1381 }
1382
1383 /**
1384  ** Mouse interface code, courtesy of XFree86 3.1.2.
1385  **
1386  ** Note: Various bits have been trimmed, and in my shortsighted enthusiasm
1387  ** to clean, reformat and rationalise naming, it's quite possible that
1388  ** some things in here have been broken.
1389  **
1390  ** I hope not 8)
1391  **
1392  ** The following code is derived from a module marked :
1393  **/
1394
1395 /* $XConsortium: xf86_Mouse.c,v 1.2 94/10/12 20:33:21 kaleb Exp $ */
1396 /* $XFree86: xc/programs/Xserver/hw/xfree86/common/xf86_Mouse.c,v 3.2 1995/01/28
1397  17:03:40 dawes Exp $ */
1398 /*
1399  *
1400  * Copyright 1990,91 by Thomas Roell, Dinkelscherben, Germany.
1401  * Copyright 1993 by David Dawes <dawes@physics.su.oz.au>
1402  *
1403  * Permission to use, copy, modify, distribute, and sell this software and its
1404  * documentation for any purpose is hereby granted without fee, provided that
1405  * the above copyright notice appear in all copies and that both that
1406  * copyright notice and this permission notice appear in supporting
1407  * documentation, and that the names of Thomas Roell and David Dawes not be
1408  * used in advertising or publicity pertaining to distribution of the
1409  * software without specific, written prior permission.  Thomas Roell
1410  * and David Dawes makes no representations about the suitability of this
1411  * software for any purpose.  It is provided "as is" without express or
1412  * implied warranty.
1413  *
1414  * THOMAS ROELL AND DAVID DAWES DISCLAIM ALL WARRANTIES WITH REGARD TO THIS
1415  * SOFTWARE, INCLUDING ALL IMPLIED WARRANTIES OF MERCHANTABILITY AND
1416  * FITNESS, IN NO EVENT SHALL THOMAS ROELL OR DAVID DAWES BE LIABLE FOR ANY
1417  * SPECIAL, INDIRECT OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES WHATSOEVER
1418  * RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN ACTION OF
1419  * CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF OR IN
1420  * CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
1421  *
1422  */
1423
1424 /**
1425  ** GlidePoint support from XFree86 3.2.
1426  ** Derived from the module:
1427  **/
1428
1429 /* $XFree86: xc/programs/Xserver/hw/xfree86/common/xf86_Mouse.c,v 3.19 1996/10/16 14:40:51 dawes Exp $ */
1430 /* $XConsortium: xf86_Mouse.c /main/10 1996/01/30 15:16:12 kaleb $ */
1431
1432 /* the following table must be ordered by MOUSE_PROTO_XXX in mouse.h */
1433 static unsigned char proto[][7] = {
1434     /*  hd_mask hd_id   dp_mask dp_id   bytes b4_mask b4_id */
1435     {   0x40,   0x40,   0x40,   0x00,   3,   ~0x23,  0x00 }, /* MicroSoft */
1436     {   0xf8,   0x80,   0x00,   0x00,   5,    0x00,  0xff }, /* MouseSystems */
1437     {   0xe0,   0x80,   0x80,   0x00,   3,    0x00,  0xff }, /* Logitech */
1438     {   0xe0,   0x80,   0x80,   0x00,   3,    0x00,  0xff }, /* MMSeries */
1439     {   0x40,   0x40,   0x40,   0x00,   3,   ~0x33,  0x00 }, /* MouseMan */
1440     {   0xf8,   0x80,   0x00,   0x00,   5,    0x00,  0xff }, /* Bus */
1441     {   0xf8,   0x80,   0x00,   0x00,   5,    0x00,  0xff }, /* InPort */
1442     {   0xc0,   0x00,   0x00,   0x00,   3,    0x00,  0xff }, /* PS/2 mouse */
1443     {   0xe0,   0x80,   0x80,   0x00,   3,    0x00,  0xff }, /* MM HitTablet */
1444     {   0x40,   0x40,   0x40,   0x00,   3,   ~0x33,  0x00 }, /* GlidePoint */
1445     {   0x40,   0x40,   0x40,   0x00,   3,   ~0x3f,  0x00 }, /* IntelliMouse */
1446     {   0x40,   0x40,   0x40,   0x00,   3,   ~0x33,  0x00 }, /* ThinkingMouse */
1447     {   0xf8,   0x80,   0x00,   0x00,   5,    0x00,  0xff }, /* sysmouse */
1448     {   0x40,   0x40,   0x40,   0x00,   3,   ~0x23,  0x00 }, /* X10 MouseRem */
1449     {   0x80,   0x80,   0x00,   0x00,   5,    0x00,  0xff }, /* KIDSPAD */
1450     {   0xc3,   0xc0,   0x00,   0x00,   6,    0x00,  0xff }, /* VersaPad */
1451     {   0x00,   0x00,   0x00,   0x00,   1,    0x00,  0xff }, /* JogDial */
1452 #if notyet
1453     {   0xf8,   0x80,   0x00,   0x00,   5,   ~0x2f,  0x10 }, /* Mariqua */
1454 #endif
1455 };
1456 static unsigned char cur_proto[7];
1457
1458 static int
1459 r_identify(void)
1460 {
1461     char pnpbuf[256];   /* PnP identifier string may be up to 256 bytes long */
1462     pnpid_t pnpid;
1463     symtab_t *t;
1464     int level;
1465     int len;
1466
1467     /* set the driver operation level, if applicable */
1468     if (rodent.level < 0)
1469         rodent.level = 1;
1470     ioctl(rodent.mfd, MOUSE_SETLEVEL, &rodent.level);
1471     rodent.level = (ioctl(rodent.mfd, MOUSE_GETLEVEL, &level) == 0) ? level : 0;
1472
1473     /*
1474      * Interrogate the driver and get some intelligence on the device...
1475      * The following ioctl functions are not always supported by device
1476      * drivers.  When the driver doesn't support them, we just trust the
1477      * user to supply valid information.
1478      */
1479     rodent.hw.iftype = MOUSE_IF_UNKNOWN;
1480     rodent.hw.model = MOUSE_MODEL_GENERIC;
1481     ioctl(rodent.mfd, MOUSE_GETHWINFO, &rodent.hw);
1482
1483     if (rodent.rtype != MOUSE_PROTO_UNKNOWN)
1484         bcopy(proto[rodent.rtype], cur_proto, sizeof(cur_proto));
1485     rodent.mode.protocol = MOUSE_PROTO_UNKNOWN;
1486     rodent.mode.rate = -1;
1487     rodent.mode.resolution = MOUSE_RES_UNKNOWN;
1488     rodent.mode.accelfactor = 0;
1489     rodent.mode.level = 0;
1490     if (ioctl(rodent.mfd, MOUSE_GETMODE, &rodent.mode) == 0) {
1491         if (rodent.mode.protocol == MOUSE_PROTO_UNKNOWN ||
1492             rodent.mode.protocol >= (int)(sizeof(proto) / sizeof(proto[0]))) {
1493             logwarnx("unknown mouse protocol (%d)", rodent.mode.protocol);
1494             return (MOUSE_PROTO_UNKNOWN);
1495         } else {
1496             if (rodent.mode.protocol != rodent.rtype) {
1497                 /* Hmm, the driver doesn't agree with the user... */
1498                 if (rodent.rtype != MOUSE_PROTO_UNKNOWN)
1499                     logwarnx("mouse type mismatch (%s != %s), %s is assumed",
1500                         r_name(rodent.mode.protocol), r_name(rodent.rtype),
1501                         r_name(rodent.mode.protocol));
1502                 rodent.rtype = rodent.mode.protocol;
1503                 bcopy(proto[rodent.rtype], cur_proto, sizeof(cur_proto));
1504             }
1505         }
1506         cur_proto[4] = rodent.mode.packetsize;
1507         cur_proto[0] = rodent.mode.syncmask[0]; /* header byte bit mask */
1508         cur_proto[1] = rodent.mode.syncmask[1]; /* header bit pattern */
1509     }
1510
1511     /* maybe this is a PnP mouse... */
1512     if (rodent.mode.protocol == MOUSE_PROTO_UNKNOWN) {
1513
1514         if (rodent.flags & NoPnP)
1515             return (rodent.rtype);
1516         if (((len = pnpgets(pnpbuf)) <= 0) || !pnpparse(&pnpid, pnpbuf, len))
1517             return (rodent.rtype);
1518
1519         debug("PnP serial mouse: '%*.*s' '%*.*s' '%*.*s'",
1520             pnpid.neisaid, pnpid.neisaid, pnpid.eisaid,
1521             pnpid.ncompat, pnpid.ncompat, pnpid.compat,
1522             pnpid.ndescription, pnpid.ndescription, pnpid.description);
1523
1524         /* we have a valid PnP serial device ID */
1525         rodent.hw.iftype = MOUSE_IF_SERIAL;
1526         t = pnpproto(&pnpid);
1527         if (t != NULL) {
1528             rodent.mode.protocol = t->val;
1529             rodent.hw.model = t->val2;
1530         } else {
1531             rodent.mode.protocol = MOUSE_PROTO_UNKNOWN;
1532         }
1533
1534         /* make final adjustment */
1535         if (rodent.mode.protocol != MOUSE_PROTO_UNKNOWN) {
1536             if (rodent.mode.protocol != rodent.rtype) {
1537                 /* Hmm, the device doesn't agree with the user... */
1538                 if (rodent.rtype != MOUSE_PROTO_UNKNOWN)
1539                     logwarnx("mouse type mismatch (%s != %s), %s is assumed",
1540                         r_name(rodent.mode.protocol), r_name(rodent.rtype),
1541                         r_name(rodent.mode.protocol));
1542                 rodent.rtype = rodent.mode.protocol;
1543                 bcopy(proto[rodent.rtype], cur_proto, sizeof(cur_proto));
1544             }
1545         }
1546     }
1547
1548     debug("proto params: %02x %02x %02x %02x %d %02x %02x",
1549         cur_proto[0], cur_proto[1], cur_proto[2], cur_proto[3],
1550         cur_proto[4], cur_proto[5], cur_proto[6]);
1551
1552     return (rodent.rtype);
1553 }
1554
1555 static const char *
1556 r_if(int iftype)
1557 {
1558
1559     return (gettokenname(rifs, iftype));
1560 }
1561
1562 static const char *
1563 r_name(int type)
1564 {
1565     const char *unknown = "unknown";
1566
1567     return (type == MOUSE_PROTO_UNKNOWN ||
1568         type >= (int)(sizeof(rnames) / sizeof(rnames[0])) ?
1569         unknown : rnames[type]);
1570 }
1571
1572 static const char *
1573 r_model(int model)
1574 {
1575
1576     return (gettokenname(rmodels, model));
1577 }
1578
1579 static void
1580 r_init(void)
1581 {
1582     unsigned char buf[16];      /* scrach buffer */
1583     fd_set fds;
1584     const char *s;
1585     char c;
1586     int i;
1587
1588     /**
1589      ** This comment is a little out of context here, but it contains
1590      ** some useful information...
1591      ********************************************************************
1592      **
1593      ** The following lines take care of the Logitech MouseMan protocols.
1594      **
1595      ** NOTE: There are different versions of both MouseMan and TrackMan!
1596      **       Hence I add another protocol P_LOGIMAN, which the user can
1597      **       specify as MouseMan in his XF86Config file. This entry was
1598      **       formerly handled as a special case of P_MS. However, people
1599      **       who don't have the middle button problem, can still specify
1600      **       Microsoft and use P_MS.
1601      **
1602      ** By default, these mice should use a 3 byte Microsoft protocol
1603      ** plus a 4th byte for the middle button. However, the mouse might
1604      ** have switched to a different protocol before we use it, so I send
1605      ** the proper sequence just in case.
1606      **
1607      ** NOTE: - all commands to (at least the European) MouseMan have to
1608      **         be sent at 1200 Baud.
1609      **       - each command starts with a '*'.
1610      **       - whenever the MouseMan receives a '*', it will switch back
1611      **  to 1200 Baud. Hence I have to select the desired protocol
1612      **  first, then select the baud rate.
1613      **
1614      ** The protocols supported by the (European) MouseMan are:
1615      **   -  5 byte packed binary protocol, as with the Mouse Systems
1616      **      mouse. Selected by sequence "*U".
1617      **   -  2 button 3 byte MicroSoft compatible protocol. Selected
1618      **      by sequence "*V".
1619      **   -  3 button 3+1 byte MicroSoft compatible protocol (default).
1620      **      Selected by sequence "*X".
1621      **
1622      ** The following baud rates are supported:
1623      **   -  1200 Baud (default). Selected by sequence "*n".
1624      **   -  9600 Baud. Selected by sequence "*q".
1625      **
1626      ** Selecting a sample rate is no longer supported with the MouseMan!
1627      ** Some additional lines in xf86Config.c take care of ill configured
1628      ** baud rates and sample rates. (The user will get an error.)
1629      */
1630
1631     switch (rodent.rtype) {
1632
1633     case MOUSE_PROTO_LOGI:
1634         /*
1635          * The baud rate selection command must be sent at the current
1636          * baud rate; try all likely settings
1637          */
1638         setmousespeed(9600, rodent.baudrate, rodentcflags[rodent.rtype]);
1639         setmousespeed(4800, rodent.baudrate, rodentcflags[rodent.rtype]);
1640         setmousespeed(2400, rodent.baudrate, rodentcflags[rodent.rtype]);
1641         setmousespeed(1200, rodent.baudrate, rodentcflags[rodent.rtype]);
1642         /* select MM series data format */
1643         write(rodent.mfd, "S", 1);
1644         setmousespeed(rodent.baudrate, rodent.baudrate,
1645                       rodentcflags[MOUSE_PROTO_MM]);
1646         /* select report rate/frequency */
1647         if      (rodent.rate <= 0)   write(rodent.mfd, "O", 1);
1648         else if (rodent.rate <= 15)  write(rodent.mfd, "J", 1);
1649         else if (rodent.rate <= 27)  write(rodent.mfd, "K", 1);
1650         else if (rodent.rate <= 42)  write(rodent.mfd, "L", 1);
1651         else if (rodent.rate <= 60)  write(rodent.mfd, "R", 1);
1652         else if (rodent.rate <= 85)  write(rodent.mfd, "M", 1);
1653         else if (rodent.rate <= 125) write(rodent.mfd, "Q", 1);
1654         else                         write(rodent.mfd, "N", 1);
1655         break;
1656
1657     case MOUSE_PROTO_LOGIMOUSEMAN:
1658         /* The command must always be sent at 1200 baud */
1659         setmousespeed(1200, 1200, rodentcflags[rodent.rtype]);
1660         write(rodent.mfd, "*X", 2);
1661         setmousespeed(1200, rodent.baudrate, rodentcflags[rodent.rtype]);
1662         break;
1663
1664     case MOUSE_PROTO_HITTAB:
1665         setmousespeed(1200, rodent.baudrate, rodentcflags[rodent.rtype]);
1666
1667         /*
1668          * Initialize Hitachi PUMA Plus - Model 1212E to desired settings.
1669          * The tablet must be configured to be in MM mode, NO parity,
1670          * Binary Format.  xf86Info.sampleRate controls the sensativity
1671          * of the tablet.  We only use this tablet for it's 4-button puck
1672          * so we don't run in "Absolute Mode"
1673          */
1674         write(rodent.mfd, "z8", 2);     /* Set Parity = "NONE" */
1675         usleep(50000);
1676         write(rodent.mfd, "zb", 2);     /* Set Format = "Binary" */
1677         usleep(50000);
1678         write(rodent.mfd, "@", 1);      /* Set Report Mode = "Stream" */
1679         usleep(50000);
1680         write(rodent.mfd, "R", 1);      /* Set Output Rate = "45 rps" */
1681         usleep(50000);
1682         write(rodent.mfd, "I\x20", 2);  /* Set Incrememtal Mode "20" */
1683         usleep(50000);
1684         write(rodent.mfd, "E", 1);      /* Set Data Type = "Relative */
1685         usleep(50000);
1686
1687         /* Resolution is in 'lines per inch' on the Hitachi tablet */
1688         if      (rodent.resolution == MOUSE_RES_LOW)            c = 'g';
1689         else if (rodent.resolution == MOUSE_RES_MEDIUMLOW)      c = 'e';
1690         else if (rodent.resolution == MOUSE_RES_MEDIUMHIGH)     c = 'h';
1691         else if (rodent.resolution == MOUSE_RES_HIGH)           c = 'd';
1692         else if (rodent.resolution <=   40)                     c = 'g';
1693         else if (rodent.resolution <=  100)                     c = 'd';
1694         else if (rodent.resolution <=  200)                     c = 'e';
1695         else if (rodent.resolution <=  500)                     c = 'h';
1696         else if (rodent.resolution <= 1000)                     c = 'j';
1697         else                    c = 'd';
1698         write(rodent.mfd, &c, 1);
1699         usleep(50000);
1700
1701         write(rodent.mfd, "\021", 1);   /* Resume DATA output */
1702         break;
1703
1704     case MOUSE_PROTO_THINK:
1705         setmousespeed(1200, rodent.baudrate, rodentcflags[rodent.rtype]);
1706         /* the PnP ID string may be sent again, discard it */
1707         usleep(200000);
1708         i = FREAD;
1709         ioctl(rodent.mfd, TIOCFLUSH, &i);
1710         /* send the command to initialize the beast */
1711         for (s = "E5E5"; *s; ++s) {
1712             write(rodent.mfd, s, 1);
1713             FD_ZERO(&fds);
1714             FD_SET(rodent.mfd, &fds);
1715             if (select(FD_SETSIZE, &fds, NULL, NULL, NULL) <= 0)
1716                 break;
1717             read(rodent.mfd, &c, 1);
1718             debug("%c", c);
1719             if (c != *s)
1720                 break;
1721         }
1722         break;
1723
1724     case MOUSE_PROTO_JOGDIAL:
1725         break;
1726     case MOUSE_PROTO_MSC:
1727         setmousespeed(1200, rodent.baudrate, rodentcflags[rodent.rtype]);
1728         if (rodent.flags & ClearDTR) {
1729            i = TIOCM_DTR;
1730            ioctl(rodent.mfd, TIOCMBIC, &i);
1731         }
1732         if (rodent.flags & ClearRTS) {
1733            i = TIOCM_RTS;
1734            ioctl(rodent.mfd, TIOCMBIC, &i);
1735         }
1736         break;
1737
1738     case MOUSE_PROTO_SYSMOUSE:
1739         if (rodent.hw.iftype == MOUSE_IF_SYSMOUSE)
1740             setmousespeed(1200, rodent.baudrate, rodentcflags[rodent.rtype]);
1741         /* FALLTHROUGH */
1742
1743     case MOUSE_PROTO_PS2:
1744         if (rodent.rate >= 0)
1745             rodent.mode.rate = rodent.rate;
1746         if (rodent.resolution != MOUSE_RES_UNKNOWN)
1747             rodent.mode.resolution = rodent.resolution;
1748         ioctl(rodent.mfd, MOUSE_SETMODE, &rodent.mode);
1749         break;
1750
1751     case MOUSE_PROTO_X10MOUSEREM:
1752         mremote_serversetup();
1753         setmousespeed(1200, rodent.baudrate, rodentcflags[rodent.rtype]);
1754         break;
1755
1756
1757     case MOUSE_PROTO_VERSAPAD:
1758         tcsendbreak(rodent.mfd, 0);     /* send break for 400 msec */
1759         i = FREAD;
1760         ioctl(rodent.mfd, TIOCFLUSH, &i);
1761         for (i = 0; i < 7; ++i) {
1762             FD_ZERO(&fds);
1763             FD_SET(rodent.mfd, &fds);
1764             if (select(FD_SETSIZE, &fds, NULL, NULL, NULL) <= 0)
1765                 break;
1766             read(rodent.mfd, &c, 1);
1767             buf[i] = c;
1768         }
1769         debug("%s\n", buf);
1770         if ((buf[0] != 'V') || (buf[1] != 'P')|| (buf[7] != '\r'))
1771             break;
1772         setmousespeed(9600, rodent.baudrate, rodentcflags[rodent.rtype]);
1773         tcsendbreak(rodent.mfd, 0);     /* send break for 400 msec again */
1774         for (i = 0; i < 7; ++i) {
1775             FD_ZERO(&fds);
1776             FD_SET(rodent.mfd, &fds);
1777             if (select(FD_SETSIZE, &fds, NULL, NULL, NULL) <= 0)
1778                 break;
1779             read(rodent.mfd, &c, 1);
1780             debug("%c", c);
1781             if (c != buf[i])
1782                 break;
1783         }
1784         i = FREAD;
1785         ioctl(rodent.mfd, TIOCFLUSH, &i);
1786         break;
1787
1788     default:
1789         setmousespeed(1200, rodent.baudrate, rodentcflags[rodent.rtype]);
1790         break;
1791     }
1792 }
1793
1794 static int
1795 r_protocol(u_char rBuf, mousestatus_t *act)
1796 {
1797     /* MOUSE_MSS_BUTTON?DOWN -> MOUSE_BUTTON?DOWN */
1798     static int butmapmss[4] = { /* Microsoft, MouseMan, GlidePoint,
1799                                    IntelliMouse, Thinking Mouse */
1800         0,
1801         MOUSE_BUTTON3DOWN,
1802         MOUSE_BUTTON1DOWN,
1803         MOUSE_BUTTON1DOWN | MOUSE_BUTTON3DOWN,
1804     };
1805     static int butmapmss2[4] = { /* Microsoft, MouseMan, GlidePoint,
1806                                     Thinking Mouse */
1807         0,
1808         MOUSE_BUTTON4DOWN,
1809         MOUSE_BUTTON2DOWN,
1810         MOUSE_BUTTON2DOWN | MOUSE_BUTTON4DOWN,
1811     };
1812     /* MOUSE_INTELLI_BUTTON?DOWN -> MOUSE_BUTTON?DOWN */
1813     static int butmapintelli[4] = { /* IntelliMouse, NetMouse, Mie Mouse,
1814                                        MouseMan+ */
1815         0,
1816         MOUSE_BUTTON2DOWN,
1817         MOUSE_BUTTON4DOWN,
1818         MOUSE_BUTTON2DOWN | MOUSE_BUTTON4DOWN,
1819     };
1820     /* MOUSE_MSC_BUTTON?UP -> MOUSE_BUTTON?DOWN */
1821     static int butmapmsc[8] = { /* MouseSystems, MMSeries, Logitech,
1822                                    Bus, sysmouse */
1823         0,
1824         MOUSE_BUTTON3DOWN,
1825         MOUSE_BUTTON2DOWN,
1826         MOUSE_BUTTON2DOWN | MOUSE_BUTTON3DOWN,
1827         MOUSE_BUTTON1DOWN,
1828         MOUSE_BUTTON1DOWN | MOUSE_BUTTON3DOWN,
1829         MOUSE_BUTTON1DOWN | MOUSE_BUTTON2DOWN,
1830         MOUSE_BUTTON1DOWN | MOUSE_BUTTON2DOWN | MOUSE_BUTTON3DOWN
1831     };
1832     /* MOUSE_PS2_BUTTON?DOWN -> MOUSE_BUTTON?DOWN */
1833     static int butmapps2[8] = { /* PS/2 */
1834         0,
1835         MOUSE_BUTTON1DOWN,
1836         MOUSE_BUTTON3DOWN,
1837         MOUSE_BUTTON1DOWN | MOUSE_BUTTON3DOWN,
1838         MOUSE_BUTTON2DOWN,
1839         MOUSE_BUTTON1DOWN | MOUSE_BUTTON2DOWN,
1840         MOUSE_BUTTON2DOWN | MOUSE_BUTTON3DOWN,
1841         MOUSE_BUTTON1DOWN | MOUSE_BUTTON2DOWN | MOUSE_BUTTON3DOWN
1842     };
1843     /* for Hitachi tablet */
1844     static int butmaphit[8] = { /* MM HitTablet */
1845         0,
1846         MOUSE_BUTTON3DOWN,
1847         MOUSE_BUTTON2DOWN,
1848         MOUSE_BUTTON1DOWN,
1849         MOUSE_BUTTON4DOWN,
1850         MOUSE_BUTTON5DOWN,
1851         MOUSE_BUTTON6DOWN,
1852         MOUSE_BUTTON7DOWN,
1853     };
1854     /* for serial VersaPad */
1855     static int butmapversa[8] = { /* VersaPad */
1856         0,
1857         0,
1858         MOUSE_BUTTON3DOWN,
1859         MOUSE_BUTTON3DOWN,
1860         MOUSE_BUTTON1DOWN,
1861         MOUSE_BUTTON1DOWN,
1862         MOUSE_BUTTON1DOWN | MOUSE_BUTTON3DOWN,
1863         MOUSE_BUTTON1DOWN | MOUSE_BUTTON3DOWN,
1864     };
1865     /* for PS/2 VersaPad */
1866     static int butmapversaps2[8] = { /* VersaPad */
1867         0,
1868         MOUSE_BUTTON3DOWN,
1869         0,
1870         MOUSE_BUTTON3DOWN,
1871         MOUSE_BUTTON1DOWN,
1872         MOUSE_BUTTON1DOWN | MOUSE_BUTTON3DOWN,
1873         MOUSE_BUTTON1DOWN,
1874         MOUSE_BUTTON1DOWN | MOUSE_BUTTON3DOWN,
1875     };
1876     static int           pBufP = 0;
1877     static unsigned char pBuf[8];
1878     static int           prev_x, prev_y;
1879     static int           on = FALSE;
1880     int                  x, y;
1881
1882     debug("received char 0x%x",(int)rBuf);
1883     if (rodent.rtype == MOUSE_PROTO_KIDSPAD)
1884         return (kidspad(rBuf, act));
1885     if (rodent.rtype == MOUSE_PROTO_GTCO_DIGIPAD)
1886         return (gtco_digipad(rBuf, act));
1887
1888     /*
1889      * Hack for resyncing: We check here for a package that is:
1890      *  a) illegal (detected by wrong data-package header)
1891      *  b) invalid (0x80 == -128 and that might be wrong for MouseSystems)
1892      *  c) bad header-package
1893      *
1894      * NOTE: b) is a voilation of the MouseSystems-Protocol, since values of
1895      *       -128 are allowed, but since they are very seldom we can easily
1896      *       use them as package-header with no button pressed.
1897      * NOTE/2: On a PS/2 mouse any byte is valid as a data byte. Furthermore,
1898      *         0x80 is not valid as a header byte. For a PS/2 mouse we skip
1899      *         checking data bytes.
1900      *         For resyncing a PS/2 mouse we require the two most significant
1901      *         bits in the header byte to be 0. These are the overflow bits,
1902      *         and in case of an overflow we actually lose sync. Overflows
1903      *         are very rare, however, and we quickly gain sync again after
1904      *         an overflow condition. This is the best we can do. (Actually,
1905      *         we could use bit 0x08 in the header byte for resyncing, since
1906      *         that bit is supposed to be always on, but nobody told
1907      *         Microsoft...)
1908      */
1909
1910     if (pBufP != 0 && rodent.rtype != MOUSE_PROTO_PS2 &&
1911         ((rBuf & cur_proto[2]) != cur_proto[3] || rBuf == 0x80))
1912     {
1913         pBufP = 0;              /* skip package */
1914     }
1915
1916     if (pBufP == 0 && (rBuf & cur_proto[0]) != cur_proto[1])
1917         return (0);
1918
1919     /* is there an extra data byte? */
1920     if (pBufP >= cur_proto[4] && (rBuf & cur_proto[0]) != cur_proto[1])
1921     {
1922         /*
1923          * Hack for Logitech MouseMan Mouse - Middle button
1924          *
1925          * Unfortunately this mouse has variable length packets: the standard
1926          * Microsoft 3 byte packet plus an optional 4th byte whenever the
1927          * middle button status changes.
1928          *
1929          * We have already processed the standard packet with the movement
1930          * and button info.  Now post an event message with the old status
1931          * of the left and right buttons and the updated middle button.
1932          */
1933
1934         /*
1935          * Even worse, different MouseMen and TrackMen differ in the 4th
1936          * byte: some will send 0x00/0x20, others 0x01/0x21, or even
1937          * 0x02/0x22, so I have to strip off the lower bits.
1938          *
1939          * [JCH-96/01/21]
1940          * HACK for ALPS "fourth button". (It's bit 0x10 of the "fourth byte"
1941          * and it is activated by tapping the glidepad with the finger! 8^)
1942          * We map it to bit bit3, and the reverse map in xf86Events just has
1943          * to be extended so that it is identified as Button 4. The lower
1944          * half of the reverse-map may remain unchanged.
1945          */
1946
1947         /*
1948          * [KY-97/08/03]
1949          * Receive the fourth byte only when preceding three bytes have
1950          * been detected (pBufP >= cur_proto[4]).  In the previous
1951          * versions, the test was pBufP == 0; thus, we may have mistakingly
1952          * received a byte even if we didn't see anything preceding
1953          * the byte.
1954          */
1955
1956         if ((rBuf & cur_proto[5]) != cur_proto[6]) {
1957             pBufP = 0;
1958             return (0);
1959         }
1960
1961         switch (rodent.rtype) {
1962 #if notyet
1963         case MOUSE_PROTO_MARIQUA:
1964             /*
1965              * This mouse has 16! buttons in addition to the standard
1966              * three of them.  They return 0x10 though 0x1f in the
1967              * so-called `ten key' mode and 0x30 though 0x3f in the
1968              * `function key' mode.  As there are only 31 bits for
1969              * button state (including the standard three), we ignore
1970              * the bit 0x20 and don't distinguish the two modes.
1971              */
1972             act->dx = act->dy = act->dz = 0;
1973             act->obutton = act->button;
1974             rBuf &= 0x1f;
1975             act->button = (1 << (rBuf - 13))
1976                 | (act->obutton & (MOUSE_BUTTON1DOWN | MOUSE_BUTTON3DOWN));
1977             /*
1978              * FIXME: this is a button "down" event. There needs to be
1979              * a corresponding button "up" event... XXX
1980              */
1981             break;
1982 #endif /* notyet */
1983         case MOUSE_PROTO_JOGDIAL:
1984             break;
1985
1986         /*
1987          * IntelliMouse, NetMouse (including NetMouse Pro) and Mie Mouse
1988          * always send the fourth byte, whereas the fourth byte is
1989          * optional for GlidePoint and ThinkingMouse. The fourth byte
1990          * is also optional for MouseMan+ and FirstMouse+ in their
1991          * native mode. It is always sent if they are in the IntelliMouse
1992          * compatible mode.
1993          */
1994         case MOUSE_PROTO_INTELLI:       /* IntelliMouse, NetMouse, Mie Mouse,
1995                                            MouseMan+ */
1996             act->dx = act->dy = 0;
1997             act->dz = (rBuf & 0x08) ? (rBuf & 0x0f) - 16 : (rBuf & 0x0f);
1998             if ((act->dz >= 7) || (act->dz <= -7))
1999                 act->dz = 0;
2000             act->obutton = act->button;
2001             act->button = butmapintelli[(rBuf & MOUSE_MSS_BUTTONS) >> 4]
2002                 | (act->obutton & (MOUSE_BUTTON1DOWN | MOUSE_BUTTON3DOWN));
2003             break;
2004
2005         default:
2006             act->dx = act->dy = act->dz = 0;
2007             act->obutton = act->button;
2008             act->button = butmapmss2[(rBuf & MOUSE_MSS_BUTTONS) >> 4]
2009                 | (act->obutton & (MOUSE_BUTTON1DOWN | MOUSE_BUTTON3DOWN));
2010             break;
2011         }
2012
2013         act->flags = ((act->dx || act->dy || act->dz) ? MOUSE_POSCHANGED : 0)
2014             | (act->obutton ^ act->button);
2015         pBufP = 0;
2016         return (act->flags);
2017     }
2018
2019     if (pBufP >= cur_proto[4])
2020         pBufP = 0;
2021     pBuf[pBufP++] = rBuf;
2022     if (pBufP != cur_proto[4])
2023         return (0);
2024
2025     /*
2026      * assembly full package
2027      */
2028
2029     debug("assembled full packet (len %d) %x,%x,%x,%x,%x,%x,%x,%x",
2030         cur_proto[4],
2031         pBuf[0], pBuf[1], pBuf[2], pBuf[3],
2032         pBuf[4], pBuf[5], pBuf[6], pBuf[7]);
2033
2034     act->dz = 0;
2035     act->obutton = act->button;
2036     switch (rodent.rtype)
2037     {
2038     case MOUSE_PROTO_MS:                /* Microsoft */
2039     case MOUSE_PROTO_LOGIMOUSEMAN:      /* MouseMan/TrackMan */
2040     case MOUSE_PROTO_X10MOUSEREM:       /* X10 MouseRemote */
2041         act->button = act->obutton & MOUSE_BUTTON4DOWN;
2042         if (rodent.flags & ChordMiddle)
2043             act->button |= ((pBuf[0] & MOUSE_MSS_BUTTONS) == MOUSE_MSS_BUTTONS)
2044                 ? MOUSE_BUTTON2DOWN
2045                 : butmapmss[(pBuf[0] & MOUSE_MSS_BUTTONS) >> 4];
2046         else
2047             act->button |= (act->obutton & MOUSE_BUTTON2DOWN)
2048                 | butmapmss[(pBuf[0] & MOUSE_MSS_BUTTONS) >> 4];
2049
2050         /* Send X10 btn events to remote client (ensure -128-+127 range) */
2051         if ((rodent.rtype == MOUSE_PROTO_X10MOUSEREM) &&
2052             ((pBuf[0] & 0xFC) == 0x44) && (pBuf[2] == 0x3F)) {
2053             if (rodent.mremcfd >= 0) {
2054                 unsigned char key = (signed char)(((pBuf[0] & 0x03) << 6) |
2055                                                   (pBuf[1] & 0x3F));
2056                 write(rodent.mremcfd, &key, 1);
2057             }
2058             return (0);
2059         }
2060
2061         act->dx = (signed char)(((pBuf[0] & 0x03) << 6) | (pBuf[1] & 0x3F));
2062         act->dy = (signed char)(((pBuf[0] & 0x0C) << 4) | (pBuf[2] & 0x3F));
2063         break;
2064
2065     case MOUSE_PROTO_GLIDEPOINT:        /* GlidePoint */
2066     case MOUSE_PROTO_THINK:             /* ThinkingMouse */
2067     case MOUSE_PROTO_INTELLI:           /* IntelliMouse, NetMouse, Mie Mouse,
2068                                            MouseMan+ */
2069         act->button = (act->obutton & (MOUSE_BUTTON2DOWN | MOUSE_BUTTON4DOWN))
2070             | butmapmss[(pBuf[0] & MOUSE_MSS_BUTTONS) >> 4];
2071         act->dx = (signed char)(((pBuf[0] & 0x03) << 6) | (pBuf[1] & 0x3F));
2072         act->dy = (signed char)(((pBuf[0] & 0x0C) << 4) | (pBuf[2] & 0x3F));
2073         break;
2074
2075     case MOUSE_PROTO_MSC:               /* MouseSystems Corp */
2076 #if notyet
2077     case MOUSE_PROTO_MARIQUA:           /* Mariqua */
2078 #endif
2079         act->button = butmapmsc[(~pBuf[0]) & MOUSE_MSC_BUTTONS];
2080         act->dx =    (signed char)(pBuf[1]) + (signed char)(pBuf[3]);
2081         act->dy = - ((signed char)(pBuf[2]) + (signed char)(pBuf[4]));
2082         break;
2083
2084     case MOUSE_PROTO_JOGDIAL:           /* JogDial */
2085             if (rBuf == 0x6c)
2086               act->dz = -1;
2087             if (rBuf == 0x72)
2088               act->dz = 1;
2089             if (rBuf == 0x64)
2090               act->button = MOUSE_BUTTON1DOWN;
2091             if (rBuf == 0x75)
2092               act->button = 0;
2093         break;
2094
2095     case MOUSE_PROTO_HITTAB:            /* MM HitTablet */
2096         act->button = butmaphit[pBuf[0] & 0x07];
2097         act->dx = (pBuf[0] & MOUSE_MM_XPOSITIVE) ?   pBuf[1] : - pBuf[1];
2098         act->dy = (pBuf[0] & MOUSE_MM_YPOSITIVE) ? - pBuf[2] :   pBuf[2];
2099         break;
2100
2101     case MOUSE_PROTO_MM:                /* MM Series */
2102     case MOUSE_PROTO_LOGI:              /* Logitech Mice */
2103         act->button = butmapmsc[pBuf[0] & MOUSE_MSC_BUTTONS];
2104         act->dx = (pBuf[0] & MOUSE_MM_XPOSITIVE) ?   pBuf[1] : - pBuf[1];
2105         act->dy = (pBuf[0] & MOUSE_MM_YPOSITIVE) ? - pBuf[2] :   pBuf[2];
2106         break;
2107
2108     case MOUSE_PROTO_VERSAPAD:          /* VersaPad */
2109         act->button = butmapversa[(pBuf[0] & MOUSE_VERSA_BUTTONS) >> 3];
2110         act->button |= (pBuf[0] & MOUSE_VERSA_TAP) ? MOUSE_BUTTON4DOWN : 0;
2111         act->dx = act->dy = 0;
2112         if (!(pBuf[0] & MOUSE_VERSA_IN_USE)) {
2113             on = FALSE;
2114             break;
2115         }
2116         x = (pBuf[2] << 6) | pBuf[1];
2117         if (x & 0x800)
2118             x -= 0x1000;
2119         y = (pBuf[4] << 6) | pBuf[3];
2120         if (y & 0x800)
2121             y -= 0x1000;
2122         if (on) {
2123             act->dx = prev_x - x;
2124             act->dy = prev_y - y;
2125         } else {
2126             on = TRUE;
2127         }
2128         prev_x = x;
2129         prev_y = y;
2130         break;
2131
2132     case MOUSE_PROTO_PS2:               /* PS/2 */
2133         act->button = butmapps2[pBuf[0] & MOUSE_PS2_BUTTONS];
2134         act->dx = (pBuf[0] & MOUSE_PS2_XNEG) ?    pBuf[1] - 256  :  pBuf[1];
2135         act->dy = (pBuf[0] & MOUSE_PS2_YNEG) ?  -(pBuf[2] - 256) : -pBuf[2];
2136         /*
2137          * Moused usually operates the psm driver at the operation level 1
2138          * which sends mouse data in MOUSE_PROTO_SYSMOUSE protocol.
2139          * The following code takes effect only when the user explicitly
2140          * requets the level 2 at which wheel movement and additional button
2141          * actions are encoded in model-dependent formats. At the level 0
2142          * the following code is no-op because the psm driver says the model
2143          * is MOUSE_MODEL_GENERIC.
2144          */
2145         switch (rodent.hw.model) {
2146         case MOUSE_MODEL_EXPLORER:
2147             /* wheel and additional button data is in the fourth byte */
2148             act->dz = (pBuf[3] & MOUSE_EXPLORER_ZNEG)
2149                 ? (pBuf[3] & 0x0f) - 16 : (pBuf[3] & 0x0f);
2150             act->button |= (pBuf[3] & MOUSE_EXPLORER_BUTTON4DOWN)
2151                 ? MOUSE_BUTTON4DOWN : 0;
2152             act->button |= (pBuf[3] & MOUSE_EXPLORER_BUTTON5DOWN)
2153                 ? MOUSE_BUTTON5DOWN : 0;
2154             break;
2155         case MOUSE_MODEL_INTELLI:
2156         case MOUSE_MODEL_NET:
2157             /* wheel data is in the fourth byte */
2158             act->dz = (signed char)pBuf[3];
2159             if ((act->dz >= 7) || (act->dz <= -7))
2160                 act->dz = 0;
2161             /* some compatible mice may have additional buttons */
2162             act->button |= (pBuf[0] & MOUSE_PS2INTELLI_BUTTON4DOWN)
2163                 ? MOUSE_BUTTON4DOWN : 0;
2164             act->button |= (pBuf[0] & MOUSE_PS2INTELLI_BUTTON5DOWN)
2165                 ? MOUSE_BUTTON5DOWN : 0;
2166             break;
2167         case MOUSE_MODEL_MOUSEMANPLUS:
2168             if (((pBuf[0] & MOUSE_PS2PLUS_SYNCMASK) == MOUSE_PS2PLUS_SYNC)
2169                     && (abs(act->dx) > 191)
2170                     && MOUSE_PS2PLUS_CHECKBITS(pBuf)) {
2171                 /* the extended data packet encodes button and wheel events */
2172                 switch (MOUSE_PS2PLUS_PACKET_TYPE(pBuf)) {
2173                 case 1:
2174                     /* wheel data packet */
2175                     act->dx = act->dy = 0;
2176                     if (pBuf[2] & 0x80) {
2177                         /* horizontal roller count - ignore it XXX*/
2178                     } else {
2179                         /* vertical roller count */
2180                         act->dz = (pBuf[2] & MOUSE_PS2PLUS_ZNEG)
2181                             ? (pBuf[2] & 0x0f) - 16 : (pBuf[2] & 0x0f);
2182                     }
2183                     act->button |= (pBuf[2] & MOUSE_PS2PLUS_BUTTON4DOWN)
2184                         ? MOUSE_BUTTON4DOWN : 0;
2185                     act->button |= (pBuf[2] & MOUSE_PS2PLUS_BUTTON5DOWN)
2186                         ? MOUSE_BUTTON5DOWN : 0;
2187                     break;
2188                 case 2:
2189                     /* this packet type is reserved by Logitech */
2190                     /*
2191                      * IBM ScrollPoint Mouse uses this packet type to
2192                      * encode both vertical and horizontal scroll movement.
2193                      */
2194                     act->dx = act->dy = 0;
2195                     /* horizontal roller count */
2196                     if (pBuf[2] & 0x0f)
2197                         act->dz = (pBuf[2] & MOUSE_SPOINT_WNEG) ? -2 : 2;
2198                     /* vertical roller count */
2199                     if (pBuf[2] & 0xf0)
2200                         act->dz = (pBuf[2] & MOUSE_SPOINT_ZNEG) ? -1 : 1;
2201 #if 0
2202                     /* vertical roller count */
2203                     act->dz = (pBuf[2] & MOUSE_SPOINT_ZNEG)
2204                         ? ((pBuf[2] >> 4) & 0x0f) - 16
2205                         : ((pBuf[2] >> 4) & 0x0f);
2206                     /* horizontal roller count */
2207                     act->dw = (pBuf[2] & MOUSE_SPOINT_WNEG)
2208                         ? (pBuf[2] & 0x0f) - 16 : (pBuf[2] & 0x0f);
2209 #endif
2210                     break;
2211                 case 0:
2212                     /* device type packet - shouldn't happen */
2213                     /* FALLTHROUGH */
2214                 default:
2215                     act->dx = act->dy = 0;
2216                     act->button = act->obutton;
2217                     debug("unknown PS2++ packet type %d: 0x%02x 0x%02x 0x%02x\n",
2218                           MOUSE_PS2PLUS_PACKET_TYPE(pBuf),
2219                           pBuf[0], pBuf[1], pBuf[2]);
2220                     break;
2221                 }
2222             } else {
2223                 /* preserve button states */
2224                 act->button |= act->obutton & MOUSE_EXTBUTTONS;
2225             }
2226             break;
2227         case MOUSE_MODEL_GLIDEPOINT:
2228             /* `tapping' action */
2229             act->button |= ((pBuf[0] & MOUSE_PS2_TAP)) ? 0 : MOUSE_BUTTON4DOWN;
2230             break;
2231         case MOUSE_MODEL_NETSCROLL:
2232             /* three additional bytes encode buttons and wheel events */
2233             act->button |= (pBuf[3] & MOUSE_PS2_BUTTON3DOWN)
2234                 ? MOUSE_BUTTON4DOWN : 0;
2235             act->button |= (pBuf[3] & MOUSE_PS2_BUTTON1DOWN)
2236                 ? MOUSE_BUTTON5DOWN : 0;
2237             act->dz = (pBuf[3] & MOUSE_PS2_XNEG) ? pBuf[4] - 256 : pBuf[4];
2238             break;
2239         case MOUSE_MODEL_THINK:
2240             /* the fourth button state in the first byte */
2241             act->button |= (pBuf[0] & MOUSE_PS2_TAP) ? MOUSE_BUTTON4DOWN : 0;
2242             break;
2243         case MOUSE_MODEL_VERSAPAD:
2244             act->button = butmapversaps2[pBuf[0] & MOUSE_PS2VERSA_BUTTONS];
2245             act->button |=
2246                 (pBuf[0] & MOUSE_PS2VERSA_TAP) ? MOUSE_BUTTON4DOWN : 0;
2247             act->dx = act->dy = 0;
2248             if (!(pBuf[0] & MOUSE_PS2VERSA_IN_USE)) {
2249                 on = FALSE;
2250                 break;
2251             }
2252             x = ((pBuf[4] << 8) & 0xf00) | pBuf[1];
2253             if (x & 0x800)
2254                 x -= 0x1000;
2255             y = ((pBuf[4] << 4) & 0xf00) | pBuf[2];
2256             if (y & 0x800)
2257                 y -= 0x1000;
2258             if (on) {
2259                 act->dx = prev_x - x;
2260                 act->dy = prev_y - y;
2261             } else {
2262                 on = TRUE;
2263             }
2264             prev_x = x;
2265             prev_y = y;
2266             break;
2267         case MOUSE_MODEL_4D:
2268             act->dx = (pBuf[1] & 0x80) ?    pBuf[1] - 256  :  pBuf[1];
2269             act->dy = (pBuf[2] & 0x80) ?  -(pBuf[2] - 256) : -pBuf[2];
2270             switch (pBuf[0] & MOUSE_4D_WHEELBITS) {
2271             case 0x10:
2272                 act->dz = 1;
2273                 break;
2274             case 0x30:
2275                 act->dz = -1;
2276                 break;
2277             case 0x40:  /* 2nd wheel rolling right XXX */
2278                 act->dz = 2;
2279                 break;
2280             case 0xc0:  /* 2nd wheel rolling left XXX */
2281                 act->dz = -2;
2282                 break;
2283             }
2284             break;
2285         case MOUSE_MODEL_4DPLUS:
2286             if ((act->dx < 16 - 256) && (act->dy > 256 - 16)) {
2287                 act->dx = act->dy = 0;
2288                 if (pBuf[2] & MOUSE_4DPLUS_BUTTON4DOWN)
2289                     act->button |= MOUSE_BUTTON4DOWN;
2290                 act->dz = (pBuf[2] & MOUSE_4DPLUS_ZNEG)
2291                               ? ((pBuf[2] & 0x07) - 8) : (pBuf[2] & 0x07);
2292             } else {
2293                 /* preserve previous button states */
2294                 act->button |= act->obutton & MOUSE_EXTBUTTONS;
2295             }
2296             break;
2297         case MOUSE_MODEL_GENERIC:
2298         default:
2299             break;
2300         }
2301         break;
2302
2303     case MOUSE_PROTO_SYSMOUSE:          /* sysmouse */
2304         act->button = butmapmsc[(~pBuf[0]) & MOUSE_SYS_STDBUTTONS];
2305         act->dx =    (signed char)(pBuf[1]) + (signed char)(pBuf[3]);
2306         act->dy = - ((signed char)(pBuf[2]) + (signed char)(pBuf[4]));
2307         if (rodent.level == 1) {
2308             act->dz = ((signed char)(pBuf[5] << 1) + (signed char)(pBuf[6] << 1)) >> 1;
2309             act->button |= ((~pBuf[7] & MOUSE_SYS_EXTBUTTONS) << 3);
2310         }
2311         break;
2312
2313     default:
2314         return (0);
2315     }
2316     /*
2317      * We don't reset pBufP here yet, as there may be an additional data
2318      * byte in some protocols. See above.
2319      */
2320
2321     /* has something changed? */
2322     act->flags = ((act->dx || act->dy || act->dz) ? MOUSE_POSCHANGED : 0)
2323         | (act->obutton ^ act->button);
2324
2325     return (act->flags);
2326 }
2327
2328 static int
2329 r_statetrans(mousestatus_t *a1, mousestatus_t *a2, int trans)
2330 {
2331     int changed;
2332     int flags;
2333
2334     a2->dx = a1->dx;
2335     a2->dy = a1->dy;
2336     a2->dz = a1->dz;
2337     a2->obutton = a2->button;
2338     a2->button = a1->button;
2339     a2->flags = a1->flags;
2340     changed = FALSE;
2341
2342     if (rodent.flags & Emulate3Button) {
2343         if (debug > 2)
2344             debug("state:%d, trans:%d -> state:%d",
2345                   mouse_button_state, trans,
2346                   states[mouse_button_state].s[trans]);
2347         /*
2348          * Avoid re-ordering button and movement events. While a button
2349          * event is deferred, throw away up to BUTTON2_MAXMOVE movement
2350          * events to allow for mouse jitter. If more movement events
2351          * occur, then complete the deferred button events immediately.
2352          */
2353         if ((a2->dx != 0 || a2->dy != 0) &&
2354             S_DELAYED(states[mouse_button_state].s[trans])) {
2355                 if (++mouse_move_delayed > BUTTON2_MAXMOVE) {
2356                         mouse_move_delayed = 0;
2357                         mouse_button_state =
2358                             states[mouse_button_state].s[A_TIMEOUT];
2359                         changed = TRUE;
2360                 } else
2361                         a2->dx = a2->dy = 0;
2362         } else
2363                 mouse_move_delayed = 0;
2364         if (mouse_button_state != states[mouse_button_state].s[trans])
2365                 changed = TRUE;
2366         if (changed)
2367                 clock_gettime(CLOCK_MONOTONIC_FAST, &mouse_button_state_ts);
2368         mouse_button_state = states[mouse_button_state].s[trans];
2369         a2->button &=
2370             ~(MOUSE_BUTTON1DOWN | MOUSE_BUTTON2DOWN | MOUSE_BUTTON3DOWN);
2371         a2->button &= states[mouse_button_state].mask;
2372         a2->button |= states[mouse_button_state].buttons;
2373         flags = a2->flags & MOUSE_POSCHANGED;
2374         flags |= a2->obutton ^ a2->button;
2375         if (flags & MOUSE_BUTTON2DOWN) {
2376             a2->flags = flags & MOUSE_BUTTON2DOWN;
2377             r_timestamp(a2);
2378         }
2379         a2->flags = flags;
2380     }
2381     return (changed);
2382 }
2383
2384 /* phisical to logical button mapping */
2385 static int p2l[MOUSE_MAXBUTTON] = {
2386     MOUSE_BUTTON1DOWN, MOUSE_BUTTON2DOWN, MOUSE_BUTTON3DOWN, MOUSE_BUTTON4DOWN,
2387     MOUSE_BUTTON5DOWN, MOUSE_BUTTON6DOWN, MOUSE_BUTTON7DOWN, MOUSE_BUTTON8DOWN,
2388     0x00000100,        0x00000200,        0x00000400,        0x00000800,
2389     0x00001000,        0x00002000,        0x00004000,        0x00008000,
2390     0x00010000,        0x00020000,        0x00040000,        0x00080000,
2391     0x00100000,        0x00200000,        0x00400000,        0x00800000,
2392     0x01000000,        0x02000000,        0x04000000,        0x08000000,
2393     0x10000000,        0x20000000,        0x40000000,
2394 };
2395
2396 static char *
2397 skipspace(char *s)
2398 {
2399     while(isspace(*s))
2400         ++s;
2401     return (s);
2402 }
2403
2404 static int
2405 r_installmap(char *arg)
2406 {
2407     int pbutton;
2408     int lbutton;
2409     char *s;
2410
2411     while (*arg) {
2412         arg = skipspace(arg);
2413         s = arg;
2414         while (isdigit(*arg))
2415             ++arg;
2416         arg = skipspace(arg);
2417         if ((arg <= s) || (*arg != '='))
2418             return (FALSE);
2419         lbutton = atoi(s);
2420
2421         arg = skipspace(++arg);
2422         s = arg;
2423         while (isdigit(*arg))
2424             ++arg;
2425         if ((arg <= s) || (!isspace(*arg) && (*arg != '\0')))
2426             return (FALSE);
2427         pbutton = atoi(s);
2428
2429         if ((lbutton <= 0) || (lbutton > MOUSE_MAXBUTTON))
2430             return (FALSE);
2431         if ((pbutton <= 0) || (pbutton > MOUSE_MAXBUTTON))
2432             return (FALSE);
2433         p2l[pbutton - 1] = 1 << (lbutton - 1);
2434         mstate[lbutton - 1] = &bstate[pbutton - 1];
2435     }
2436
2437     return (TRUE);
2438 }
2439
2440 static void
2441 r_map(mousestatus_t *act1, mousestatus_t *act2)
2442 {
2443     register int pb;
2444     register int pbuttons;
2445     int lbuttons;
2446
2447     pbuttons = act1->button;
2448     lbuttons = 0;
2449
2450     act2->obutton = act2->button;
2451     if (pbuttons & rodent.wmode) {
2452         pbuttons &= ~rodent.wmode;
2453         act1->dz = act1->dy;
2454         act1->dx = 0;
2455         act1->dy = 0;
2456     }
2457     act2->dx = act1->dx;
2458     act2->dy = act1->dy;
2459     act2->dz = act1->dz;
2460
2461     switch (rodent.zmap[0]) {
2462     case 0:     /* do nothing */
2463         break;
2464     case MOUSE_XAXIS:
2465         if (act1->dz != 0) {
2466             act2->dx = act1->dz;
2467             act2->dz = 0;
2468         }
2469         break;
2470     case MOUSE_YAXIS:
2471         if (act1->dz != 0) {
2472             act2->dy = act1->dz;
2473             act2->dz = 0;
2474         }
2475         break;
2476     default:    /* buttons */
2477         pbuttons &= ~(rodent.zmap[0] | rodent.zmap[1]
2478                     | rodent.zmap[2] | rodent.zmap[3]);
2479         if ((act1->dz < -1) && rodent.zmap[2]) {
2480             pbuttons |= rodent.zmap[2];
2481             zstate[2].count = 1;
2482         } else if (act1->dz < 0) {
2483             pbuttons |= rodent.zmap[0];
2484             zstate[0].count = 1;
2485         } else if ((act1->dz > 1) && rodent.zmap[3]) {
2486             pbuttons |= rodent.zmap[3];
2487             zstate[3].count = 1;
2488         } else if (act1->dz > 0) {
2489             pbuttons |= rodent.zmap[1];
2490             zstate[1].count = 1;
2491         }
2492         act2->dz = 0;
2493         break;
2494     }
2495
2496     for (pb = 0; (pb < MOUSE_MAXBUTTON) && (pbuttons != 0); ++pb) {
2497         lbuttons |= (pbuttons & 1) ? p2l[pb] : 0;
2498         pbuttons >>= 1;
2499     }
2500     act2->button = lbuttons;
2501
2502     act2->flags = ((act2->dx || act2->dy || act2->dz) ? MOUSE_POSCHANGED : 0)
2503         | (act2->obutton ^ act2->button);
2504 }
2505
2506 static void
2507 r_timestamp(mousestatus_t *act)
2508 {
2509     struct timespec ts;
2510     struct timespec ts1;
2511     struct timespec ts2;
2512     struct timespec ts3;
2513     int button;
2514     int mask;
2515     int i;
2516
2517     mask = act->flags & MOUSE_BUTTONS;
2518 #if 0
2519     if (mask == 0)
2520         return;
2521 #endif
2522
2523     clock_gettime(CLOCK_MONOTONIC_FAST, &ts1);
2524     drift_current_ts = ts1;
2525
2526     /* double click threshold */
2527     ts2.tv_sec = rodent.clickthreshold / 1000;
2528     ts2.tv_nsec = (rodent.clickthreshold % 1000) * 1000000;
2529     tssub(&ts1, &ts2, &ts);
2530     debug("ts:  %jd %ld", (intmax_t)ts.tv_sec, ts.tv_nsec);
2531
2532     /* 3 button emulation timeout */
2533     ts2.tv_sec = rodent.button2timeout / 1000;
2534     ts2.tv_nsec = (rodent.button2timeout % 1000) * 1000000;
2535     tssub(&ts1, &ts2, &ts3);
2536
2537     button = MOUSE_BUTTON1DOWN;
2538     for (i = 0; (i < MOUSE_MAXBUTTON) && (mask != 0); ++i) {
2539         if (mask & 1) {
2540             if (act->button & button) {
2541                 /* the button is down */
2542                 debug("  :  %jd %ld",
2543                     (intmax_t)bstate[i].ts.tv_sec, bstate[i].ts.tv_nsec);
2544                 if (tscmp(&ts, &bstate[i].ts, >)) {
2545                     bstate[i].count = 1;
2546                 } else {
2547                     ++bstate[i].count;
2548                 }
2549                 bstate[i].ts = ts1;
2550             } else {
2551                 /* the button is up */
2552                 bstate[i].ts = ts1;
2553             }
2554         } else {
2555             if (act->button & button) {
2556                 /* the button has been down */
2557                 if (tscmp(&ts3, &bstate[i].ts, >)) {
2558                     bstate[i].count = 1;
2559                     bstate[i].ts = ts1;
2560                     act->flags |= button;
2561                     debug("button %d timeout", i + 1);
2562                 }
2563             } else {
2564                 /* the button has been up */
2565             }
2566         }
2567         button <<= 1;
2568         mask >>= 1;
2569     }
2570 }
2571
2572 static int
2573 r_timeout(void)
2574 {
2575     struct timespec ts;
2576     struct timespec ts1;
2577     struct timespec ts2;
2578
2579     if (states[mouse_button_state].timeout)
2580         return (TRUE);
2581     clock_gettime(CLOCK_MONOTONIC_FAST, &ts1);
2582     ts2.tv_sec = rodent.button2timeout / 1000;
2583     ts2.tv_nsec = (rodent.button2timeout % 1000) * 1000000;
2584     tssub(&ts1, &ts2, &ts);
2585     return (tscmp(&ts, &mouse_button_state_ts, >));
2586 }
2587
2588 static void
2589 r_click(mousestatus_t *act)
2590 {
2591     struct mouse_info mouse;
2592     int button;
2593     int mask;
2594     int i;
2595
2596     mask = act->flags & MOUSE_BUTTONS;
2597     if (mask == 0)
2598         return;
2599
2600     button = MOUSE_BUTTON1DOWN;
2601     for (i = 0; (i < MOUSE_MAXBUTTON) && (mask != 0); ++i) {
2602         if (mask & 1) {
2603             debug("mstate[%d]->count:%d", i, mstate[i]->count);
2604             if (act->button & button) {
2605                 /* the button is down */
2606                 mouse.u.event.value = mstate[i]->count;
2607             } else {
2608                 /* the button is up */
2609                 mouse.u.event.value = 0;
2610             }
2611             mouse.operation = MOUSE_BUTTON_EVENT;
2612             mouse.u.event.id = button;
2613             if (debug < 2)
2614                 if (!paused)
2615                     ioctl(rodent.cfd, CONS_MOUSECTL, &mouse);
2616             debug("button %d  count %d", i + 1, mouse.u.event.value);
2617         }
2618         button <<= 1;
2619         mask >>= 1;
2620     }
2621 }
2622
2623 /* $XConsortium: posix_tty.c,v 1.3 95/01/05 20:42:55 kaleb Exp $ */
2624 /* $XFree86: xc/programs/Xserver/hw/xfree86/os-support/shared/posix_tty.c,v 3.4 1995/01/28 17:05:03 dawes Exp $ */
2625 /*
2626  * Copyright 1993 by David Dawes <dawes@physics.su.oz.au>
2627  *
2628  * Permission to use, copy, modify, distribute, and sell this software and its
2629  * documentation for any purpose is hereby granted without fee, provided that
2630  * the above copyright notice appear in all copies and that both that
2631  * copyright notice and this permission notice appear in supporting
2632  * documentation, and that the name of David Dawes
2633  * not be used in advertising or publicity pertaining to distribution of
2634  * the software without specific, written prior permission.
2635  * David Dawes makes no representations about the suitability of this
2636  * software for any purpose.  It is provided "as is" without express or
2637  * implied warranty.
2638  *
2639  * DAVID DAWES DISCLAIMS ALL WARRANTIES WITH REGARD TO
2640  * THIS SOFTWARE, INCLUDING ALL IMPLIED WARRANTIES OF MERCHANTABILITY AND
2641  * FITNESS, IN NO EVENT SHALL DAVID DAWES BE LIABLE FOR
2642  * ANY SPECIAL, INDIRECT OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES WHATSOEVER
2643  * RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN ACTION OF
2644  * CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF OR IN
2645  * CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
2646  *
2647  */
2648
2649
2650 static void
2651 setmousespeed(int old, int new, unsigned cflag)
2652 {
2653         struct termios tty;
2654         const char *c;
2655
2656         if (tcgetattr(rodent.mfd, &tty) < 0)
2657         {
2658                 logwarn("unable to get status of mouse fd");
2659                 return;
2660         }
2661
2662         tty.c_iflag = IGNBRK | IGNPAR;
2663         tty.c_oflag = 0;
2664         tty.c_lflag = 0;
2665         tty.c_cflag = (tcflag_t)cflag;
2666         tty.c_cc[VTIME] = 0;
2667         tty.c_cc[VMIN] = 1;
2668
2669         switch (old)
2670         {
2671         case 9600:
2672                 cfsetispeed(&tty, B9600);
2673                 cfsetospeed(&tty, B9600);
2674                 break;
2675         case 4800:
2676                 cfsetispeed(&tty, B4800);
2677                 cfsetospeed(&tty, B4800);
2678                 break;
2679         case 2400:
2680                 cfsetispeed(&tty, B2400);
2681                 cfsetospeed(&tty, B2400);
2682                 break;
2683         case 1200:
2684         default:
2685                 cfsetispeed(&tty, B1200);
2686                 cfsetospeed(&tty, B1200);
2687         }
2688
2689         if (tcsetattr(rodent.mfd, TCSADRAIN, &tty) < 0)
2690         {
2691                 logwarn("unable to set status of mouse fd");
2692                 return;
2693         }
2694
2695         switch (new)
2696         {
2697         case 9600:
2698                 c = "*q";
2699                 cfsetispeed(&tty, B9600);
2700                 cfsetospeed(&tty, B9600);
2701                 break;
2702         case 4800:
2703                 c = "*p";
2704                 cfsetispeed(&tty, B4800);
2705                 cfsetospeed(&tty, B4800);
2706                 break;
2707         case 2400:
2708                 c = "*o";
2709                 cfsetispeed(&tty, B2400);
2710                 cfsetospeed(&tty, B2400);
2711                 break;
2712         case 1200:
2713         default:
2714                 c = "*n";
2715                 cfsetispeed(&tty, B1200);
2716                 cfsetospeed(&tty, B1200);
2717         }
2718
2719         if (rodent.rtype == MOUSE_PROTO_LOGIMOUSEMAN
2720             || rodent.rtype == MOUSE_PROTO_LOGI)
2721         {
2722                 if (write(rodent.mfd, c, 2) != 2)
2723                 {
2724                         logwarn("unable to write to mouse fd");
2725                         return;
2726                 }
2727         }
2728         usleep(100000);
2729
2730         if (tcsetattr(rodent.mfd, TCSADRAIN, &tty) < 0)
2731                 logwarn("unable to set status of mouse fd");
2732 }
2733
2734 /*
2735  * PnP COM device support
2736  *
2737  * It's a simplistic implementation, but it works :-)
2738  * KY, 31/7/97.
2739  */
2740
2741 /*
2742  * Try to elicit a PnP ID as described in
2743  * Microsoft, Hayes: "Plug and Play External COM Device Specification,
2744  * rev 1.00", 1995.
2745  *
2746  * The routine does not fully implement the COM Enumerator as par Section
2747  * 2.1 of the document.  In particular, we don't have idle state in which
2748  * the driver software monitors the com port for dynamic connection or
2749  * removal of a device at the port, because `moused' simply quits if no
2750  * device is found.
2751  *
2752  * In addition, as PnP COM device enumeration procedure slightly has
2753  * changed since its first publication, devices which follow earlier
2754  * revisions of the above spec. may fail to respond if the rev 1.0
2755  * procedure is used. XXX
2756  */
2757 static int
2758 pnpwakeup1(void)
2759 {
2760     struct timeval timeout;
2761     fd_set fds;
2762     int i;
2763
2764     /*
2765      * This is the procedure described in rev 1.0 of PnP COM device spec.
2766      * Unfortunately, some devices which comform to earlier revisions of
2767      * the spec gets confused and do not return the ID string...
2768      */
2769     debug("PnP COM device rev 1.0 probe...");
2770
2771     /* port initialization (2.1.2) */
2772     ioctl(rodent.mfd, TIOCMGET, &i);
2773     i |= TIOCM_DTR;             /* DTR = 1 */
2774     i &= ~TIOCM_RTS;            /* RTS = 0 */
2775     ioctl(rodent.mfd, TIOCMSET, &i);
2776     usleep(240000);
2777
2778     /*
2779      * The PnP COM device spec. dictates that the mouse must set DSR
2780      * in response to DTR (by hardware or by software) and that if DSR is
2781      * not asserted, the host computer should think that there is no device
2782      * at this serial port.  But some mice just don't do that...
2783      */
2784     ioctl(rodent.mfd, TIOCMGET, &i);
2785     debug("modem status 0%o", i);
2786     if ((i & TIOCM_DSR) == 0)
2787         return (FALSE);
2788
2789     /* port setup, 1st phase (2.1.3) */
2790     setmousespeed(1200, 1200, (CS7 | CREAD | CLOCAL | HUPCL));
2791     i = TIOCM_DTR | TIOCM_RTS;  /* DTR = 0, RTS = 0 */
2792     ioctl(rodent.mfd, TIOCMBIC, &i);
2793     usleep(240000);
2794     i = TIOCM_DTR;              /* DTR = 1, RTS = 0 */
2795     ioctl(rodent.mfd, TIOCMBIS, &i);
2796     usleep(240000);
2797
2798     /* wait for response, 1st phase (2.1.4) */
2799     i = FREAD;
2800     ioctl(rodent.mfd, TIOCFLUSH, &i);
2801     i = TIOCM_RTS;              /* DTR = 1, RTS = 1 */
2802     ioctl(rodent.mfd, TIOCMBIS, &i);
2803
2804     /* try to read something */
2805     FD_ZERO(&fds);
2806     FD_SET(rodent.mfd, &fds);
2807     timeout.tv_sec = 0;
2808     timeout.tv_usec = 240000;
2809     if (select(FD_SETSIZE, &fds, NULL, NULL, &timeout) > 0) {
2810         debug("pnpwakeup1(): valid response in first phase.");
2811         return (TRUE);
2812     }
2813
2814     /* port setup, 2nd phase (2.1.5) */
2815     i = TIOCM_DTR | TIOCM_RTS;  /* DTR = 0, RTS = 0 */
2816     ioctl(rodent.mfd, TIOCMBIC, &i);
2817     usleep(240000);
2818
2819     /* wait for respose, 2nd phase (2.1.6) */
2820     i = FREAD;
2821     ioctl(rodent.mfd, TIOCFLUSH, &i);
2822     i = TIOCM_DTR | TIOCM_RTS;  /* DTR = 1, RTS = 1 */
2823     ioctl(rodent.mfd, TIOCMBIS, &i);
2824
2825     /* try to read something */
2826     FD_ZERO(&fds);
2827     FD_SET(rodent.mfd, &fds);
2828     timeout.tv_sec = 0;
2829     timeout.tv_usec = 240000;
2830     if (select(FD_SETSIZE, &fds, NULL, NULL, &timeout) > 0) {
2831         debug("pnpwakeup1(): valid response in second phase.");
2832         return (TRUE);
2833     }
2834
2835     return (FALSE);
2836 }
2837
2838 static int
2839 pnpwakeup2(void)
2840 {
2841     struct timeval timeout;
2842     fd_set fds;
2843     int i;
2844
2845     /*
2846      * This is a simplified procedure; it simply toggles RTS.
2847      */
2848     debug("alternate probe...");
2849
2850     ioctl(rodent.mfd, TIOCMGET, &i);
2851     i |= TIOCM_DTR;             /* DTR = 1 */
2852     i &= ~TIOCM_RTS;            /* RTS = 0 */
2853     ioctl(rodent.mfd, TIOCMSET, &i);
2854     usleep(240000);
2855
2856     setmousespeed(1200, 1200, (CS7 | CREAD | CLOCAL | HUPCL));
2857
2858     /* wait for respose */
2859     i = FREAD;
2860     ioctl(rodent.mfd, TIOCFLUSH, &i);
2861     i = TIOCM_DTR | TIOCM_RTS;  /* DTR = 1, RTS = 1 */
2862     ioctl(rodent.mfd, TIOCMBIS, &i);
2863
2864     /* try to read something */
2865     FD_ZERO(&fds);
2866     FD_SET(rodent.mfd, &fds);
2867     timeout.tv_sec = 0;
2868     timeout.tv_usec = 240000;
2869     if (select(FD_SETSIZE, &fds, NULL, NULL, &timeout) > 0) {
2870         debug("pnpwakeup2(): valid response.");
2871         return (TRUE);
2872     }
2873
2874     return (FALSE);
2875 }
2876
2877 static int
2878 pnpgets(char *buf)
2879 {
2880     struct timeval timeout;
2881     fd_set fds;
2882     int begin;
2883     int i;
2884     char c;
2885
2886     if (!pnpwakeup1() && !pnpwakeup2()) {
2887         /*
2888          * According to PnP spec, we should set DTR = 1 and RTS = 0 while
2889          * in idle state.  But, `moused' shall set DTR = RTS = 1 and proceed,
2890          * assuming there is something at the port even if it didn't
2891          * respond to the PnP enumeration procedure.
2892          */
2893         i = TIOCM_DTR | TIOCM_RTS;              /* DTR = 1, RTS = 1 */
2894         ioctl(rodent.mfd, TIOCMBIS, &i);
2895         return (0);
2896     }
2897
2898     /* collect PnP COM device ID (2.1.7) */
2899     begin = -1;
2900     i = 0;
2901     usleep(240000);     /* the mouse must send `Begin ID' within 200msec */
2902     while (read(rodent.mfd, &c, 1) == 1) {
2903         /* we may see "M", or "M3..." before `Begin ID' */
2904         buf[i++] = c;
2905         if ((c == 0x08) || (c == 0x28)) {       /* Begin ID */
2906             debug("begin-id %02x", c);
2907             begin = i - 1;
2908             break;
2909         }
2910         debug("%c %02x", c, c);
2911         if (i >= 256)
2912             break;
2913     }
2914     if (begin < 0) {
2915         /* we haven't seen `Begin ID' in time... */
2916         goto connect_idle;
2917     }
2918
2919     ++c;                        /* make it `End ID' */
2920     for (;;) {
2921         FD_ZERO(&fds);
2922         FD_SET(rodent.mfd, &fds);
2923         timeout.tv_sec = 0;
2924         timeout.tv_usec = 240000;
2925         if (select(FD_SETSIZE, &fds, NULL, NULL, &timeout) <= 0)
2926             break;
2927
2928         read(rodent.mfd, &buf[i], 1);
2929         if (buf[i++] == c)      /* End ID */
2930             break;
2931         if (i >= 256)
2932             break;
2933     }
2934     if (begin > 0) {
2935         i -= begin;
2936         bcopy(&buf[begin], &buf[0], i);
2937     }
2938     /* string may not be human readable... */
2939     debug("len:%d, '%-*.*s'", i, i, i, buf);
2940
2941     if (buf[i - 1] == c)
2942         return (i);             /* a valid PnP string */
2943
2944     /*
2945      * According to PnP spec, we should set DTR = 1 and RTS = 0 while
2946      * in idle state.  But, `moused' shall leave the modem control lines
2947      * as they are. See above.
2948      */
2949 connect_idle:
2950
2951     /* we may still have something in the buffer */
2952     return (MAX(i, 0));
2953 }
2954
2955 static int
2956 pnpparse(pnpid_t *id, char *buf, int len)
2957 {
2958     char s[3];
2959     int offset;
2960     int sum = 0;
2961     int i, j;
2962
2963     id->revision = 0;
2964     id->eisaid = NULL;
2965     id->serial = NULL;
2966     id->class = NULL;
2967     id->compat = NULL;
2968     id->description = NULL;
2969     id->neisaid = 0;
2970     id->nserial = 0;
2971     id->nclass = 0;
2972     id->ncompat = 0;
2973     id->ndescription = 0;
2974
2975     if ((buf[0] != 0x28) && (buf[0] != 0x08)) {
2976         /* non-PnP mice */
2977         switch(buf[0]) {
2978         default:
2979             return (FALSE);
2980         case 'M': /* Microsoft */
2981             id->eisaid = "PNP0F01";
2982             break;
2983         case 'H': /* MouseSystems */
2984             id->eisaid = "PNP0F04";
2985             break;
2986         }
2987         id->neisaid = strlen(id->eisaid);
2988         id->class = "MOUSE";
2989         id->nclass = strlen(id->class);
2990         debug("non-PnP mouse '%c'", buf[0]);
2991         return (TRUE);
2992     }
2993
2994     /* PnP mice */
2995     offset = 0x28 - buf[0];
2996
2997     /* calculate checksum */
2998     for (i = 0; i < len - 3; ++i) {
2999         sum += buf[i];
3000         buf[i] += offset;
3001     }
3002     sum += buf[len - 1];
3003     for (; i < len; ++i)
3004         buf[i] += offset;
3005     debug("PnP ID string: '%*.*s'", len, len, buf);
3006
3007     /* revision */
3008     buf[1] -= offset;
3009     buf[2] -= offset;
3010     id->revision = ((buf[1] & 0x3f) << 6) | (buf[2] & 0x3f);
3011     debug("PnP rev %d.%02d", id->revision / 100, id->revision % 100);
3012
3013     /* EISA vendor and product ID */
3014     id->eisaid = &buf[3];
3015     id->neisaid = 7;
3016
3017     /* option strings */
3018     i = 10;
3019     if (buf[i] == '\\') {
3020         /* device serial # */
3021         for (j = ++i; i < len; ++i) {
3022             if (buf[i] == '\\')
3023                 break;
3024         }
3025         if (i >= len)
3026             i -= 3;
3027         if (i - j == 8) {
3028             id->serial = &buf[j];
3029             id->nserial = 8;
3030         }
3031     }
3032     if (buf[i] == '\\') {
3033         /* PnP class */
3034         for (j = ++i; i < len; ++i) {
3035             if (buf[i] == '\\')
3036                 break;
3037         }
3038         if (i >= len)
3039             i -= 3;
3040         if (i > j + 1) {
3041             id->class = &buf[j];
3042             id->nclass = i - j;
3043         }
3044     }
3045     if (buf[i] == '\\') {
3046         /* compatible driver */
3047         for (j = ++i; i < len; ++i) {
3048             if (buf[i] == '\\')
3049                 break;
3050         }
3051         /*
3052          * PnP COM spec prior to v0.96 allowed '*' in this field,
3053          * it's not allowed now; just ignore it.
3054          */
3055         if (buf[j] == '*')
3056             ++j;
3057         if (i >= len)
3058             i -= 3;
3059         if (i > j + 1) {
3060             id->compat = &buf[j];
3061             id->ncompat = i - j;
3062         }
3063     }
3064     if (buf[i] == '\\') {
3065         /* product description */
3066         for (j = ++i; i < len; ++i) {
3067             if (buf[i] == ';')
3068                 break;
3069         }
3070         if (i >= len)
3071             i -= 3;
3072         if (i > j + 1) {
3073             id->description = &buf[j];
3074             id->ndescription = i - j;
3075         }
3076     }
3077
3078     /* checksum exists if there are any optional fields */
3079     if ((id->nserial > 0) || (id->nclass > 0)
3080         || (id->ncompat > 0) || (id->ndescription > 0)) {
3081         debug("PnP checksum: 0x%X", sum);
3082         sprintf(s, "%02X", sum & 0x0ff);
3083         if (strncmp(s, &buf[len - 3], 2) != 0) {
3084 #if 0
3085             /*
3086              * I found some mice do not comply with the PnP COM device
3087              * spec regarding checksum... XXX
3088              */
3089             logwarnx("PnP checksum error", 0);
3090             return (FALSE);
3091 #endif
3092         }
3093     }
3094
3095     return (TRUE);
3096 }
3097
3098 static symtab_t *
3099 pnpproto(pnpid_t *id)
3100 {
3101     symtab_t *t;
3102     int i, j;
3103
3104     if (id->nclass > 0)
3105         if (strncmp(id->class, "MOUSE", id->nclass) != 0 &&
3106             strncmp(id->class, "TABLET", id->nclass) != 0)
3107             /* this is not a mouse! */
3108             return (NULL);
3109
3110     if (id->neisaid > 0) {
3111         t = gettoken(pnpprod, id->eisaid, id->neisaid);
3112         if (t->val != MOUSE_PROTO_UNKNOWN)
3113             return (t);
3114     }
3115
3116     /*
3117      * The 'Compatible drivers' field may contain more than one
3118      * ID separated by ','.
3119      */
3120     if (id->ncompat <= 0)
3121         return (NULL);
3122     for (i = 0; i < id->ncompat; ++i) {
3123         for (j = i; id->compat[i] != ','; ++i)
3124             if (i >= id->ncompat)
3125                 break;
3126         if (i > j) {
3127             t = gettoken(pnpprod, id->compat + j, i - j);
3128             if (t->val != MOUSE_PROTO_UNKNOWN)
3129                 return (t);
3130         }
3131     }
3132
3133     return (NULL);
3134 }
3135
3136 /* name/val mapping */
3137
3138 static symtab_t *
3139 gettoken(symtab_t *tab, const char *s, int len)
3140 {
3141     int i;
3142
3143     for (i = 0; tab[i].name != NULL; ++i) {
3144         if (strncmp(tab[i].name, s, len) == 0)
3145             break;
3146     }
3147     return (&tab[i]);
3148 }
3149
3150 static const char *
3151 gettokenname(symtab_t *tab, int val)
3152 {
3153     static const char unknown[] = "unknown";
3154     int i;
3155
3156     for (i = 0; tab[i].name != NULL; ++i) {
3157         if (tab[i].val == val)
3158             return (tab[i].name);
3159     }
3160     return (unknown);
3161 }
3162
3163
3164 /*
3165  * code to read from the Genius Kidspad tablet.
3166
3167 The tablet responds to the COM PnP protocol 1.0 with EISA-ID KYE0005,
3168 and to pre-pnp probes (RTS toggle) with 'T' (tablet ?)
3169 9600, 8 bit, parity odd.
3170
3171 The tablet puts out 5 bytes. b0 (mask 0xb8, value 0xb8) contains
3172 the proximity, tip and button info:
3173    (byte0 & 0x1)        true = tip pressed
3174    (byte0 & 0x2)        true = button pressed
3175    (byte0 & 0x40)       false = pen in proximity of tablet.
3176
3177 The next 4 bytes are used for coordinates xl, xh, yl, yh (7 bits valid).
3178
3179 Only absolute coordinates are returned, so we use the following approach:
3180 we store the last coordinates sent when the pen went out of the tablet,
3181
3182
3183  *
3184  */
3185
3186 typedef enum {
3187     S_IDLE, S_PROXY, S_FIRST, S_DOWN, S_UP
3188 } k_status;
3189
3190 static int
3191 kidspad(u_char rxc, mousestatus_t *act)
3192 {
3193     static int buf[5];
3194     static int buflen = 0, b_prev = 0 , x_prev = -1, y_prev = -1;
3195     static k_status status = S_IDLE;
3196     static struct timespec now;
3197
3198     int x, y;
3199
3200     if (buflen > 0 && (rxc & 0x80)) {
3201         fprintf(stderr, "invalid code %d 0x%x\n", buflen, rxc);
3202         buflen = 0;
3203     }
3204     if (buflen == 0 && (rxc & 0xb8) != 0xb8) {
3205         fprintf(stderr, "invalid code 0 0x%x\n", rxc);
3206         return (0);     /* invalid code, no action */
3207     }
3208     buf[buflen++] = rxc;
3209     if (buflen < 5)
3210         return (0);
3211
3212     buflen = 0; /* for next time... */
3213
3214     x = buf[1]+128*(buf[2] - 7);
3215     if (x < 0) x = 0;
3216     y = 28*128 - (buf[3] + 128* (buf[4] - 7));
3217     if (y < 0) y = 0;
3218
3219     x /= 8;
3220     y /= 8;
3221
3222     act->flags = 0;
3223     act->obutton = act->button;
3224     act->dx = act->dy = act->dz = 0;
3225     clock_gettime(CLOCK_MONOTONIC_FAST, &now);
3226     if (buf[0] & 0x40) /* pen went out of reach */
3227         status = S_IDLE;
3228     else if (status == S_IDLE) { /* pen is newly near the tablet */
3229         act->flags |= MOUSE_POSCHANGED; /* force update */
3230         status = S_PROXY;
3231         x_prev = x;
3232         y_prev = y;
3233     }
3234     act->dx = x - x_prev;
3235     act->dy = y - y_prev;
3236     if (act->dx || act->dy)
3237         act->flags |= MOUSE_POSCHANGED;
3238     x_prev = x;
3239     y_prev = y;
3240     if (b_prev != 0 && b_prev != buf[0]) { /* possibly record button change */
3241         act->button = 0;
3242         if (buf[0] & 0x01) /* tip pressed */
3243             act->button |= MOUSE_BUTTON1DOWN;
3244         if (buf[0] & 0x02) /* button pressed */
3245             act->button |= MOUSE_BUTTON2DOWN;
3246         act->flags |= MOUSE_BUTTONSCHANGED;
3247     }
3248     b_prev = buf[0];
3249     return (act->flags);
3250 }
3251
3252 static int
3253 gtco_digipad (u_char rxc, mousestatus_t *act)
3254 {
3255         static u_char buf[5];
3256         static int buflen = 0, b_prev = 0 , x_prev = -1, y_prev = -1;
3257         static k_status status = S_IDLE;
3258         int x, y;
3259
3260 #define GTCO_HEADER     0x80
3261 #define GTCO_PROXIMITY  0x40
3262 #define GTCO_START      (GTCO_HEADER|GTCO_PROXIMITY)
3263 #define GTCO_BUTTONMASK 0x3c
3264
3265
3266         if (buflen > 0 && ((rxc & GTCO_HEADER) != GTCO_HEADER)) {
3267                 fprintf(stderr, "invalid code %d 0x%x\n", buflen, rxc);
3268                 buflen = 0;
3269         }
3270         if (buflen == 0 && (rxc & GTCO_START) != GTCO_START) {
3271                 fprintf(stderr, "invalid code 0 0x%x\n", rxc);
3272                 return (0);     /* invalid code, no action */
3273         }
3274
3275         buf[buflen++] = rxc;
3276         if (buflen < 5)
3277                 return (0);
3278
3279         buflen = 0;     /* for next time... */
3280
3281         x = ((buf[2] & ~GTCO_START) << 6 | (buf[1] & ~GTCO_START));
3282         y = 4768 - ((buf[4] & ~GTCO_START) << 6 | (buf[3] & ~GTCO_START));
3283
3284         x /= 2.5;
3285         y /= 2.5;
3286
3287         act->flags = 0;
3288         act->obutton = act->button;
3289         act->dx = act->dy = act->dz = 0;
3290
3291         if ((buf[0] & 0x40) == 0) /* pen went out of reach */
3292                 status = S_IDLE;
3293         else if (status == S_IDLE) { /* pen is newly near the tablet */
3294                 act->flags |= MOUSE_POSCHANGED; /* force update */
3295                 status = S_PROXY;
3296                 x_prev = x;
3297                 y_prev = y;
3298         }
3299
3300         act->dx = x - x_prev;
3301         act->dy = y - y_prev;
3302         if (act->dx || act->dy)
3303                 act->flags |= MOUSE_POSCHANGED;
3304         x_prev = x;
3305         y_prev = y;
3306
3307         /* possibly record button change */
3308         if (b_prev != 0 && b_prev != buf[0]) {
3309                 act->button = 0;
3310                 if (buf[0] & 0x04) {
3311                         /* tip pressed/yellow */
3312                         act->button |= MOUSE_BUTTON1DOWN;
3313                 }
3314                 if (buf[0] & 0x08) {
3315                         /* grey/white */
3316                         act->button |= MOUSE_BUTTON2DOWN;
3317                 }
3318                 if (buf[0] & 0x10) {
3319                         /* black/green */
3320                         act->button |= MOUSE_BUTTON3DOWN;
3321                 }
3322                 if (buf[0] & 0x20) {
3323                         /* tip+grey/blue */
3324                         act->button |= MOUSE_BUTTON4DOWN;
3325                 }
3326                 act->flags |= MOUSE_BUTTONSCHANGED;
3327         }
3328         b_prev = buf[0];
3329         return (act->flags);
3330 }
3331
3332 static void
3333 mremote_serversetup(void)
3334 {
3335     struct sockaddr_un ad;
3336
3337     /* Open a UNIX domain stream socket to listen for mouse remote clients */
3338     unlink(_PATH_MOUSEREMOTE);
3339
3340     if ((rodent.mremsfd = socket(AF_UNIX, SOCK_STREAM, 0)) < 0)
3341         logerrx(1, "unable to create unix domain socket %s",_PATH_MOUSEREMOTE);
3342
3343     umask(0111);
3344
3345     bzero(&ad, sizeof(ad));
3346     ad.sun_family = AF_UNIX;
3347     strcpy(ad.sun_path, _PATH_MOUSEREMOTE);
3348 #ifndef SUN_LEN
3349 #define SUN_LEN(unp) (((char *)(unp)->sun_path - (char *)(unp)) + \
3350                        strlen((unp)->path))
3351 #endif
3352     if (bind(rodent.mremsfd, (struct sockaddr *) &ad, SUN_LEN(&ad)) < 0)
3353         logerrx(1, "unable to bind unix domain socket %s", _PATH_MOUSEREMOTE);
3354
3355     listen(rodent.mremsfd, 1);
3356 }
3357
3358 static void
3359 mremote_clientchg(int add)
3360 {
3361     struct sockaddr_un ad;
3362     socklen_t ad_len;
3363     int fd;
3364
3365     if (rodent.rtype != MOUSE_PROTO_X10MOUSEREM)
3366         return;
3367
3368     if (add) {
3369         /*  Accept client connection, if we don't already have one  */
3370         ad_len = sizeof(ad);
3371         fd = accept(rodent.mremsfd, (struct sockaddr *) &ad, &ad_len);
3372         if (fd < 0)
3373             logwarnx("failed accept on mouse remote socket");
3374
3375         if (rodent.mremcfd < 0) {
3376             rodent.mremcfd = fd;
3377             debug("remote client connect...accepted");
3378         }
3379         else {
3380             close(fd);
3381             debug("another remote client connect...disconnected");
3382         }
3383     }
3384     else {
3385         /* Client disconnected */
3386         debug("remote client disconnected");
3387         close(rodent.mremcfd);
3388         rodent.mremcfd = -1;
3389     }
3390 }