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