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