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