Current Path : /usr/src/usr.sbin/moused/ |
FreeBSD hs32.drive.ne.jp 9.1-RELEASE FreeBSD 9.1-RELEASE #1: Wed Jan 14 12:18:08 JST 2015 root@hs32.drive.ne.jp:/sys/amd64/compile/hs32 amd64 |
Current File : //usr/src/usr.sbin/moused/moused.c |
/** ** Copyright (c) 1995 Michael Smith, All rights reserved. ** ** Redistribution and use in source and binary forms, with or without ** modification, are permitted provided that the following conditions ** are met: ** 1. Redistributions of source code must retain the above copyright ** notice, this list of conditions and the following disclaimer as ** the first lines of this file unmodified. ** 2. Redistributions in binary form must reproduce the above copyright ** notice, this list of conditions and the following disclaimer in the ** documentation and/or other materials provided with the distribution. ** 3. All advertising materials mentioning features or use of this software ** must display the following acknowledgment: ** This product includes software developed by Michael Smith. ** 4. The name of the author may not be used to endorse or promote products ** derived from this software without specific prior written permission. ** ** ** THIS SOFTWARE IS PROVIDED BY Michael Smith ``AS IS'' AND ANY ** EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE ** IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR ** PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL Michael Smith BE LIABLE FOR ** ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR ** CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF ** SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR ** BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, ** WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE ** OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, ** EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. ** **/ /** ** MOUSED.C ** ** Mouse daemon : listens to a serial port, the bus mouse interface, or ** the PS/2 mouse port for mouse data stream, interprets data and passes ** ioctls off to the console driver. ** ** The mouse interface functions are derived closely from the mouse ** handler in the XFree86 X server. Many thanks to the XFree86 people ** for their great work! ** **/ #include <sys/cdefs.h> __FBSDID("$FreeBSD: release/9.1.0/usr.sbin/moused/moused.c 233559 2012-03-27 15:27:36Z hselasky $"); #include <sys/param.h> #include <sys/consio.h> #include <sys/mouse.h> #include <sys/socket.h> #include <sys/stat.h> #include <sys/time.h> #include <sys/un.h> #include <ctype.h> #include <err.h> #include <errno.h> #include <fcntl.h> #include <libutil.h> #include <limits.h> #include <setjmp.h> #include <signal.h> #include <stdarg.h> #include <stdint.h> #include <stdio.h> #include <stdlib.h> #include <string.h> #include <syslog.h> #include <termios.h> #include <unistd.h> #include <math.h> #define MAX_CLICKTHRESHOLD 2000 /* 2 seconds */ #define MAX_BUTTON2TIMEOUT 2000 /* 2 seconds */ #define DFLT_CLICKTHRESHOLD 500 /* 0.5 second */ #define DFLT_BUTTON2TIMEOUT 100 /* 0.1 second */ #define DFLT_SCROLLTHRESHOLD 3 /* 3 pixels */ #define DFLT_SCROLLSPEED 2 /* 2 pixels */ /* Abort 3-button emulation delay after this many movement events. */ #define BUTTON2_MAXMOVE 3 #define TRUE 1 #define FALSE 0 #define MOUSE_XAXIS (-1) #define MOUSE_YAXIS (-2) /* Logitech PS2++ protocol */ #define MOUSE_PS2PLUS_CHECKBITS(b) \ ((((b[2] & 0x03) << 2) | 0x02) == (b[1] & 0x0f)) #define MOUSE_PS2PLUS_PACKET_TYPE(b) \ (((b[0] & 0x30) >> 2) | ((b[1] & 0x30) >> 4)) #define ChordMiddle 0x0001 #define Emulate3Button 0x0002 #define ClearDTR 0x0004 #define ClearRTS 0x0008 #define NoPnP 0x0010 #define VirtualScroll 0x0020 #define HVirtualScroll 0x0040 #define ExponentialAcc 0x0080 #define ID_NONE 0 #define ID_PORT 1 #define ID_IF 2 #define ID_TYPE 4 #define ID_MODEL 8 #define ID_ALL (ID_PORT | ID_IF | ID_TYPE | ID_MODEL) /* Operations on timespecs */ #define tsclr(tvp) ((tvp)->tv_sec = (tvp)->tv_nsec = 0) #define tscmp(tvp, uvp, cmp) \ (((tvp)->tv_sec == (uvp)->tv_sec) ? \ ((tvp)->tv_nsec cmp (uvp)->tv_nsec) : \ ((tvp)->tv_sec cmp (uvp)->tv_sec)) #define tssub(tvp, uvp, vvp) \ do { \ (vvp)->tv_sec = (tvp)->tv_sec - (uvp)->tv_sec; \ (vvp)->tv_nsec = (tvp)->tv_nsec - (uvp)->tv_nsec; \ if ((vvp)->tv_nsec < 0) { \ (vvp)->tv_sec--; \ (vvp)->tv_nsec += 1000000000; \ } \ } while (0) #define debug(...) do { \ if (debug && nodaemon) \ warnx(__VA_ARGS__); \ } while (0) #define logerr(e, ...) do { \ log_or_warn(LOG_DAEMON | LOG_ERR, errno, __VA_ARGS__); \ exit(e); \ } while (0) #define logerrx(e, ...) do { \ log_or_warn(LOG_DAEMON | LOG_ERR, 0, __VA_ARGS__); \ exit(e); \ } while (0) #define logwarn(...) \ log_or_warn(LOG_DAEMON | LOG_WARNING, errno, __VA_ARGS__) #define logwarnx(...) \ log_or_warn(LOG_DAEMON | LOG_WARNING, 0, __VA_ARGS__) /* structures */ /* symbol table entry */ typedef struct { const char *name; int val; int val2; } symtab_t; /* serial PnP ID string */ typedef struct { int revision; /* PnP revision, 100 for 1.00 */ const char *eisaid; /* EISA ID including mfr ID and product ID */ char *serial; /* serial No, optional */ const char *class; /* device class, optional */ char *compat; /* list of compatible drivers, optional */ char *description; /* product description, optional */ int neisaid; /* length of the above fields... */ int nserial; int nclass; int ncompat; int ndescription; } pnpid_t; /* global variables */ int debug = 0; int nodaemon = FALSE; int background = FALSE; int paused = FALSE; int identify = ID_NONE; int extioctl = FALSE; const char *pidfile = "/var/run/moused.pid"; struct pidfh *pfh; #define SCROLL_NOTSCROLLING 0 #define SCROLL_PREPARE 1 #define SCROLL_SCROLLING 2 static int scroll_state; static int scroll_movement; static int hscroll_movement; /* local variables */ /* interface (the table must be ordered by MOUSE_IF_XXX in mouse.h) */ static symtab_t rifs[] = { { "serial", MOUSE_IF_SERIAL, 0 }, { "bus", MOUSE_IF_BUS, 0 }, { "inport", MOUSE_IF_INPORT, 0 }, { "ps/2", MOUSE_IF_PS2, 0 }, { "sysmouse", MOUSE_IF_SYSMOUSE, 0 }, { "usb", MOUSE_IF_USB, 0 }, { NULL, MOUSE_IF_UNKNOWN, 0 }, }; /* types (the table must be ordered by MOUSE_PROTO_XXX in mouse.h) */ static const char *rnames[] = { "microsoft", "mousesystems", "logitech", "mmseries", "mouseman", "busmouse", "inportmouse", "ps/2", "mmhitab", "glidepoint", "intellimouse", "thinkingmouse", "sysmouse", "x10mouseremote", "kidspad", "versapad", "jogdial", #if notyet "mariqua", #endif "gtco_digipad", NULL }; /* models */ static symtab_t rmodels[] = { { "NetScroll", MOUSE_MODEL_NETSCROLL, 0 }, { "NetMouse/NetScroll Optical", MOUSE_MODEL_NET, 0 }, { "GlidePoint", MOUSE_MODEL_GLIDEPOINT, 0 }, { "ThinkingMouse", MOUSE_MODEL_THINK, 0 }, { "IntelliMouse", MOUSE_MODEL_INTELLI, 0 }, { "EasyScroll/SmartScroll", MOUSE_MODEL_EASYSCROLL, 0 }, { "MouseMan+", MOUSE_MODEL_MOUSEMANPLUS, 0 }, { "Kidspad", MOUSE_MODEL_KIDSPAD, 0 }, { "VersaPad", MOUSE_MODEL_VERSAPAD, 0 }, { "IntelliMouse Explorer", MOUSE_MODEL_EXPLORER, 0 }, { "4D Mouse", MOUSE_MODEL_4D, 0 }, { "4D+ Mouse", MOUSE_MODEL_4DPLUS, 0 }, { "Synaptics Touchpad", MOUSE_MODEL_SYNAPTICS, 0 }, { "generic", MOUSE_MODEL_GENERIC, 0 }, { NULL, MOUSE_MODEL_UNKNOWN, 0 }, }; /* PnP EISA/product IDs */ static symtab_t pnpprod[] = { /* Kensignton ThinkingMouse */ { "KML0001", MOUSE_PROTO_THINK, MOUSE_MODEL_THINK }, /* MS IntelliMouse */ { "MSH0001", MOUSE_PROTO_INTELLI, MOUSE_MODEL_INTELLI }, /* MS IntelliMouse TrackBall */ { "MSH0004", MOUSE_PROTO_INTELLI, MOUSE_MODEL_INTELLI }, /* Tremon Wheel Mouse MUSD */ { "HTK0001", MOUSE_PROTO_INTELLI, MOUSE_MODEL_INTELLI }, /* Genius PnP Mouse */ { "KYE0001", MOUSE_PROTO_MS, MOUSE_MODEL_GENERIC }, /* MouseSystems SmartScroll Mouse (OEM from Genius?) */ { "KYE0002", MOUSE_PROTO_MS, MOUSE_MODEL_EASYSCROLL }, /* Genius NetMouse */ { "KYE0003", MOUSE_PROTO_INTELLI, MOUSE_MODEL_NET }, /* Genius Kidspad, Easypad and other tablets */ { "KYE0005", MOUSE_PROTO_KIDSPAD, MOUSE_MODEL_KIDSPAD }, /* Genius EZScroll */ { "KYEEZ00", MOUSE_PROTO_MS, MOUSE_MODEL_EASYSCROLL }, /* Logitech Cordless MouseMan Wheel */ { "LGI8033", MOUSE_PROTO_INTELLI, MOUSE_MODEL_MOUSEMANPLUS }, /* Logitech MouseMan (new 4 button model) */ { "LGI800C", MOUSE_PROTO_INTELLI, MOUSE_MODEL_MOUSEMANPLUS }, /* Logitech MouseMan+ */ { "LGI8050", MOUSE_PROTO_INTELLI, MOUSE_MODEL_MOUSEMANPLUS }, /* Logitech FirstMouse+ */ { "LGI8051", MOUSE_PROTO_INTELLI, MOUSE_MODEL_MOUSEMANPLUS }, /* Logitech serial */ { "LGI8001", MOUSE_PROTO_LOGIMOUSEMAN, MOUSE_MODEL_GENERIC }, /* A4 Tech 4D/4D+ Mouse */ { "A4W0005", MOUSE_PROTO_INTELLI, MOUSE_MODEL_4D }, /* 8D Scroll Mouse */ { "PEC9802", MOUSE_PROTO_INTELLI, MOUSE_MODEL_INTELLI }, /* Mitsumi Wireless Scroll Mouse */ { "MTM6401", MOUSE_PROTO_INTELLI, MOUSE_MODEL_INTELLI }, /* MS bus */ { "PNP0F00", MOUSE_PROTO_BUS, MOUSE_MODEL_GENERIC }, /* MS serial */ { "PNP0F01", MOUSE_PROTO_MS, MOUSE_MODEL_GENERIC }, /* MS InPort */ { "PNP0F02", MOUSE_PROTO_INPORT, MOUSE_MODEL_GENERIC }, /* MS PS/2 */ { "PNP0F03", MOUSE_PROTO_PS2, MOUSE_MODEL_GENERIC }, /* * EzScroll returns PNP0F04 in the compatible device field; but it * doesn't look compatible... XXX */ /* MouseSystems */ { "PNP0F04", MOUSE_PROTO_MSC, MOUSE_MODEL_GENERIC }, /* MouseSystems */ { "PNP0F05", MOUSE_PROTO_MSC, MOUSE_MODEL_GENERIC }, #if notyet /* Genius Mouse */ { "PNP0F06", MOUSE_PROTO_XXX, MOUSE_MODEL_GENERIC }, /* Genius Mouse */ { "PNP0F07", MOUSE_PROTO_XXX, MOUSE_MODEL_GENERIC }, #endif /* Logitech serial */ { "PNP0F08", MOUSE_PROTO_LOGIMOUSEMAN, MOUSE_MODEL_GENERIC }, /* MS BallPoint serial */ { "PNP0F09", MOUSE_PROTO_MS, MOUSE_MODEL_GENERIC }, /* MS PnP serial */ { "PNP0F0A", MOUSE_PROTO_MS, MOUSE_MODEL_GENERIC }, /* MS PnP BallPoint serial */ { "PNP0F0B", MOUSE_PROTO_MS, MOUSE_MODEL_GENERIC }, /* MS serial comatible */ { "PNP0F0C", MOUSE_PROTO_MS, MOUSE_MODEL_GENERIC }, /* MS InPort comatible */ { "PNP0F0D", MOUSE_PROTO_INPORT, MOUSE_MODEL_GENERIC }, /* MS PS/2 comatible */ { "PNP0F0E", MOUSE_PROTO_PS2, MOUSE_MODEL_GENERIC }, /* MS BallPoint comatible */ { "PNP0F0F", MOUSE_PROTO_MS, MOUSE_MODEL_GENERIC }, #if notyet /* TI QuickPort */ { "PNP0F10", MOUSE_PROTO_XXX, MOUSE_MODEL_GENERIC }, #endif /* MS bus comatible */ { "PNP0F11", MOUSE_PROTO_BUS, MOUSE_MODEL_GENERIC }, /* Logitech PS/2 */ { "PNP0F12", MOUSE_PROTO_PS2, MOUSE_MODEL_GENERIC }, /* PS/2 */ { "PNP0F13", MOUSE_PROTO_PS2, MOUSE_MODEL_GENERIC }, #if notyet /* MS Kids Mouse */ { "PNP0F14", MOUSE_PROTO_XXX, MOUSE_MODEL_GENERIC }, #endif /* Logitech bus */ { "PNP0F15", MOUSE_PROTO_BUS, MOUSE_MODEL_GENERIC }, #if notyet /* Logitech SWIFT */ { "PNP0F16", MOUSE_PROTO_XXX, MOUSE_MODEL_GENERIC }, #endif /* Logitech serial compat */ { "PNP0F17", MOUSE_PROTO_LOGIMOUSEMAN, MOUSE_MODEL_GENERIC }, /* Logitech bus compatible */ { "PNP0F18", MOUSE_PROTO_BUS, MOUSE_MODEL_GENERIC }, /* Logitech PS/2 compatible */ { "PNP0F19", MOUSE_PROTO_PS2, MOUSE_MODEL_GENERIC }, #if notyet /* Logitech SWIFT compatible */ { "PNP0F1A", MOUSE_PROTO_XXX, MOUSE_MODEL_GENERIC }, /* HP Omnibook */ { "PNP0F1B", MOUSE_PROTO_XXX, MOUSE_MODEL_GENERIC }, /* Compaq LTE TrackBall PS/2 */ { "PNP0F1C", MOUSE_PROTO_XXX, MOUSE_MODEL_GENERIC }, /* Compaq LTE TrackBall serial */ { "PNP0F1D", MOUSE_PROTO_XXX, MOUSE_MODEL_GENERIC }, /* MS Kidts Trackball */ { "PNP0F1E", MOUSE_PROTO_XXX, MOUSE_MODEL_GENERIC }, #endif /* Interlink VersaPad */ { "LNK0001", MOUSE_PROTO_VERSAPAD, MOUSE_MODEL_VERSAPAD }, { NULL, MOUSE_PROTO_UNKNOWN, MOUSE_MODEL_GENERIC }, }; /* the table must be ordered by MOUSE_PROTO_XXX in mouse.h */ static unsigned short rodentcflags[] = { (CS7 | CREAD | CLOCAL | HUPCL), /* MicroSoft */ (CS8 | CSTOPB | CREAD | CLOCAL | HUPCL), /* MouseSystems */ (CS8 | CSTOPB | CREAD | CLOCAL | HUPCL), /* Logitech */ (CS8 | PARENB | PARODD | CREAD | CLOCAL | HUPCL), /* MMSeries */ (CS7 | CREAD | CLOCAL | HUPCL), /* MouseMan */ 0, /* Bus */ 0, /* InPort */ 0, /* PS/2 */ (CS8 | CREAD | CLOCAL | HUPCL), /* MM HitTablet */ (CS7 | CREAD | CLOCAL | HUPCL), /* GlidePoint */ (CS7 | CREAD | CLOCAL | HUPCL), /* IntelliMouse */ (CS7 | CREAD | CLOCAL | HUPCL), /* Thinking Mouse */ (CS8 | CSTOPB | CREAD | CLOCAL | HUPCL), /* sysmouse */ (CS7 | CREAD | CLOCAL | HUPCL), /* X10 MouseRemote */ (CS8 | PARENB | PARODD | CREAD | CLOCAL | HUPCL), /* kidspad etc. */ (CS8 | CREAD | CLOCAL | HUPCL), /* VersaPad */ 0, /* JogDial */ #if notyet (CS8 | CSTOPB | CREAD | CLOCAL | HUPCL), /* Mariqua */ #endif (CS8 | CREAD | HUPCL ), /* GTCO Digi-Pad */ }; static struct rodentparam { int flags; const char *portname; /* /dev/XXX */ int rtype; /* MOUSE_PROTO_XXX */ int level; /* operation level: 0 or greater */ int baudrate; int rate; /* report rate */ int resolution; /* MOUSE_RES_XXX or a positive number */ int zmap[4]; /* MOUSE_{X|Y}AXIS or a button number */ int wmode; /* wheel mode button number */ int mfd; /* mouse file descriptor */ int cfd; /* /dev/consolectl file descriptor */ int mremsfd; /* mouse remote server file descriptor */ int mremcfd; /* mouse remote client file descriptor */ long clickthreshold; /* double click speed in msec */ long button2timeout; /* 3 button emulation timeout */ mousehw_t hw; /* mouse device hardware information */ mousemode_t mode; /* protocol information */ float accelx; /* Acceleration in the X axis */ float accely; /* Acceleration in the Y axis */ float expoaccel; /* Exponential acceleration */ float expoffset; /* Movement offset for exponential accel. */ float remainx; /* Remainder on X and Y axis, respectively... */ float remainy; /* ... to compensate for rounding errors. */ int scrollthreshold; /* Movement distance before virtual scrolling */ int scrollspeed; /* Movement distance to rate of scrolling */ } rodent = { .flags = 0, .portname = NULL, .rtype = MOUSE_PROTO_UNKNOWN, .level = -1, .baudrate = 1200, .rate = 0, .resolution = MOUSE_RES_UNKNOWN, .zmap = { 0, 0, 0, 0 }, .wmode = 0, .mfd = -1, .cfd = -1, .mremsfd = -1, .mremcfd = -1, .clickthreshold = DFLT_CLICKTHRESHOLD, .button2timeout = DFLT_BUTTON2TIMEOUT, .accelx = 1.0, .accely = 1.0, .expoaccel = 1.0, .expoffset = 1.0, .remainx = 0.0, .remainy = 0.0, .scrollthreshold = DFLT_SCROLLTHRESHOLD, .scrollspeed = DFLT_SCROLLSPEED, }; /* button status */ struct button_state { int count; /* 0: up, 1: single click, 2: double click,... */ struct timespec ts; /* timestamp on the last button event */ }; static struct button_state bstate[MOUSE_MAXBUTTON]; /* button state */ static struct button_state *mstate[MOUSE_MAXBUTTON];/* mapped button st.*/ static struct button_state zstate[4]; /* Z/W axis state */ /* state machine for 3 button emulation */ #define S0 0 /* start */ #define S1 1 /* button 1 delayed down */ #define S2 2 /* button 3 delayed down */ #define S3 3 /* both buttons down -> button 2 down */ #define S4 4 /* button 1 delayed up */ #define S5 5 /* button 1 down */ #define S6 6 /* button 3 down */ #define S7 7 /* both buttons down */ #define S8 8 /* button 3 delayed up */ #define S9 9 /* button 1 or 3 up after S3 */ #define A(b1, b3) (((b1) ? 2 : 0) | ((b3) ? 1 : 0)) #define A_TIMEOUT 4 #define S_DELAYED(st) (states[st].s[A_TIMEOUT] != (st)) static struct { int s[A_TIMEOUT + 1]; int buttons; int mask; int timeout; } states[10] = { /* S0 */ { { S0, S2, S1, S3, S0 }, 0, ~(MOUSE_BUTTON1DOWN | MOUSE_BUTTON3DOWN), FALSE }, /* S1 */ { { S4, S2, S1, S3, S5 }, 0, ~MOUSE_BUTTON1DOWN, FALSE }, /* S2 */ { { S8, S2, S1, S3, S6 }, 0, ~MOUSE_BUTTON3DOWN, FALSE }, /* S3 */ { { S0, S9, S9, S3, S3 }, MOUSE_BUTTON2DOWN, ~0, FALSE }, /* S4 */ { { S0, S2, S1, S3, S0 }, MOUSE_BUTTON1DOWN, ~0, TRUE }, /* S5 */ { { S0, S2, S5, S7, S5 }, MOUSE_BUTTON1DOWN, ~0, FALSE }, /* S6 */ { { S0, S6, S1, S7, S6 }, MOUSE_BUTTON3DOWN, ~0, FALSE }, /* S7 */ { { S0, S6, S5, S7, S7 }, MOUSE_BUTTON1DOWN | MOUSE_BUTTON3DOWN, ~0, FALSE }, /* S8 */ { { S0, S2, S1, S3, S0 }, MOUSE_BUTTON3DOWN, ~0, TRUE }, /* S9 */ { { S0, S9, S9, S3, S9 }, 0, ~(MOUSE_BUTTON1DOWN | MOUSE_BUTTON3DOWN), FALSE }, }; static int mouse_button_state; static struct timespec mouse_button_state_ts; static int mouse_move_delayed; static jmp_buf env; struct drift_xy { int x; int y; }; static int drift_distance = 4; /* max steps X+Y */ static int drift_time = 500; /* in 0.5 sec */ static struct timespec drift_time_ts; static struct timespec drift_2time_ts; /* 2*drift_time */ static int drift_after = 4000; /* 4 sec */ static struct timespec drift_after_ts; static int drift_terminate = FALSE; static struct timespec drift_current_ts; static struct timespec drift_tmp; static struct timespec drift_last_activity = {0, 0}; static struct timespec drift_since = {0, 0}; static struct drift_xy drift_last = {0, 0}; /* steps in last drift_time */ static struct drift_xy drift_previous = {0, 0}; /* steps in prev. drift_time */ /* function prototypes */ static void linacc(int, int, int*, int*); static void expoacc(int, int, int*, int*); static void moused(void); static void hup(int sig); static void cleanup(int sig); static void pause_mouse(int sig); static void usage(void); static void log_or_warn(int log_pri, int errnum, const char *fmt, ...) __printflike(3, 4); static int r_identify(void); static const char *r_if(int type); static const char *r_name(int type); static const char *r_model(int model); static void r_init(void); static int r_protocol(u_char b, mousestatus_t *act); static int r_statetrans(mousestatus_t *a1, mousestatus_t *a2, int trans); static int r_installmap(char *arg); static void r_map(mousestatus_t *act1, mousestatus_t *act2); static void r_timestamp(mousestatus_t *act); static int r_timeout(void); static void r_click(mousestatus_t *act); static void setmousespeed(int old, int new, unsigned cflag); static int pnpwakeup1(void); static int pnpwakeup2(void); static int pnpgets(char *buf); static int pnpparse(pnpid_t *id, char *buf, int len); static symtab_t *pnpproto(pnpid_t *id); static symtab_t *gettoken(symtab_t *tab, const char *s, int len); static const char *gettokenname(symtab_t *tab, int val); static void mremote_serversetup(void); static void mremote_clientchg(int add); static int kidspad(u_char rxc, mousestatus_t *act); static int gtco_digipad(u_char, mousestatus_t *); int main(int argc, char *argv[]) { int c; int i; int j; static int retry; for (i = 0; i < MOUSE_MAXBUTTON; ++i) mstate[i] = &bstate[i]; while ((c = getopt(argc, argv, "3A:C:DE:F:HI:L:PRS:T:VU:a:cdfhi:l:m:p:r:st:w:z:")) != -1) switch(c) { case '3': rodent.flags |= Emulate3Button; break; case 'E': rodent.button2timeout = atoi(optarg); if ((rodent.button2timeout < 0) || (rodent.button2timeout > MAX_BUTTON2TIMEOUT)) { warnx("invalid argument `%s'", optarg); usage(); } break; case 'a': i = sscanf(optarg, "%f,%f", &rodent.accelx, &rodent.accely); if (i == 0) { warnx("invalid linear acceleration argument '%s'", optarg); usage(); } if (i == 1) rodent.accely = rodent.accelx; break; case 'A': rodent.flags |= ExponentialAcc; i = sscanf(optarg, "%f,%f", &rodent.expoaccel, &rodent.expoffset); if (i == 0) { warnx("invalid exponential acceleration argument '%s'", optarg); usage(); } if (i == 1) rodent.expoffset = 1.0; break; case 'c': rodent.flags |= ChordMiddle; break; case 'd': ++debug; break; case 'f': nodaemon = TRUE; break; case 'i': if (strcmp(optarg, "all") == 0) identify = ID_ALL; else if (strcmp(optarg, "port") == 0) identify = ID_PORT; else if (strcmp(optarg, "if") == 0) identify = ID_IF; else if (strcmp(optarg, "type") == 0) identify = ID_TYPE; else if (strcmp(optarg, "model") == 0) identify = ID_MODEL; else { warnx("invalid argument `%s'", optarg); usage(); } nodaemon = TRUE; break; case 'l': rodent.level = atoi(optarg); if ((rodent.level < 0) || (rodent.level > 4)) { warnx("invalid argument `%s'", optarg); usage(); } break; case 'm': if (!r_installmap(optarg)) { warnx("invalid argument `%s'", optarg); usage(); } break; case 'p': rodent.portname = optarg; break; case 'r': if (strcmp(optarg, "high") == 0) rodent.resolution = MOUSE_RES_HIGH; else if (strcmp(optarg, "medium-high") == 0) rodent.resolution = MOUSE_RES_HIGH; else if (strcmp(optarg, "medium-low") == 0) rodent.resolution = MOUSE_RES_MEDIUMLOW; else if (strcmp(optarg, "low") == 0) rodent.resolution = MOUSE_RES_LOW; else if (strcmp(optarg, "default") == 0) rodent.resolution = MOUSE_RES_DEFAULT; else { rodent.resolution = atoi(optarg); if (rodent.resolution <= 0) { warnx("invalid argument `%s'", optarg); usage(); } } break; case 's': rodent.baudrate = 9600; break; case 'w': i = atoi(optarg); if ((i <= 0) || (i > MOUSE_MAXBUTTON)) { warnx("invalid argument `%s'", optarg); usage(); } rodent.wmode = 1 << (i - 1); break; case 'z': if (strcmp(optarg, "x") == 0) rodent.zmap[0] = MOUSE_XAXIS; else if (strcmp(optarg, "y") == 0) rodent.zmap[0] = MOUSE_YAXIS; else { i = atoi(optarg); /* * Use button i for negative Z axis movement and * button (i + 1) for positive Z axis movement. */ if ((i <= 0) || (i > MOUSE_MAXBUTTON - 1)) { warnx("invalid argument `%s'", optarg); usage(); } rodent.zmap[0] = i; rodent.zmap[1] = i + 1; debug("optind: %d, optarg: '%s'", optind, optarg); for (j = 1; j < 4; ++j) { if ((optind >= argc) || !isdigit(*argv[optind])) break; i = atoi(argv[optind]); if ((i <= 0) || (i > MOUSE_MAXBUTTON - 1)) { warnx("invalid argument `%s'", argv[optind]); usage(); } rodent.zmap[j] = i; ++optind; } if ((rodent.zmap[2] != 0) && (rodent.zmap[3] == 0)) rodent.zmap[3] = rodent.zmap[2] + 1; } break; case 'C': rodent.clickthreshold = atoi(optarg); if ((rodent.clickthreshold < 0) || (rodent.clickthreshold > MAX_CLICKTHRESHOLD)) { warnx("invalid argument `%s'", optarg); usage(); } break; case 'D': rodent.flags |= ClearDTR; break; case 'F': rodent.rate = atoi(optarg); if (rodent.rate <= 0) { warnx("invalid argument `%s'", optarg); usage(); } break; case 'H': rodent.flags |= HVirtualScroll; break; case 'I': pidfile = optarg; break; case 'L': rodent.scrollspeed = atoi(optarg); if (rodent.scrollspeed < 0) { warnx("invalid argument `%s'", optarg); usage(); } break; case 'P': rodent.flags |= NoPnP; break; case 'R': rodent.flags |= ClearRTS; break; case 'S': rodent.baudrate = atoi(optarg); if (rodent.baudrate <= 0) { warnx("invalid argument `%s'", optarg); usage(); } debug("rodent baudrate %d", rodent.baudrate); break; case 'T': drift_terminate = TRUE; sscanf(optarg, "%d,%d,%d", &drift_distance, &drift_time, &drift_after); if (drift_distance <= 0 || drift_time <= 0 || drift_after <= 0) { warnx("invalid argument `%s'", optarg); usage(); } debug("terminate drift: distance %d, time %d, after %d", drift_distance, drift_time, drift_after); drift_time_ts.tv_sec = drift_time / 1000; drift_time_ts.tv_nsec = (drift_time % 1000) * 1000000; drift_2time_ts.tv_sec = (drift_time *= 2) / 1000; drift_2time_ts.tv_nsec = (drift_time % 1000) * 1000000; drift_after_ts.tv_sec = drift_after / 1000; drift_after_ts.tv_nsec = (drift_after % 1000) * 1000000; break; case 't': if (strcmp(optarg, "auto") == 0) { rodent.rtype = MOUSE_PROTO_UNKNOWN; rodent.flags &= ~NoPnP; rodent.level = -1; break; } for (i = 0; rnames[i] != NULL; i++) if (strcmp(optarg, rnames[i]) == 0) { rodent.rtype = i; rodent.flags |= NoPnP; rodent.level = (i == MOUSE_PROTO_SYSMOUSE) ? 1 : 0; break; } if (rnames[i] == NULL) { warnx("no such mouse type `%s'", optarg); usage(); } break; case 'V': rodent.flags |= VirtualScroll; break; case 'U': rodent.scrollthreshold = atoi(optarg); if (rodent.scrollthreshold < 0) { warnx("invalid argument `%s'", optarg); usage(); } break; case 'h': case '?': default: usage(); } /* fix Z axis mapping */ for (i = 0; i < 4; ++i) { if (rodent.zmap[i] > 0) { for (j = 0; j < MOUSE_MAXBUTTON; ++j) { if (mstate[j] == &bstate[rodent.zmap[i] - 1]) mstate[j] = &zstate[i]; } rodent.zmap[i] = 1 << (rodent.zmap[i] - 1); } } /* the default port name */ switch(rodent.rtype) { case MOUSE_PROTO_INPORT: /* INPORT and BUS are the same... */ rodent.rtype = MOUSE_PROTO_BUS; /* FALLTHROUGH */ case MOUSE_PROTO_BUS: if (!rodent.portname) rodent.portname = "/dev/mse0"; break; case MOUSE_PROTO_PS2: if (!rodent.portname) rodent.portname = "/dev/psm0"; break; default: if (rodent.portname) break; warnx("no port name specified"); usage(); } retry = 1; if (strncmp(rodent.portname, "/dev/ums", 8) == 0) { retry = 5; } for (;;) { if (setjmp(env) == 0) { signal(SIGHUP, hup); signal(SIGINT , cleanup); signal(SIGQUIT, cleanup); signal(SIGTERM, cleanup); signal(SIGUSR1, pause_mouse); for (i = 0; i < retry; ++i) { if (i > 0) sleep(2); rodent.mfd = open(rodent.portname, O_RDWR | O_NONBLOCK); if (rodent.mfd != -1 || errno != ENOENT) break; } if (rodent.mfd == -1) logerr(1, "unable to open %s", rodent.portname); if (r_identify() == MOUSE_PROTO_UNKNOWN) { logwarnx("cannot determine mouse type on %s", rodent.portname); close(rodent.mfd); rodent.mfd = -1; } /* print some information */ if (identify != ID_NONE) { if (identify == ID_ALL) printf("%s %s %s %s\n", rodent.portname, r_if(rodent.hw.iftype), r_name(rodent.rtype), r_model(rodent.hw.model)); else if (identify & ID_PORT) printf("%s\n", rodent.portname); else if (identify & ID_IF) printf("%s\n", r_if(rodent.hw.iftype)); else if (identify & ID_TYPE) printf("%s\n", r_name(rodent.rtype)); else if (identify & ID_MODEL) printf("%s\n", r_model(rodent.hw.model)); exit(0); } else { debug("port: %s interface: %s type: %s model: %s", rodent.portname, r_if(rodent.hw.iftype), r_name(rodent.rtype), r_model(rodent.hw.model)); } if (rodent.mfd == -1) { /* * We cannot continue because of error. Exit if the * program has not become a daemon. Otherwise, block * until the user corrects the problem and issues SIGHUP. */ if (!background) exit(1); sigpause(0); } r_init(); /* call init function */ moused(); } if (rodent.mfd != -1) close(rodent.mfd); if (rodent.cfd != -1) close(rodent.cfd); rodent.mfd = rodent.cfd = -1; } /* NOT REACHED */ exit(0); } /* * Function to calculate linear acceleration. * * If there are any rounding errors, the remainder * is stored in the remainx and remainy variables * and taken into account upon the next movement. */ static void linacc(int dx, int dy, int *movex, int *movey) { float fdx, fdy; if (dx == 0 && dy == 0) { *movex = *movey = 0; return; } fdx = dx * rodent.accelx + rodent.remainx; fdy = dy * rodent.accely + rodent.remainy; *movex = lround(fdx); *movey = lround(fdy); rodent.remainx = fdx - *movex; rodent.remainy = fdy - *movey; } /* * Function to calculate exponential acceleration. * (Also includes linear acceleration if enabled.) * * In order to give a smoother behaviour, we record the four * most recent non-zero movements and use their average value * to calculate the acceleration. */ static void expoacc(int dx, int dy, int *movex, int *movey) { static float lastlength[3] = {0.0, 0.0, 0.0}; float fdx, fdy, length, lbase, accel; if (dx == 0 && dy == 0) { *movex = *movey = 0; return; } fdx = dx * rodent.accelx; fdy = dy * rodent.accely; length = sqrtf((fdx * fdx) + (fdy * fdy)); /* Pythagoras */ length = (length + lastlength[0] + lastlength[1] + lastlength[2]) / 4; lbase = length / rodent.expoffset; accel = powf(lbase, rodent.expoaccel) / lbase; fdx = fdx * accel + rodent.remainx; fdy = fdy * accel + rodent.remainy; *movex = lroundf(fdx); *movey = lroundf(fdy); rodent.remainx = fdx - *movex; rodent.remainy = fdy - *movey; lastlength[2] = lastlength[1]; lastlength[1] = lastlength[0]; lastlength[0] = length; /* Insert new average, not original length! */ } static void moused(void) { struct mouse_info mouse; mousestatus_t action0; /* original mouse action */ mousestatus_t action; /* interrim buffer */ mousestatus_t action2; /* mapped action */ struct timeval timeout; fd_set fds; u_char b; pid_t mpid; int flags; int c; int i; if ((rodent.cfd = open("/dev/consolectl", O_RDWR, 0)) == -1) logerr(1, "cannot open /dev/consolectl"); if (!nodaemon && !background) { pfh = pidfile_open(pidfile, 0600, &mpid); if (pfh == NULL) { if (errno == EEXIST) logerrx(1, "moused already running, pid: %d", mpid); logwarn("cannot open pid file"); } if (daemon(0, 0)) { int saved_errno = errno; pidfile_remove(pfh); errno = saved_errno; logerr(1, "failed to become a daemon"); } else { background = TRUE; pidfile_write(pfh); } } /* clear mouse data */ bzero(&action0, sizeof(action0)); bzero(&action, sizeof(action)); bzero(&action2, sizeof(action2)); bzero(&mouse, sizeof(mouse)); mouse_button_state = S0; clock_gettime(CLOCK_MONOTONIC_FAST, &mouse_button_state_ts); mouse_move_delayed = 0; for (i = 0; i < MOUSE_MAXBUTTON; ++i) { bstate[i].count = 0; bstate[i].ts = mouse_button_state_ts; } for (i = 0; i < (int)(sizeof(zstate) / sizeof(zstate[0])); ++i) { zstate[i].count = 0; zstate[i].ts = mouse_button_state_ts; } /* choose which ioctl command to use */ mouse.operation = MOUSE_MOTION_EVENT; extioctl = (ioctl(rodent.cfd, CONS_MOUSECTL, &mouse) == 0); /* process mouse data */ timeout.tv_sec = 0; timeout.tv_usec = 20000; /* 20 msec */ for (;;) { FD_ZERO(&fds); FD_SET(rodent.mfd, &fds); if (rodent.mremsfd >= 0) FD_SET(rodent.mremsfd, &fds); if (rodent.mremcfd >= 0) FD_SET(rodent.mremcfd, &fds); c = select(FD_SETSIZE, &fds, NULL, NULL, ((rodent.flags & Emulate3Button) && S_DELAYED(mouse_button_state)) ? &timeout : NULL); if (c < 0) { /* error */ logwarn("failed to read from mouse"); continue; } else if (c == 0) { /* timeout */ /* assert(rodent.flags & Emulate3Button) */ action0.button = action0.obutton; action0.dx = action0.dy = action0.dz = 0; action0.flags = flags = 0; if (r_timeout() && r_statetrans(&action0, &action, A_TIMEOUT)) { if (debug > 2) debug("flags:%08x buttons:%08x obuttons:%08x", action.flags, action.button, action.obutton); } else { action0.obutton = action0.button; continue; } } else { /* MouseRemote client connect/disconnect */ if ((rodent.mremsfd >= 0) && FD_ISSET(rodent.mremsfd, &fds)) { mremote_clientchg(TRUE); continue; } if ((rodent.mremcfd >= 0) && FD_ISSET(rodent.mremcfd, &fds)) { mremote_clientchg(FALSE); continue; } /* mouse movement */ if (read(rodent.mfd, &b, 1) == -1) { if (errno == EWOULDBLOCK) continue; else return; } if ((flags = r_protocol(b, &action0)) == 0) continue; if ((rodent.flags & VirtualScroll) || (rodent.flags & HVirtualScroll)) { /* Allow middle button drags to scroll up and down */ if (action0.button == MOUSE_BUTTON2DOWN) { if (scroll_state == SCROLL_NOTSCROLLING) { scroll_state = SCROLL_PREPARE; scroll_movement = hscroll_movement = 0; debug("PREPARING TO SCROLL"); } debug("[BUTTON2] flags:%08x buttons:%08x obuttons:%08x", action.flags, action.button, action.obutton); } else { debug("[NOTBUTTON2] flags:%08x buttons:%08x obuttons:%08x", action.flags, action.button, action.obutton); /* This isn't a middle button down... move along... */ if (scroll_state == SCROLL_SCROLLING) { /* * We were scrolling, someone let go of button 2. * Now turn autoscroll off. */ scroll_state = SCROLL_NOTSCROLLING; debug("DONE WITH SCROLLING / %d", scroll_state); } else if (scroll_state == SCROLL_PREPARE) { mousestatus_t newaction = action0; /* We were preparing to scroll, but we never moved... */ r_timestamp(&action0); r_statetrans(&action0, &newaction, A(newaction.button & MOUSE_BUTTON1DOWN, action0.button & MOUSE_BUTTON3DOWN)); /* Send middle down */ newaction.button = MOUSE_BUTTON2DOWN; r_click(&newaction); /* Send middle up */ r_timestamp(&newaction); newaction.obutton = newaction.button; newaction.button = action0.button; r_click(&newaction); } } } r_timestamp(&action0); r_statetrans(&action0, &action, A(action0.button & MOUSE_BUTTON1DOWN, action0.button & MOUSE_BUTTON3DOWN)); debug("flags:%08x buttons:%08x obuttons:%08x", action.flags, action.button, action.obutton); } action0.obutton = action0.button; flags &= MOUSE_POSCHANGED; flags |= action.obutton ^ action.button; action.flags = flags; if (flags) { /* handler detected action */ r_map(&action, &action2); debug("activity : buttons 0x%08x dx %d dy %d dz %d", action2.button, action2.dx, action2.dy, action2.dz); if ((rodent.flags & VirtualScroll) || (rodent.flags & HVirtualScroll)) { /* * If *only* the middle button is pressed AND we are moving * the stick/trackpoint/nipple, scroll! */ if (scroll_state == SCROLL_PREPARE) { /* Middle button down, waiting for movement threshold */ if (action2.dy || action2.dx) { if (rodent.flags & VirtualScroll) { scroll_movement += action2.dy; if (scroll_movement < -rodent.scrollthreshold) { scroll_state = SCROLL_SCROLLING; } else if (scroll_movement > rodent.scrollthreshold) { scroll_state = SCROLL_SCROLLING; } } if (rodent.flags & HVirtualScroll) { hscroll_movement += action2.dx; if (hscroll_movement < -rodent.scrollthreshold) { scroll_state = SCROLL_SCROLLING; } else if (hscroll_movement > rodent.scrollthreshold) { scroll_state = SCROLL_SCROLLING; } } if (scroll_state == SCROLL_SCROLLING) scroll_movement = hscroll_movement = 0; } } else if (scroll_state == SCROLL_SCROLLING) { if (rodent.flags & VirtualScroll) { scroll_movement += action2.dy; debug("SCROLL: %d", scroll_movement); if (scroll_movement < -rodent.scrollspeed) { /* Scroll down */ action2.dz = -1; scroll_movement = 0; } else if (scroll_movement > rodent.scrollspeed) { /* Scroll up */ action2.dz = 1; scroll_movement = 0; } } if (rodent.flags & HVirtualScroll) { hscroll_movement += action2.dx; debug("HORIZONTAL SCROLL: %d", hscroll_movement); if (hscroll_movement < -rodent.scrollspeed) { action2.dz = -2; hscroll_movement = 0; } else if (hscroll_movement > rodent.scrollspeed) { action2.dz = 2; hscroll_movement = 0; } } /* Don't move while scrolling */ action2.dx = action2.dy = 0; } } if (drift_terminate) { if ((flags & MOUSE_POSCHANGED) == 0 || action.dz || action2.dz) drift_last_activity = drift_current_ts; else { /* X or/and Y movement only - possibly drift */ tssub(&drift_current_ts, &drift_last_activity, &drift_tmp); if (tscmp(&drift_tmp, &drift_after_ts, >)) { tssub(&drift_current_ts, &drift_since, &drift_tmp); if (tscmp(&drift_tmp, &drift_time_ts, <)) { drift_last.x += action2.dx; drift_last.y += action2.dy; } else { /* discard old accumulated steps (drift) */ if (tscmp(&drift_tmp, &drift_2time_ts, >)) drift_previous.x = drift_previous.y = 0; else drift_previous = drift_last; drift_last.x = action2.dx; drift_last.y = action2.dy; drift_since = drift_current_ts; } if (abs(drift_last.x) + abs(drift_last.y) > drift_distance) { /* real movement, pass all accumulated steps */ action2.dx = drift_previous.x + drift_last.x; action2.dy = drift_previous.y + drift_last.y; /* and reset accumulators */ tsclr(&drift_since); drift_last.x = drift_last.y = 0; /* drift_previous will be cleared at next movement*/ drift_last_activity = drift_current_ts; } else { continue; /* don't pass current movement to * console driver */ } } } } if (extioctl) { /* Defer clicks until we aren't VirtualScroll'ing. */ if (scroll_state == SCROLL_NOTSCROLLING) r_click(&action2); if (action2.flags & MOUSE_POSCHANGED) { mouse.operation = MOUSE_MOTION_EVENT; mouse.u.data.buttons = action2.button; if (rodent.flags & ExponentialAcc) { expoacc(action2.dx, action2.dy, &mouse.u.data.x, &mouse.u.data.y); } else { linacc(action2.dx, action2.dy, &mouse.u.data.x, &mouse.u.data.y); } mouse.u.data.z = action2.dz; if (debug < 2) if (!paused) ioctl(rodent.cfd, CONS_MOUSECTL, &mouse); } } else { mouse.operation = MOUSE_ACTION; mouse.u.data.buttons = action2.button; if (rodent.flags & ExponentialAcc) { expoacc(action2.dx, action2.dy, &mouse.u.data.x, &mouse.u.data.y); } else { linacc(action2.dx, action2.dy, &mouse.u.data.x, &mouse.u.data.y); } mouse.u.data.z = action2.dz; if (debug < 2) if (!paused) ioctl(rodent.cfd, CONS_MOUSECTL, &mouse); } /* * If the Z axis movement is mapped to an imaginary physical * button, we need to cook up a corresponding button `up' event * after sending a button `down' event. */ if ((rodent.zmap[0] > 0) && (action.dz != 0)) { action.obutton = action.button; action.dx = action.dy = action.dz = 0; r_map(&action, &action2); debug("activity : buttons 0x%08x dx %d dy %d dz %d", action2.button, action2.dx, action2.dy, action2.dz); if (extioctl) { r_click(&action2); } else { mouse.operation = MOUSE_ACTION; mouse.u.data.buttons = action2.button; mouse.u.data.x = mouse.u.data.y = mouse.u.data.z = 0; if (debug < 2) if (!paused) ioctl(rodent.cfd, CONS_MOUSECTL, &mouse); } } } } /* NOT REACHED */ } static void hup(__unused int sig) { longjmp(env, 1); } static void cleanup(__unused int sig) { if (rodent.rtype == MOUSE_PROTO_X10MOUSEREM) unlink(_PATH_MOUSEREMOTE); exit(0); } static void pause_mouse(__unused int sig) { paused = !paused; } /** ** usage ** ** Complain, and free the CPU for more worthy tasks **/ static void usage(void) { fprintf(stderr, "%s\n%s\n%s\n%s\n%s\n", "usage: moused [-DRcdfs] [-I file] [-F rate] [-r resolution] [-S baudrate]", " [-VH [-U threshold]] [-a X[,Y]] [-C threshold] [-m N=M] [-w N]", " [-z N] [-t <mousetype>] [-l level] [-3 [-E timeout]]", " [-T distance[,time[,after]]] -p <port>", " moused [-d] -i <port|if|type|model|all> -p <port>"); exit(1); } /* * Output an error message to syslog or stderr as appropriate. If * `errnum' is non-zero, append its string form to the message. */ static void log_or_warn(int log_pri, int errnum, const char *fmt, ...) { va_list ap; char buf[256]; va_start(ap, fmt); vsnprintf(buf, sizeof(buf), fmt, ap); va_end(ap); if (errnum) { strlcat(buf, ": ", sizeof(buf)); strlcat(buf, strerror(errnum), sizeof(buf)); } if (background) syslog(log_pri, "%s", buf); else warnx("%s", buf); } /** ** Mouse interface code, courtesy of XFree86 3.1.2. ** ** Note: Various bits have been trimmed, and in my shortsighted enthusiasm ** to clean, reformat and rationalise naming, it's quite possible that ** some things in here have been broken. ** ** I hope not 8) ** ** The following code is derived from a module marked : **/ /* $XConsortium: xf86_Mouse.c,v 1.2 94/10/12 20:33:21 kaleb Exp $ */ /* $XFree86: xc/programs/Xserver/hw/xfree86/common/xf86_Mouse.c,v 3.2 1995/01/28 17:03:40 dawes Exp $ */ /* * * Copyright 1990,91 by Thomas Roell, Dinkelscherben, Germany. * Copyright 1993 by David Dawes <dawes@physics.su.oz.au> * * Permission to use, copy, modify, distribute, and sell this software and its * documentation for any purpose is hereby granted without fee, provided that * the above copyright notice appear in all copies and that both that * copyright notice and this permission notice appear in supporting * documentation, and that the names of Thomas Roell and David Dawes not be * used in advertising or publicity pertaining to distribution of the * software without specific, written prior permission. Thomas Roell * and David Dawes makes no representations about the suitability of this * software for any purpose. It is provided "as is" without express or * implied warranty. * * THOMAS ROELL AND DAVID DAWES DISCLAIM ALL WARRANTIES WITH REGARD TO THIS * SOFTWARE, INCLUDING ALL IMPLIED WARRANTIES OF MERCHANTABILITY AND * FITNESS, IN NO EVENT SHALL THOMAS ROELL OR DAVID DAWES BE LIABLE FOR ANY * SPECIAL, INDIRECT OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES WHATSOEVER * RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN ACTION OF * CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF OR IN * CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE. * */ /** ** GlidePoint support from XFree86 3.2. ** Derived from the module: **/ /* $XFree86: xc/programs/Xserver/hw/xfree86/common/xf86_Mouse.c,v 3.19 1996/10/16 14:40:51 dawes Exp $ */ /* $XConsortium: xf86_Mouse.c /main/10 1996/01/30 15:16:12 kaleb $ */ /* the following table must be ordered by MOUSE_PROTO_XXX in mouse.h */ static unsigned char proto[][7] = { /* hd_mask hd_id dp_mask dp_id bytes b4_mask b4_id */ { 0x40, 0x40, 0x40, 0x00, 3, ~0x23, 0x00 }, /* MicroSoft */ { 0xf8, 0x80, 0x00, 0x00, 5, 0x00, 0xff }, /* MouseSystems */ { 0xe0, 0x80, 0x80, 0x00, 3, 0x00, 0xff }, /* Logitech */ { 0xe0, 0x80, 0x80, 0x00, 3, 0x00, 0xff }, /* MMSeries */ { 0x40, 0x40, 0x40, 0x00, 3, ~0x33, 0x00 }, /* MouseMan */ { 0xf8, 0x80, 0x00, 0x00, 5, 0x00, 0xff }, /* Bus */ { 0xf8, 0x80, 0x00, 0x00, 5, 0x00, 0xff }, /* InPort */ { 0xc0, 0x00, 0x00, 0x00, 3, 0x00, 0xff }, /* PS/2 mouse */ { 0xe0, 0x80, 0x80, 0x00, 3, 0x00, 0xff }, /* MM HitTablet */ { 0x40, 0x40, 0x40, 0x00, 3, ~0x33, 0x00 }, /* GlidePoint */ { 0x40, 0x40, 0x40, 0x00, 3, ~0x3f, 0x00 }, /* IntelliMouse */ { 0x40, 0x40, 0x40, 0x00, 3, ~0x33, 0x00 }, /* ThinkingMouse */ { 0xf8, 0x80, 0x00, 0x00, 5, 0x00, 0xff }, /* sysmouse */ { 0x40, 0x40, 0x40, 0x00, 3, ~0x23, 0x00 }, /* X10 MouseRem */ { 0x80, 0x80, 0x00, 0x00, 5, 0x00, 0xff }, /* KIDSPAD */ { 0xc3, 0xc0, 0x00, 0x00, 6, 0x00, 0xff }, /* VersaPad */ { 0x00, 0x00, 0x00, 0x00, 1, 0x00, 0xff }, /* JogDial */ #if notyet { 0xf8, 0x80, 0x00, 0x00, 5, ~0x2f, 0x10 }, /* Mariqua */ #endif }; static unsigned char cur_proto[7]; static int r_identify(void) { char pnpbuf[256]; /* PnP identifier string may be up to 256 bytes long */ pnpid_t pnpid; symtab_t *t; int level; int len; /* set the driver operation level, if applicable */ if (rodent.level < 0) rodent.level = 1; ioctl(rodent.mfd, MOUSE_SETLEVEL, &rodent.level); rodent.level = (ioctl(rodent.mfd, MOUSE_GETLEVEL, &level) == 0) ? level : 0; /* * Interrogate the driver and get some intelligence on the device... * The following ioctl functions are not always supported by device * drivers. When the driver doesn't support them, we just trust the * user to supply valid information. */ rodent.hw.iftype = MOUSE_IF_UNKNOWN; rodent.hw.model = MOUSE_MODEL_GENERIC; ioctl(rodent.mfd, MOUSE_GETHWINFO, &rodent.hw); if (rodent.rtype != MOUSE_PROTO_UNKNOWN) bcopy(proto[rodent.rtype], cur_proto, sizeof(cur_proto)); rodent.mode.protocol = MOUSE_PROTO_UNKNOWN; rodent.mode.rate = -1; rodent.mode.resolution = MOUSE_RES_UNKNOWN; rodent.mode.accelfactor = 0; rodent.mode.level = 0; if (ioctl(rodent.mfd, MOUSE_GETMODE, &rodent.mode) == 0) { if (rodent.mode.protocol == MOUSE_PROTO_UNKNOWN || rodent.mode.protocol >= (int)(sizeof(proto) / sizeof(proto[0]))) { logwarnx("unknown mouse protocol (%d)", rodent.mode.protocol); return (MOUSE_PROTO_UNKNOWN); } else { /* INPORT and BUS are the same... */ if (rodent.mode.protocol == MOUSE_PROTO_INPORT) rodent.mode.protocol = MOUSE_PROTO_BUS; if (rodent.mode.protocol != rodent.rtype) { /* Hmm, the driver doesn't agree with the user... */ if (rodent.rtype != MOUSE_PROTO_UNKNOWN) logwarnx("mouse type mismatch (%s != %s), %s is assumed", r_name(rodent.mode.protocol), r_name(rodent.rtype), r_name(rodent.mode.protocol)); rodent.rtype = rodent.mode.protocol; bcopy(proto[rodent.rtype], cur_proto, sizeof(cur_proto)); } } cur_proto[4] = rodent.mode.packetsize; cur_proto[0] = rodent.mode.syncmask[0]; /* header byte bit mask */ cur_proto[1] = rodent.mode.syncmask[1]; /* header bit pattern */ } /* maybe this is a PnP mouse... */ if (rodent.mode.protocol == MOUSE_PROTO_UNKNOWN) { if (rodent.flags & NoPnP) return (rodent.rtype); if (((len = pnpgets(pnpbuf)) <= 0) || !pnpparse(&pnpid, pnpbuf, len)) return (rodent.rtype); debug("PnP serial mouse: '%*.*s' '%*.*s' '%*.*s'", pnpid.neisaid, pnpid.neisaid, pnpid.eisaid, pnpid.ncompat, pnpid.ncompat, pnpid.compat, pnpid.ndescription, pnpid.ndescription, pnpid.description); /* we have a valid PnP serial device ID */ rodent.hw.iftype = MOUSE_IF_SERIAL; t = pnpproto(&pnpid); if (t != NULL) { rodent.mode.protocol = t->val; rodent.hw.model = t->val2; } else { rodent.mode.protocol = MOUSE_PROTO_UNKNOWN; } if (rodent.mode.protocol == MOUSE_PROTO_INPORT) rodent.mode.protocol = MOUSE_PROTO_BUS; /* make final adjustment */ if (rodent.mode.protocol != MOUSE_PROTO_UNKNOWN) { if (rodent.mode.protocol != rodent.rtype) { /* Hmm, the device doesn't agree with the user... */ if (rodent.rtype != MOUSE_PROTO_UNKNOWN) logwarnx("mouse type mismatch (%s != %s), %s is assumed", r_name(rodent.mode.protocol), r_name(rodent.rtype), r_name(rodent.mode.protocol)); rodent.rtype = rodent.mode.protocol; bcopy(proto[rodent.rtype], cur_proto, sizeof(cur_proto)); } } } debug("proto params: %02x %02x %02x %02x %d %02x %02x", cur_proto[0], cur_proto[1], cur_proto[2], cur_proto[3], cur_proto[4], cur_proto[5], cur_proto[6]); return (rodent.rtype); } static const char * r_if(int iftype) { return (gettokenname(rifs, iftype)); } static const char * r_name(int type) { const char *unknown = "unknown"; return (type == MOUSE_PROTO_UNKNOWN || type >= (int)(sizeof(rnames) / sizeof(rnames[0])) ? unknown : rnames[type]); } static const char * r_model(int model) { return (gettokenname(rmodels, model)); } static void r_init(void) { unsigned char buf[16]; /* scrach buffer */ fd_set fds; const char *s; char c; int i; /** ** This comment is a little out of context here, but it contains ** some useful information... ******************************************************************** ** ** The following lines take care of the Logitech MouseMan protocols. ** ** NOTE: There are different versions of both MouseMan and TrackMan! ** Hence I add another protocol P_LOGIMAN, which the user can ** specify as MouseMan in his XF86Config file. This entry was ** formerly handled as a special case of P_MS. However, people ** who don't have the middle button problem, can still specify ** Microsoft and use P_MS. ** ** By default, these mice should use a 3 byte Microsoft protocol ** plus a 4th byte for the middle button. However, the mouse might ** have switched to a different protocol before we use it, so I send ** the proper sequence just in case. ** ** NOTE: - all commands to (at least the European) MouseMan have to ** be sent at 1200 Baud. ** - each command starts with a '*'. ** - whenever the MouseMan receives a '*', it will switch back ** to 1200 Baud. Hence I have to select the desired protocol ** first, then select the baud rate. ** ** The protocols supported by the (European) MouseMan are: ** - 5 byte packed binary protocol, as with the Mouse Systems ** mouse. Selected by sequence "*U". ** - 2 button 3 byte MicroSoft compatible protocol. Selected ** by sequence "*V". ** - 3 button 3+1 byte MicroSoft compatible protocol (default). ** Selected by sequence "*X". ** ** The following baud rates are supported: ** - 1200 Baud (default). Selected by sequence "*n". ** - 9600 Baud. Selected by sequence "*q". ** ** Selecting a sample rate is no longer supported with the MouseMan! ** Some additional lines in xf86Config.c take care of ill configured ** baud rates and sample rates. (The user will get an error.) */ switch (rodent.rtype) { case MOUSE_PROTO_LOGI: /* * The baud rate selection command must be sent at the current * baud rate; try all likely settings */ setmousespeed(9600, rodent.baudrate, rodentcflags[rodent.rtype]); setmousespeed(4800, rodent.baudrate, rodentcflags[rodent.rtype]); setmousespeed(2400, rodent.baudrate, rodentcflags[rodent.rtype]); setmousespeed(1200, rodent.baudrate, rodentcflags[rodent.rtype]); /* select MM series data format */ write(rodent.mfd, "S", 1); setmousespeed(rodent.baudrate, rodent.baudrate, rodentcflags[MOUSE_PROTO_MM]); /* select report rate/frequency */ if (rodent.rate <= 0) write(rodent.mfd, "O", 1); else if (rodent.rate <= 15) write(rodent.mfd, "J", 1); else if (rodent.rate <= 27) write(rodent.mfd, "K", 1); else if (rodent.rate <= 42) write(rodent.mfd, "L", 1); else if (rodent.rate <= 60) write(rodent.mfd, "R", 1); else if (rodent.rate <= 85) write(rodent.mfd, "M", 1); else if (rodent.rate <= 125) write(rodent.mfd, "Q", 1); else write(rodent.mfd, "N", 1); break; case MOUSE_PROTO_LOGIMOUSEMAN: /* The command must always be sent at 1200 baud */ setmousespeed(1200, 1200, rodentcflags[rodent.rtype]); write(rodent.mfd, "*X", 2); setmousespeed(1200, rodent.baudrate, rodentcflags[rodent.rtype]); break; case MOUSE_PROTO_HITTAB: setmousespeed(1200, rodent.baudrate, rodentcflags[rodent.rtype]); /* * Initialize Hitachi PUMA Plus - Model 1212E to desired settings. * The tablet must be configured to be in MM mode, NO parity, * Binary Format. xf86Info.sampleRate controls the sensativity * of the tablet. We only use this tablet for it's 4-button puck * so we don't run in "Absolute Mode" */ write(rodent.mfd, "z8", 2); /* Set Parity = "NONE" */ usleep(50000); write(rodent.mfd, "zb", 2); /* Set Format = "Binary" */ usleep(50000); write(rodent.mfd, "@", 1); /* Set Report Mode = "Stream" */ usleep(50000); write(rodent.mfd, "R", 1); /* Set Output Rate = "45 rps" */ usleep(50000); write(rodent.mfd, "I\x20", 2); /* Set Incrememtal Mode "20" */ usleep(50000); write(rodent.mfd, "E", 1); /* Set Data Type = "Relative */ usleep(50000); /* Resolution is in 'lines per inch' on the Hitachi tablet */ if (rodent.resolution == MOUSE_RES_LOW) c = 'g'; else if (rodent.resolution == MOUSE_RES_MEDIUMLOW) c = 'e'; else if (rodent.resolution == MOUSE_RES_MEDIUMHIGH) c = 'h'; else if (rodent.resolution == MOUSE_RES_HIGH) c = 'd'; else if (rodent.resolution <= 40) c = 'g'; else if (rodent.resolution <= 100) c = 'd'; else if (rodent.resolution <= 200) c = 'e'; else if (rodent.resolution <= 500) c = 'h'; else if (rodent.resolution <= 1000) c = 'j'; else c = 'd'; write(rodent.mfd, &c, 1); usleep(50000); write(rodent.mfd, "\021", 1); /* Resume DATA output */ break; case MOUSE_PROTO_THINK: setmousespeed(1200, rodent.baudrate, rodentcflags[rodent.rtype]); /* the PnP ID string may be sent again, discard it */ usleep(200000); i = FREAD; ioctl(rodent.mfd, TIOCFLUSH, &i); /* send the command to initialize the beast */ for (s = "E5E5"; *s; ++s) { write(rodent.mfd, s, 1); FD_ZERO(&fds); FD_SET(rodent.mfd, &fds); if (select(FD_SETSIZE, &fds, NULL, NULL, NULL) <= 0) break; read(rodent.mfd, &c, 1); debug("%c", c); if (c != *s) break; } break; case MOUSE_PROTO_JOGDIAL: break; case MOUSE_PROTO_MSC: setmousespeed(1200, rodent.baudrate, rodentcflags[rodent.rtype]); if (rodent.flags & ClearDTR) { i = TIOCM_DTR; ioctl(rodent.mfd, TIOCMBIC, &i); } if (rodent.flags & ClearRTS) { i = TIOCM_RTS; ioctl(rodent.mfd, TIOCMBIC, &i); } break; case MOUSE_PROTO_SYSMOUSE: if (rodent.hw.iftype == MOUSE_IF_SYSMOUSE) setmousespeed(1200, rodent.baudrate, rodentcflags[rodent.rtype]); /* FALLTHROUGH */ case MOUSE_PROTO_BUS: case MOUSE_PROTO_INPORT: case MOUSE_PROTO_PS2: if (rodent.rate >= 0) rodent.mode.rate = rodent.rate; if (rodent.resolution != MOUSE_RES_UNKNOWN) rodent.mode.resolution = rodent.resolution; ioctl(rodent.mfd, MOUSE_SETMODE, &rodent.mode); break; case MOUSE_PROTO_X10MOUSEREM: mremote_serversetup(); setmousespeed(1200, rodent.baudrate, rodentcflags[rodent.rtype]); break; case MOUSE_PROTO_VERSAPAD: tcsendbreak(rodent.mfd, 0); /* send break for 400 msec */ i = FREAD; ioctl(rodent.mfd, TIOCFLUSH, &i); for (i = 0; i < 7; ++i) { FD_ZERO(&fds); FD_SET(rodent.mfd, &fds); if (select(FD_SETSIZE, &fds, NULL, NULL, NULL) <= 0) break; read(rodent.mfd, &c, 1); buf[i] = c; } debug("%s\n", buf); if ((buf[0] != 'V') || (buf[1] != 'P')|| (buf[7] != '\r')) break; setmousespeed(9600, rodent.baudrate, rodentcflags[rodent.rtype]); tcsendbreak(rodent.mfd, 0); /* send break for 400 msec again */ for (i = 0; i < 7; ++i) { FD_ZERO(&fds); FD_SET(rodent.mfd, &fds); if (select(FD_SETSIZE, &fds, NULL, NULL, NULL) <= 0) break; read(rodent.mfd, &c, 1); debug("%c", c); if (c != buf[i]) break; } i = FREAD; ioctl(rodent.mfd, TIOCFLUSH, &i); break; default: setmousespeed(1200, rodent.baudrate, rodentcflags[rodent.rtype]); break; } } static int r_protocol(u_char rBuf, mousestatus_t *act) { /* MOUSE_MSS_BUTTON?DOWN -> MOUSE_BUTTON?DOWN */ static int butmapmss[4] = { /* Microsoft, MouseMan, GlidePoint, IntelliMouse, Thinking Mouse */ 0, MOUSE_BUTTON3DOWN, MOUSE_BUTTON1DOWN, MOUSE_BUTTON1DOWN | MOUSE_BUTTON3DOWN, }; static int butmapmss2[4] = { /* Microsoft, MouseMan, GlidePoint, Thinking Mouse */ 0, MOUSE_BUTTON4DOWN, MOUSE_BUTTON2DOWN, MOUSE_BUTTON2DOWN | MOUSE_BUTTON4DOWN, }; /* MOUSE_INTELLI_BUTTON?DOWN -> MOUSE_BUTTON?DOWN */ static int butmapintelli[4] = { /* IntelliMouse, NetMouse, Mie Mouse, MouseMan+ */ 0, MOUSE_BUTTON2DOWN, MOUSE_BUTTON4DOWN, MOUSE_BUTTON2DOWN | MOUSE_BUTTON4DOWN, }; /* MOUSE_MSC_BUTTON?UP -> MOUSE_BUTTON?DOWN */ static int butmapmsc[8] = { /* MouseSystems, MMSeries, Logitech, Bus, sysmouse */ 0, MOUSE_BUTTON3DOWN, MOUSE_BUTTON2DOWN, MOUSE_BUTTON2DOWN | MOUSE_BUTTON3DOWN, MOUSE_BUTTON1DOWN, MOUSE_BUTTON1DOWN | MOUSE_BUTTON3DOWN, MOUSE_BUTTON1DOWN | MOUSE_BUTTON2DOWN, MOUSE_BUTTON1DOWN | MOUSE_BUTTON2DOWN | MOUSE_BUTTON3DOWN }; /* MOUSE_PS2_BUTTON?DOWN -> MOUSE_BUTTON?DOWN */ static int butmapps2[8] = { /* PS/2 */ 0, MOUSE_BUTTON1DOWN, MOUSE_BUTTON3DOWN, MOUSE_BUTTON1DOWN | MOUSE_BUTTON3DOWN, MOUSE_BUTTON2DOWN, MOUSE_BUTTON1DOWN | MOUSE_BUTTON2DOWN, MOUSE_BUTTON2DOWN | MOUSE_BUTTON3DOWN, MOUSE_BUTTON1DOWN | MOUSE_BUTTON2DOWN | MOUSE_BUTTON3DOWN }; /* for Hitachi tablet */ static int butmaphit[8] = { /* MM HitTablet */ 0, MOUSE_BUTTON3DOWN, MOUSE_BUTTON2DOWN, MOUSE_BUTTON1DOWN, MOUSE_BUTTON4DOWN, MOUSE_BUTTON5DOWN, MOUSE_BUTTON6DOWN, MOUSE_BUTTON7DOWN, }; /* for serial VersaPad */ static int butmapversa[8] = { /* VersaPad */ 0, 0, MOUSE_BUTTON3DOWN, MOUSE_BUTTON3DOWN, MOUSE_BUTTON1DOWN, MOUSE_BUTTON1DOWN, MOUSE_BUTTON1DOWN | MOUSE_BUTTON3DOWN, MOUSE_BUTTON1DOWN | MOUSE_BUTTON3DOWN, }; /* for PS/2 VersaPad */ static int butmapversaps2[8] = { /* VersaPad */ 0, MOUSE_BUTTON3DOWN, 0, MOUSE_BUTTON3DOWN, MOUSE_BUTTON1DOWN, MOUSE_BUTTON1DOWN | MOUSE_BUTTON3DOWN, MOUSE_BUTTON1DOWN, MOUSE_BUTTON1DOWN | MOUSE_BUTTON3DOWN, }; static int pBufP = 0; static unsigned char pBuf[8]; static int prev_x, prev_y; static int on = FALSE; int x, y; debug("received char 0x%x",(int)rBuf); if (rodent.rtype == MOUSE_PROTO_KIDSPAD) return (kidspad(rBuf, act)); if (rodent.rtype == MOUSE_PROTO_GTCO_DIGIPAD) return (gtco_digipad(rBuf, act)); /* * Hack for resyncing: We check here for a package that is: * a) illegal (detected by wrong data-package header) * b) invalid (0x80 == -128 and that might be wrong for MouseSystems) * c) bad header-package * * NOTE: b) is a voilation of the MouseSystems-Protocol, since values of * -128 are allowed, but since they are very seldom we can easily * use them as package-header with no button pressed. * NOTE/2: On a PS/2 mouse any byte is valid as a data byte. Furthermore, * 0x80 is not valid as a header byte. For a PS/2 mouse we skip * checking data bytes. * For resyncing a PS/2 mouse we require the two most significant * bits in the header byte to be 0. These are the overflow bits, * and in case of an overflow we actually lose sync. Overflows * are very rare, however, and we quickly gain sync again after * an overflow condition. This is the best we can do. (Actually, * we could use bit 0x08 in the header byte for resyncing, since * that bit is supposed to be always on, but nobody told * Microsoft...) */ if (pBufP != 0 && rodent.rtype != MOUSE_PROTO_PS2 && ((rBuf & cur_proto[2]) != cur_proto[3] || rBuf == 0x80)) { pBufP = 0; /* skip package */ } if (pBufP == 0 && (rBuf & cur_proto[0]) != cur_proto[1]) return (0); /* is there an extra data byte? */ if (pBufP >= cur_proto[4] && (rBuf & cur_proto[0]) != cur_proto[1]) { /* * Hack for Logitech MouseMan Mouse - Middle button * * Unfortunately this mouse has variable length packets: the standard * Microsoft 3 byte packet plus an optional 4th byte whenever the * middle button status changes. * * We have already processed the standard packet with the movement * and button info. Now post an event message with the old status * of the left and right buttons and the updated middle button. */ /* * Even worse, different MouseMen and TrackMen differ in the 4th * byte: some will send 0x00/0x20, others 0x01/0x21, or even * 0x02/0x22, so I have to strip off the lower bits. * * [JCH-96/01/21] * HACK for ALPS "fourth button". (It's bit 0x10 of the "fourth byte" * and it is activated by tapping the glidepad with the finger! 8^) * We map it to bit bit3, and the reverse map in xf86Events just has * to be extended so that it is identified as Button 4. The lower * half of the reverse-map may remain unchanged. */ /* * [KY-97/08/03] * Receive the fourth byte only when preceding three bytes have * been detected (pBufP >= cur_proto[4]). In the previous * versions, the test was pBufP == 0; thus, we may have mistakingly * received a byte even if we didn't see anything preceding * the byte. */ if ((rBuf & cur_proto[5]) != cur_proto[6]) { pBufP = 0; return (0); } switch (rodent.rtype) { #if notyet case MOUSE_PROTO_MARIQUA: /* * This mouse has 16! buttons in addition to the standard * three of them. They return 0x10 though 0x1f in the * so-called `ten key' mode and 0x30 though 0x3f in the * `function key' mode. As there are only 31 bits for * button state (including the standard three), we ignore * the bit 0x20 and don't distinguish the two modes. */ act->dx = act->dy = act->dz = 0; act->obutton = act->button; rBuf &= 0x1f; act->button = (1 << (rBuf - 13)) | (act->obutton & (MOUSE_BUTTON1DOWN | MOUSE_BUTTON3DOWN)); /* * FIXME: this is a button "down" event. There needs to be * a corresponding button "up" event... XXX */ break; #endif /* notyet */ case MOUSE_PROTO_JOGDIAL: break; /* * IntelliMouse, NetMouse (including NetMouse Pro) and Mie Mouse * always send the fourth byte, whereas the fourth byte is * optional for GlidePoint and ThinkingMouse. The fourth byte * is also optional for MouseMan+ and FirstMouse+ in their * native mode. It is always sent if they are in the IntelliMouse * compatible mode. */ case MOUSE_PROTO_INTELLI: /* IntelliMouse, NetMouse, Mie Mouse, MouseMan+ */ act->dx = act->dy = 0; act->dz = (rBuf & 0x08) ? (rBuf & 0x0f) - 16 : (rBuf & 0x0f); if ((act->dz >= 7) || (act->dz <= -7)) act->dz = 0; act->obutton = act->button; act->button = butmapintelli[(rBuf & MOUSE_MSS_BUTTONS) >> 4] | (act->obutton & (MOUSE_BUTTON1DOWN | MOUSE_BUTTON3DOWN)); break; default: act->dx = act->dy = act->dz = 0; act->obutton = act->button; act->button = butmapmss2[(rBuf & MOUSE_MSS_BUTTONS) >> 4] | (act->obutton & (MOUSE_BUTTON1DOWN | MOUSE_BUTTON3DOWN)); break; } act->flags = ((act->dx || act->dy || act->dz) ? MOUSE_POSCHANGED : 0) | (act->obutton ^ act->button); pBufP = 0; return (act->flags); } if (pBufP >= cur_proto[4]) pBufP = 0; pBuf[pBufP++] = rBuf; if (pBufP != cur_proto[4]) return (0); /* * assembly full package */ debug("assembled full packet (len %d) %x,%x,%x,%x,%x,%x,%x,%x", cur_proto[4], pBuf[0], pBuf[1], pBuf[2], pBuf[3], pBuf[4], pBuf[5], pBuf[6], pBuf[7]); act->dz = 0; act->obutton = act->button; switch (rodent.rtype) { case MOUSE_PROTO_MS: /* Microsoft */ case MOUSE_PROTO_LOGIMOUSEMAN: /* MouseMan/TrackMan */ case MOUSE_PROTO_X10MOUSEREM: /* X10 MouseRemote */ act->button = act->obutton & MOUSE_BUTTON4DOWN; if (rodent.flags & ChordMiddle) act->button |= ((pBuf[0] & MOUSE_MSS_BUTTONS) == MOUSE_MSS_BUTTONS) ? MOUSE_BUTTON2DOWN : butmapmss[(pBuf[0] & MOUSE_MSS_BUTTONS) >> 4]; else act->button |= (act->obutton & MOUSE_BUTTON2DOWN) | butmapmss[(pBuf[0] & MOUSE_MSS_BUTTONS) >> 4]; /* Send X10 btn events to remote client (ensure -128-+127 range) */ if ((rodent.rtype == MOUSE_PROTO_X10MOUSEREM) && ((pBuf[0] & 0xFC) == 0x44) && (pBuf[2] == 0x3F)) { if (rodent.mremcfd >= 0) { unsigned char key = (signed char)(((pBuf[0] & 0x03) << 6) | (pBuf[1] & 0x3F)); write(rodent.mremcfd, &key, 1); } return (0); } act->dx = (signed char)(((pBuf[0] & 0x03) << 6) | (pBuf[1] & 0x3F)); act->dy = (signed char)(((pBuf[0] & 0x0C) << 4) | (pBuf[2] & 0x3F)); break; case MOUSE_PROTO_GLIDEPOINT: /* GlidePoint */ case MOUSE_PROTO_THINK: /* ThinkingMouse */ case MOUSE_PROTO_INTELLI: /* IntelliMouse, NetMouse, Mie Mouse, MouseMan+ */ act->button = (act->obutton & (MOUSE_BUTTON2DOWN | MOUSE_BUTTON4DOWN)) | butmapmss[(pBuf[0] & MOUSE_MSS_BUTTONS) >> 4]; act->dx = (signed char)(((pBuf[0] & 0x03) << 6) | (pBuf[1] & 0x3F)); act->dy = (signed char)(((pBuf[0] & 0x0C) << 4) | (pBuf[2] & 0x3F)); break; case MOUSE_PROTO_MSC: /* MouseSystems Corp */ #if notyet case MOUSE_PROTO_MARIQUA: /* Mariqua */ #endif act->button = butmapmsc[(~pBuf[0]) & MOUSE_MSC_BUTTONS]; act->dx = (signed char)(pBuf[1]) + (signed char)(pBuf[3]); act->dy = - ((signed char)(pBuf[2]) + (signed char)(pBuf[4])); break; case MOUSE_PROTO_JOGDIAL: /* JogDial */ if (rBuf == 0x6c) act->dz = -1; if (rBuf == 0x72) act->dz = 1; if (rBuf == 0x64) act->button = MOUSE_BUTTON1DOWN; if (rBuf == 0x75) act->button = 0; break; case MOUSE_PROTO_HITTAB: /* MM HitTablet */ act->button = butmaphit[pBuf[0] & 0x07]; act->dx = (pBuf[0] & MOUSE_MM_XPOSITIVE) ? pBuf[1] : - pBuf[1]; act->dy = (pBuf[0] & MOUSE_MM_YPOSITIVE) ? - pBuf[2] : pBuf[2]; break; case MOUSE_PROTO_MM: /* MM Series */ case MOUSE_PROTO_LOGI: /* Logitech Mice */ act->button = butmapmsc[pBuf[0] & MOUSE_MSC_BUTTONS]; act->dx = (pBuf[0] & MOUSE_MM_XPOSITIVE) ? pBuf[1] : - pBuf[1]; act->dy = (pBuf[0] & MOUSE_MM_YPOSITIVE) ? - pBuf[2] : pBuf[2]; break; case MOUSE_PROTO_VERSAPAD: /* VersaPad */ act->button = butmapversa[(pBuf[0] & MOUSE_VERSA_BUTTONS) >> 3]; act->button |= (pBuf[0] & MOUSE_VERSA_TAP) ? MOUSE_BUTTON4DOWN : 0; act->dx = act->dy = 0; if (!(pBuf[0] & MOUSE_VERSA_IN_USE)) { on = FALSE; break; } x = (pBuf[2] << 6) | pBuf[1]; if (x & 0x800) x -= 0x1000; y = (pBuf[4] << 6) | pBuf[3]; if (y & 0x800) y -= 0x1000; if (on) { act->dx = prev_x - x; act->dy = prev_y - y; } else { on = TRUE; } prev_x = x; prev_y = y; break; case MOUSE_PROTO_BUS: /* Bus */ case MOUSE_PROTO_INPORT: /* InPort */ act->button = butmapmsc[(~pBuf[0]) & MOUSE_MSC_BUTTONS]; act->dx = (signed char)pBuf[1]; act->dy = - (signed char)pBuf[2]; break; case MOUSE_PROTO_PS2: /* PS/2 */ act->button = butmapps2[pBuf[0] & MOUSE_PS2_BUTTONS]; act->dx = (pBuf[0] & MOUSE_PS2_XNEG) ? pBuf[1] - 256 : pBuf[1]; act->dy = (pBuf[0] & MOUSE_PS2_YNEG) ? -(pBuf[2] - 256) : -pBuf[2]; /* * Moused usually operates the psm driver at the operation level 1 * which sends mouse data in MOUSE_PROTO_SYSMOUSE protocol. * The following code takes effect only when the user explicitly * requets the level 2 at which wheel movement and additional button * actions are encoded in model-dependent formats. At the level 0 * the following code is no-op because the psm driver says the model * is MOUSE_MODEL_GENERIC. */ switch (rodent.hw.model) { case MOUSE_MODEL_EXPLORER: /* wheel and additional button data is in the fourth byte */ act->dz = (pBuf[3] & MOUSE_EXPLORER_ZNEG) ? (pBuf[3] & 0x0f) - 16 : (pBuf[3] & 0x0f); act->button |= (pBuf[3] & MOUSE_EXPLORER_BUTTON4DOWN) ? MOUSE_BUTTON4DOWN : 0; act->button |= (pBuf[3] & MOUSE_EXPLORER_BUTTON5DOWN) ? MOUSE_BUTTON5DOWN : 0; break; case MOUSE_MODEL_INTELLI: case MOUSE_MODEL_NET: /* wheel data is in the fourth byte */ act->dz = (signed char)pBuf[3]; if ((act->dz >= 7) || (act->dz <= -7)) act->dz = 0; /* some compatible mice may have additional buttons */ act->button |= (pBuf[0] & MOUSE_PS2INTELLI_BUTTON4DOWN) ? MOUSE_BUTTON4DOWN : 0; act->button |= (pBuf[0] & MOUSE_PS2INTELLI_BUTTON5DOWN) ? MOUSE_BUTTON5DOWN : 0; break; case MOUSE_MODEL_MOUSEMANPLUS: if (((pBuf[0] & MOUSE_PS2PLUS_SYNCMASK) == MOUSE_PS2PLUS_SYNC) && (abs(act->dx) > 191) && MOUSE_PS2PLUS_CHECKBITS(pBuf)) { /* the extended data packet encodes button and wheel events */ switch (MOUSE_PS2PLUS_PACKET_TYPE(pBuf)) { case 1: /* wheel data packet */ act->dx = act->dy = 0; if (pBuf[2] & 0x80) { /* horizontal roller count - ignore it XXX*/ } else { /* vertical roller count */ act->dz = (pBuf[2] & MOUSE_PS2PLUS_ZNEG) ? (pBuf[2] & 0x0f) - 16 : (pBuf[2] & 0x0f); } act->button |= (pBuf[2] & MOUSE_PS2PLUS_BUTTON4DOWN) ? MOUSE_BUTTON4DOWN : 0; act->button |= (pBuf[2] & MOUSE_PS2PLUS_BUTTON5DOWN) ? MOUSE_BUTTON5DOWN : 0; break; case 2: /* this packet type is reserved by Logitech */ /* * IBM ScrollPoint Mouse uses this packet type to * encode both vertical and horizontal scroll movement. */ act->dx = act->dy = 0; /* horizontal roller count */ if (pBuf[2] & 0x0f) act->dz = (pBuf[2] & MOUSE_SPOINT_WNEG) ? -2 : 2; /* vertical roller count */ if (pBuf[2] & 0xf0) act->dz = (pBuf[2] & MOUSE_SPOINT_ZNEG) ? -1 : 1; #if 0 /* vertical roller count */ act->dz = (pBuf[2] & MOUSE_SPOINT_ZNEG) ? ((pBuf[2] >> 4) & 0x0f) - 16 : ((pBuf[2] >> 4) & 0x0f); /* horizontal roller count */ act->dw = (pBuf[2] & MOUSE_SPOINT_WNEG) ? (pBuf[2] & 0x0f) - 16 : (pBuf[2] & 0x0f); #endif break; case 0: /* device type packet - shouldn't happen */ /* FALLTHROUGH */ default: act->dx = act->dy = 0; act->button = act->obutton; debug("unknown PS2++ packet type %d: 0x%02x 0x%02x 0x%02x\n", MOUSE_PS2PLUS_PACKET_TYPE(pBuf), pBuf[0], pBuf[1], pBuf[2]); break; } } else { /* preserve button states */ act->button |= act->obutton & MOUSE_EXTBUTTONS; } break; case MOUSE_MODEL_GLIDEPOINT: /* `tapping' action */ act->button |= ((pBuf[0] & MOUSE_PS2_TAP)) ? 0 : MOUSE_BUTTON4DOWN; break; case MOUSE_MODEL_NETSCROLL: /* three addtional bytes encode buttons and wheel events */ act->button |= (pBuf[3] & MOUSE_PS2_BUTTON3DOWN) ? MOUSE_BUTTON4DOWN : 0; act->button |= (pBuf[3] & MOUSE_PS2_BUTTON1DOWN) ? MOUSE_BUTTON5DOWN : 0; act->dz = (pBuf[3] & MOUSE_PS2_XNEG) ? pBuf[4] - 256 : pBuf[4]; break; case MOUSE_MODEL_THINK: /* the fourth button state in the first byte */ act->button |= (pBuf[0] & MOUSE_PS2_TAP) ? MOUSE_BUTTON4DOWN : 0; break; case MOUSE_MODEL_VERSAPAD: act->button = butmapversaps2[pBuf[0] & MOUSE_PS2VERSA_BUTTONS]; act->button |= (pBuf[0] & MOUSE_PS2VERSA_TAP) ? MOUSE_BUTTON4DOWN : 0; act->dx = act->dy = 0; if (!(pBuf[0] & MOUSE_PS2VERSA_IN_USE)) { on = FALSE; break; } x = ((pBuf[4] << 8) & 0xf00) | pBuf[1]; if (x & 0x800) x -= 0x1000; y = ((pBuf[4] << 4) & 0xf00) | pBuf[2]; if (y & 0x800) y -= 0x1000; if (on) { act->dx = prev_x - x; act->dy = prev_y - y; } else { on = TRUE; } prev_x = x; prev_y = y; break; case MOUSE_MODEL_4D: act->dx = (pBuf[1] & 0x80) ? pBuf[1] - 256 : pBuf[1]; act->dy = (pBuf[2] & 0x80) ? -(pBuf[2] - 256) : -pBuf[2]; switch (pBuf[0] & MOUSE_4D_WHEELBITS) { case 0x10: act->dz = 1; break; case 0x30: act->dz = -1; break; case 0x40: /* 2nd wheel rolling right XXX */ act->dz = 2; break; case 0xc0: /* 2nd wheel rolling left XXX */ act->dz = -2; break; } break; case MOUSE_MODEL_4DPLUS: if ((act->dx < 16 - 256) && (act->dy > 256 - 16)) { act->dx = act->dy = 0; if (pBuf[2] & MOUSE_4DPLUS_BUTTON4DOWN) act->button |= MOUSE_BUTTON4DOWN; act->dz = (pBuf[2] & MOUSE_4DPLUS_ZNEG) ? ((pBuf[2] & 0x07) - 8) : (pBuf[2] & 0x07); } else { /* preserve previous button states */ act->button |= act->obutton & MOUSE_EXTBUTTONS; } break; case MOUSE_MODEL_GENERIC: default: break; } break; case MOUSE_PROTO_SYSMOUSE: /* sysmouse */ act->button = butmapmsc[(~pBuf[0]) & MOUSE_SYS_STDBUTTONS]; act->dx = (signed char)(pBuf[1]) + (signed char)(pBuf[3]); act->dy = - ((signed char)(pBuf[2]) + (signed char)(pBuf[4])); if (rodent.level == 1) { act->dz = ((signed char)(pBuf[5] << 1) + (signed char)(pBuf[6] << 1)) >> 1; act->button |= ((~pBuf[7] & MOUSE_SYS_EXTBUTTONS) << 3); } break; default: return (0); } /* * We don't reset pBufP here yet, as there may be an additional data * byte in some protocols. See above. */ /* has something changed? */ act->flags = ((act->dx || act->dy || act->dz) ? MOUSE_POSCHANGED : 0) | (act->obutton ^ act->button); return (act->flags); } static int r_statetrans(mousestatus_t *a1, mousestatus_t *a2, int trans) { int changed; int flags; a2->dx = a1->dx; a2->dy = a1->dy; a2->dz = a1->dz; a2->obutton = a2->button; a2->button = a1->button; a2->flags = a1->flags; changed = FALSE; if (rodent.flags & Emulate3Button) { if (debug > 2) debug("state:%d, trans:%d -> state:%d", mouse_button_state, trans, states[mouse_button_state].s[trans]); /* * Avoid re-ordering button and movement events. While a button * event is deferred, throw away up to BUTTON2_MAXMOVE movement * events to allow for mouse jitter. If more movement events * occur, then complete the deferred button events immediately. */ if ((a2->dx != 0 || a2->dy != 0) && S_DELAYED(states[mouse_button_state].s[trans])) { if (++mouse_move_delayed > BUTTON2_MAXMOVE) { mouse_move_delayed = 0; mouse_button_state = states[mouse_button_state].s[A_TIMEOUT]; changed = TRUE; } else a2->dx = a2->dy = 0; } else mouse_move_delayed = 0; if (mouse_button_state != states[mouse_button_state].s[trans]) changed = TRUE; if (changed) clock_gettime(CLOCK_MONOTONIC_FAST, &mouse_button_state_ts); mouse_button_state = states[mouse_button_state].s[trans]; a2->button &= ~(MOUSE_BUTTON1DOWN | MOUSE_BUTTON2DOWN | MOUSE_BUTTON3DOWN); a2->button &= states[mouse_button_state].mask; a2->button |= states[mouse_button_state].buttons; flags = a2->flags & MOUSE_POSCHANGED; flags |= a2->obutton ^ a2->button; if (flags & MOUSE_BUTTON2DOWN) { a2->flags = flags & MOUSE_BUTTON2DOWN; r_timestamp(a2); } a2->flags = flags; } return (changed); } /* phisical to logical button mapping */ static int p2l[MOUSE_MAXBUTTON] = { MOUSE_BUTTON1DOWN, MOUSE_BUTTON2DOWN, MOUSE_BUTTON3DOWN, MOUSE_BUTTON4DOWN, MOUSE_BUTTON5DOWN, MOUSE_BUTTON6DOWN, MOUSE_BUTTON7DOWN, MOUSE_BUTTON8DOWN, 0x00000100, 0x00000200, 0x00000400, 0x00000800, 0x00001000, 0x00002000, 0x00004000, 0x00008000, 0x00010000, 0x00020000, 0x00040000, 0x00080000, 0x00100000, 0x00200000, 0x00400000, 0x00800000, 0x01000000, 0x02000000, 0x04000000, 0x08000000, 0x10000000, 0x20000000, 0x40000000, }; static char * skipspace(char *s) { while(isspace(*s)) ++s; return (s); } static int r_installmap(char *arg) { int pbutton; int lbutton; char *s; while (*arg) { arg = skipspace(arg); s = arg; while (isdigit(*arg)) ++arg; arg = skipspace(arg); if ((arg <= s) || (*arg != '=')) return (FALSE); lbutton = atoi(s); arg = skipspace(++arg); s = arg; while (isdigit(*arg)) ++arg; if ((arg <= s) || (!isspace(*arg) && (*arg != '\0'))) return (FALSE); pbutton = atoi(s); if ((lbutton <= 0) || (lbutton > MOUSE_MAXBUTTON)) return (FALSE); if ((pbutton <= 0) || (pbutton > MOUSE_MAXBUTTON)) return (FALSE); p2l[pbutton - 1] = 1 << (lbutton - 1); mstate[lbutton - 1] = &bstate[pbutton - 1]; } return (TRUE); } static void r_map(mousestatus_t *act1, mousestatus_t *act2) { register int pb; register int pbuttons; int lbuttons; pbuttons = act1->button; lbuttons = 0; act2->obutton = act2->button; if (pbuttons & rodent.wmode) { pbuttons &= ~rodent.wmode; act1->dz = act1->dy; act1->dx = 0; act1->dy = 0; } act2->dx = act1->dx; act2->dy = act1->dy; act2->dz = act1->dz; switch (rodent.zmap[0]) { case 0: /* do nothing */ break; case MOUSE_XAXIS: if (act1->dz != 0) { act2->dx = act1->dz; act2->dz = 0; } break; case MOUSE_YAXIS: if (act1->dz != 0) { act2->dy = act1->dz; act2->dz = 0; } break; default: /* buttons */ pbuttons &= ~(rodent.zmap[0] | rodent.zmap[1] | rodent.zmap[2] | rodent.zmap[3]); if ((act1->dz < -1) && rodent.zmap[2]) { pbuttons |= rodent.zmap[2]; zstate[2].count = 1; } else if (act1->dz < 0) { pbuttons |= rodent.zmap[0]; zstate[0].count = 1; } else if ((act1->dz > 1) && rodent.zmap[3]) { pbuttons |= rodent.zmap[3]; zstate[3].count = 1; } else if (act1->dz > 0) { pbuttons |= rodent.zmap[1]; zstate[1].count = 1; } act2->dz = 0; break; } for (pb = 0; (pb < MOUSE_MAXBUTTON) && (pbuttons != 0); ++pb) { lbuttons |= (pbuttons & 1) ? p2l[pb] : 0; pbuttons >>= 1; } act2->button = lbuttons; act2->flags = ((act2->dx || act2->dy || act2->dz) ? MOUSE_POSCHANGED : 0) | (act2->obutton ^ act2->button); } static void r_timestamp(mousestatus_t *act) { struct timespec ts; struct timespec ts1; struct timespec ts2; struct timespec ts3; int button; int mask; int i; mask = act->flags & MOUSE_BUTTONS; #if 0 if (mask == 0) return; #endif clock_gettime(CLOCK_MONOTONIC_FAST, &ts1); drift_current_ts = ts1; /* double click threshold */ ts2.tv_sec = rodent.clickthreshold / 1000; ts2.tv_nsec = (rodent.clickthreshold % 1000) * 1000000; tssub(&ts1, &ts2, &ts); debug("ts: %jd %ld", (intmax_t)ts.tv_sec, ts.tv_nsec); /* 3 button emulation timeout */ ts2.tv_sec = rodent.button2timeout / 1000; ts2.tv_nsec = (rodent.button2timeout % 1000) * 1000000; tssub(&ts1, &ts2, &ts3); button = MOUSE_BUTTON1DOWN; for (i = 0; (i < MOUSE_MAXBUTTON) && (mask != 0); ++i) { if (mask & 1) { if (act->button & button) { /* the button is down */ debug(" : %jd %ld", (intmax_t)bstate[i].ts.tv_sec, bstate[i].ts.tv_nsec); if (tscmp(&ts, &bstate[i].ts, >)) { bstate[i].count = 1; } else { ++bstate[i].count; } bstate[i].ts = ts1; } else { /* the button is up */ bstate[i].ts = ts1; } } else { if (act->button & button) { /* the button has been down */ if (tscmp(&ts3, &bstate[i].ts, >)) { bstate[i].count = 1; bstate[i].ts = ts1; act->flags |= button; debug("button %d timeout", i + 1); } } else { /* the button has been up */ } } button <<= 1; mask >>= 1; } } static int r_timeout(void) { struct timespec ts; struct timespec ts1; struct timespec ts2; if (states[mouse_button_state].timeout) return (TRUE); clock_gettime(CLOCK_MONOTONIC_FAST, &ts1); ts2.tv_sec = rodent.button2timeout / 1000; ts2.tv_nsec = (rodent.button2timeout % 1000) * 1000000; tssub(&ts1, &ts2, &ts); return (tscmp(&ts, &mouse_button_state_ts, >)); } static void r_click(mousestatus_t *act) { struct mouse_info mouse; int button; int mask; int i; mask = act->flags & MOUSE_BUTTONS; if (mask == 0) return; button = MOUSE_BUTTON1DOWN; for (i = 0; (i < MOUSE_MAXBUTTON) && (mask != 0); ++i) { if (mask & 1) { debug("mstate[%d]->count:%d", i, mstate[i]->count); if (act->button & button) { /* the button is down */ mouse.u.event.value = mstate[i]->count; } else { /* the button is up */ mouse.u.event.value = 0; } mouse.operation = MOUSE_BUTTON_EVENT; mouse.u.event.id = button; if (debug < 2) if (!paused) ioctl(rodent.cfd, CONS_MOUSECTL, &mouse); debug("button %d count %d", i + 1, mouse.u.event.value); } button <<= 1; mask >>= 1; } } /* $XConsortium: posix_tty.c,v 1.3 95/01/05 20:42:55 kaleb Exp $ */ /* $XFree86: xc/programs/Xserver/hw/xfree86/os-support/shared/posix_tty.c,v 3.4 1995/01/28 17:05:03 dawes Exp $ */ /* * Copyright 1993 by David Dawes <dawes@physics.su.oz.au> * * Permission to use, copy, modify, distribute, and sell this software and its * documentation for any purpose is hereby granted without fee, provided that * the above copyright notice appear in all copies and that both that * copyright notice and this permission notice appear in supporting * documentation, and that the name of David Dawes * not be used in advertising or publicity pertaining to distribution of * the software without specific, written prior permission. * David Dawes makes no representations about the suitability of this * software for any purpose. It is provided "as is" without express or * implied warranty. * * DAVID DAWES DISCLAIMS ALL WARRANTIES WITH REGARD TO * THIS SOFTWARE, INCLUDING ALL IMPLIED WARRANTIES OF MERCHANTABILITY AND * FITNESS, IN NO EVENT SHALL DAVID DAWES BE LIABLE FOR * ANY SPECIAL, INDIRECT OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES WHATSOEVER * RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN ACTION OF * CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF OR IN * CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE. * */ static void setmousespeed(int old, int new, unsigned cflag) { struct termios tty; const char *c; if (tcgetattr(rodent.mfd, &tty) < 0) { logwarn("unable to get status of mouse fd"); return; } tty.c_iflag = IGNBRK | IGNPAR; tty.c_oflag = 0; tty.c_lflag = 0; tty.c_cflag = (tcflag_t)cflag; tty.c_cc[VTIME] = 0; tty.c_cc[VMIN] = 1; switch (old) { case 9600: cfsetispeed(&tty, B9600); cfsetospeed(&tty, B9600); break; case 4800: cfsetispeed(&tty, B4800); cfsetospeed(&tty, B4800); break; case 2400: cfsetispeed(&tty, B2400); cfsetospeed(&tty, B2400); break; case 1200: default: cfsetispeed(&tty, B1200); cfsetospeed(&tty, B1200); } if (tcsetattr(rodent.mfd, TCSADRAIN, &tty) < 0) { logwarn("unable to set status of mouse fd"); return; } switch (new) { case 9600: c = "*q"; cfsetispeed(&tty, B9600); cfsetospeed(&tty, B9600); break; case 4800: c = "*p"; cfsetispeed(&tty, B4800); cfsetospeed(&tty, B4800); break; case 2400: c = "*o"; cfsetispeed(&tty, B2400); cfsetospeed(&tty, B2400); break; case 1200: default: c = "*n"; cfsetispeed(&tty, B1200); cfsetospeed(&tty, B1200); } if (rodent.rtype == MOUSE_PROTO_LOGIMOUSEMAN || rodent.rtype == MOUSE_PROTO_LOGI) { if (write(rodent.mfd, c, 2) != 2) { logwarn("unable to write to mouse fd"); return; } } usleep(100000); if (tcsetattr(rodent.mfd, TCSADRAIN, &tty) < 0) logwarn("unable to set status of mouse fd"); } /* * PnP COM device support * * It's a simplistic implementation, but it works :-) * KY, 31/7/97. */ /* * Try to elicit a PnP ID as described in * Microsoft, Hayes: "Plug and Play External COM Device Specification, * rev 1.00", 1995. * * The routine does not fully implement the COM Enumerator as par Section * 2.1 of the document. In particular, we don't have idle state in which * the driver software monitors the com port for dynamic connection or * removal of a device at the port, because `moused' simply quits if no * device is found. * * In addition, as PnP COM device enumeration procedure slightly has * changed since its first publication, devices which follow earlier * revisions of the above spec. may fail to respond if the rev 1.0 * procedure is used. XXX */ static int pnpwakeup1(void) { struct timeval timeout; fd_set fds; int i; /* * This is the procedure described in rev 1.0 of PnP COM device spec. * Unfortunately, some devices which comform to earlier revisions of * the spec gets confused and do not return the ID string... */ debug("PnP COM device rev 1.0 probe..."); /* port initialization (2.1.2) */ ioctl(rodent.mfd, TIOCMGET, &i); i |= TIOCM_DTR; /* DTR = 1 */ i &= ~TIOCM_RTS; /* RTS = 0 */ ioctl(rodent.mfd, TIOCMSET, &i); usleep(240000); /* * The PnP COM device spec. dictates that the mouse must set DSR * in response to DTR (by hardware or by software) and that if DSR is * not asserted, the host computer should think that there is no device * at this serial port. But some mice just don't do that... */ ioctl(rodent.mfd, TIOCMGET, &i); debug("modem status 0%o", i); if ((i & TIOCM_DSR) == 0) return (FALSE); /* port setup, 1st phase (2.1.3) */ setmousespeed(1200, 1200, (CS7 | CREAD | CLOCAL | HUPCL)); i = TIOCM_DTR | TIOCM_RTS; /* DTR = 0, RTS = 0 */ ioctl(rodent.mfd, TIOCMBIC, &i); usleep(240000); i = TIOCM_DTR; /* DTR = 1, RTS = 0 */ ioctl(rodent.mfd, TIOCMBIS, &i); usleep(240000); /* wait for response, 1st phase (2.1.4) */ i = FREAD; ioctl(rodent.mfd, TIOCFLUSH, &i); i = TIOCM_RTS; /* DTR = 1, RTS = 1 */ ioctl(rodent.mfd, TIOCMBIS, &i); /* try to read something */ FD_ZERO(&fds); FD_SET(rodent.mfd, &fds); timeout.tv_sec = 0; timeout.tv_usec = 240000; if (select(FD_SETSIZE, &fds, NULL, NULL, &timeout) > 0) { debug("pnpwakeup1(): valid response in first phase."); return (TRUE); } /* port setup, 2nd phase (2.1.5) */ i = TIOCM_DTR | TIOCM_RTS; /* DTR = 0, RTS = 0 */ ioctl(rodent.mfd, TIOCMBIC, &i); usleep(240000); /* wait for respose, 2nd phase (2.1.6) */ i = FREAD; ioctl(rodent.mfd, TIOCFLUSH, &i); i = TIOCM_DTR | TIOCM_RTS; /* DTR = 1, RTS = 1 */ ioctl(rodent.mfd, TIOCMBIS, &i); /* try to read something */ FD_ZERO(&fds); FD_SET(rodent.mfd, &fds); timeout.tv_sec = 0; timeout.tv_usec = 240000; if (select(FD_SETSIZE, &fds, NULL, NULL, &timeout) > 0) { debug("pnpwakeup1(): valid response in second phase."); return (TRUE); } return (FALSE); } static int pnpwakeup2(void) { struct timeval timeout; fd_set fds; int i; /* * This is a simplified procedure; it simply toggles RTS. */ debug("alternate probe..."); ioctl(rodent.mfd, TIOCMGET, &i); i |= TIOCM_DTR; /* DTR = 1 */ i &= ~TIOCM_RTS; /* RTS = 0 */ ioctl(rodent.mfd, TIOCMSET, &i); usleep(240000); setmousespeed(1200, 1200, (CS7 | CREAD | CLOCAL | HUPCL)); /* wait for respose */ i = FREAD; ioctl(rodent.mfd, TIOCFLUSH, &i); i = TIOCM_DTR | TIOCM_RTS; /* DTR = 1, RTS = 1 */ ioctl(rodent.mfd, TIOCMBIS, &i); /* try to read something */ FD_ZERO(&fds); FD_SET(rodent.mfd, &fds); timeout.tv_sec = 0; timeout.tv_usec = 240000; if (select(FD_SETSIZE, &fds, NULL, NULL, &timeout) > 0) { debug("pnpwakeup2(): valid response."); return (TRUE); } return (FALSE); } static int pnpgets(char *buf) { struct timeval timeout; fd_set fds; int begin; int i; char c; if (!pnpwakeup1() && !pnpwakeup2()) { /* * According to PnP spec, we should set DTR = 1 and RTS = 0 while * in idle state. But, `moused' shall set DTR = RTS = 1 and proceed, * assuming there is something at the port even if it didn't * respond to the PnP enumeration procedure. */ i = TIOCM_DTR | TIOCM_RTS; /* DTR = 1, RTS = 1 */ ioctl(rodent.mfd, TIOCMBIS, &i); return (0); } /* collect PnP COM device ID (2.1.7) */ begin = -1; i = 0; usleep(240000); /* the mouse must send `Begin ID' within 200msec */ while (read(rodent.mfd, &c, 1) == 1) { /* we may see "M", or "M3..." before `Begin ID' */ buf[i++] = c; if ((c == 0x08) || (c == 0x28)) { /* Begin ID */ debug("begin-id %02x", c); begin = i - 1; break; } debug("%c %02x", c, c); if (i >= 256) break; } if (begin < 0) { /* we haven't seen `Begin ID' in time... */ goto connect_idle; } ++c; /* make it `End ID' */ for (;;) { FD_ZERO(&fds); FD_SET(rodent.mfd, &fds); timeout.tv_sec = 0; timeout.tv_usec = 240000; if (select(FD_SETSIZE, &fds, NULL, NULL, &timeout) <= 0) break; read(rodent.mfd, &buf[i], 1); if (buf[i++] == c) /* End ID */ break; if (i >= 256) break; } if (begin > 0) { i -= begin; bcopy(&buf[begin], &buf[0], i); } /* string may not be human readable... */ debug("len:%d, '%-*.*s'", i, i, i, buf); if (buf[i - 1] == c) return (i); /* a valid PnP string */ /* * According to PnP spec, we should set DTR = 1 and RTS = 0 while * in idle state. But, `moused' shall leave the modem control lines * as they are. See above. */ connect_idle: /* we may still have something in the buffer */ return ((i > 0) ? i : 0); } static int pnpparse(pnpid_t *id, char *buf, int len) { char s[3]; int offset; int sum = 0; int i, j; id->revision = 0; id->eisaid = NULL; id->serial = NULL; id->class = NULL; id->compat = NULL; id->description = NULL; id->neisaid = 0; id->nserial = 0; id->nclass = 0; id->ncompat = 0; id->ndescription = 0; if ((buf[0] != 0x28) && (buf[0] != 0x08)) { /* non-PnP mice */ switch(buf[0]) { default: return (FALSE); case 'M': /* Microsoft */ id->eisaid = "PNP0F01"; break; case 'H': /* MouseSystems */ id->eisaid = "PNP0F04"; break; } id->neisaid = strlen(id->eisaid); id->class = "MOUSE"; id->nclass = strlen(id->class); debug("non-PnP mouse '%c'", buf[0]); return (TRUE); } /* PnP mice */ offset = 0x28 - buf[0]; /* calculate checksum */ for (i = 0; i < len - 3; ++i) { sum += buf[i]; buf[i] += offset; } sum += buf[len - 1]; for (; i < len; ++i) buf[i] += offset; debug("PnP ID string: '%*.*s'", len, len, buf); /* revision */ buf[1] -= offset; buf[2] -= offset; id->revision = ((buf[1] & 0x3f) << 6) | (buf[2] & 0x3f); debug("PnP rev %d.%02d", id->revision / 100, id->revision % 100); /* EISA vender and product ID */ id->eisaid = &buf[3]; id->neisaid = 7; /* option strings */ i = 10; if (buf[i] == '\\') { /* device serial # */ for (j = ++i; i < len; ++i) { if (buf[i] == '\\') break; } if (i >= len) i -= 3; if (i - j == 8) { id->serial = &buf[j]; id->nserial = 8; } } if (buf[i] == '\\') { /* PnP class */ for (j = ++i; i < len; ++i) { if (buf[i] == '\\') break; } if (i >= len) i -= 3; if (i > j + 1) { id->class = &buf[j]; id->nclass = i - j; } } if (buf[i] == '\\') { /* compatible driver */ for (j = ++i; i < len; ++i) { if (buf[i] == '\\') break; } /* * PnP COM spec prior to v0.96 allowed '*' in this field, * it's not allowed now; just igore it. */ if (buf[j] == '*') ++j; if (i >= len) i -= 3; if (i > j + 1) { id->compat = &buf[j]; id->ncompat = i - j; } } if (buf[i] == '\\') { /* product description */ for (j = ++i; i < len; ++i) { if (buf[i] == ';') break; } if (i >= len) i -= 3; if (i > j + 1) { id->description = &buf[j]; id->ndescription = i - j; } } /* checksum exists if there are any optional fields */ if ((id->nserial > 0) || (id->nclass > 0) || (id->ncompat > 0) || (id->ndescription > 0)) { debug("PnP checksum: 0x%X", sum); sprintf(s, "%02X", sum & 0x0ff); if (strncmp(s, &buf[len - 3], 2) != 0) { #if 0 /* * I found some mice do not comply with the PnP COM device * spec regarding checksum... XXX */ logwarnx("PnP checksum error", 0); return (FALSE); #endif } } return (TRUE); } static symtab_t * pnpproto(pnpid_t *id) { symtab_t *t; int i, j; if (id->nclass > 0) if (strncmp(id->class, "MOUSE", id->nclass) != 0 && strncmp(id->class, "TABLET", id->nclass) != 0) /* this is not a mouse! */ return (NULL); if (id->neisaid > 0) { t = gettoken(pnpprod, id->eisaid, id->neisaid); if (t->val != MOUSE_PROTO_UNKNOWN) return (t); } /* * The 'Compatible drivers' field may contain more than one * ID separated by ','. */ if (id->ncompat <= 0) return (NULL); for (i = 0; i < id->ncompat; ++i) { for (j = i; id->compat[i] != ','; ++i) if (i >= id->ncompat) break; if (i > j) { t = gettoken(pnpprod, id->compat + j, i - j); if (t->val != MOUSE_PROTO_UNKNOWN) return (t); } } return (NULL); } /* name/val mapping */ static symtab_t * gettoken(symtab_t *tab, const char *s, int len) { int i; for (i = 0; tab[i].name != NULL; ++i) { if (strncmp(tab[i].name, s, len) == 0) break; } return (&tab[i]); } static const char * gettokenname(symtab_t *tab, int val) { static const char unknown[] = "unknown"; int i; for (i = 0; tab[i].name != NULL; ++i) { if (tab[i].val == val) return (tab[i].name); } return (unknown); } /* * code to read from the Genius Kidspad tablet. The tablet responds to the COM PnP protocol 1.0 with EISA-ID KYE0005, and to pre-pnp probes (RTS toggle) with 'T' (tablet ?) 9600, 8 bit, parity odd. The tablet puts out 5 bytes. b0 (mask 0xb8, value 0xb8) contains the proximity, tip and button info: (byte0 & 0x1) true = tip pressed (byte0 & 0x2) true = button pressed (byte0 & 0x40) false = pen in proximity of tablet. The next 4 bytes are used for coordinates xl, xh, yl, yh (7 bits valid). Only absolute coordinates are returned, so we use the following approach: we store the last coordinates sent when the pen went out of the tablet, * */ typedef enum { S_IDLE, S_PROXY, S_FIRST, S_DOWN, S_UP } k_status; static int kidspad(u_char rxc, mousestatus_t *act) { static int buf[5]; static int buflen = 0, b_prev = 0 , x_prev = -1, y_prev = -1; static k_status status = S_IDLE; static struct timespec old, now; int x, y; if (buflen > 0 && (rxc & 0x80)) { fprintf(stderr, "invalid code %d 0x%x\n", buflen, rxc); buflen = 0; } if (buflen == 0 && (rxc & 0xb8) != 0xb8) { fprintf(stderr, "invalid code 0 0x%x\n", rxc); return (0); /* invalid code, no action */ } buf[buflen++] = rxc; if (buflen < 5) return (0); buflen = 0; /* for next time... */ x = buf[1]+128*(buf[2] - 7); if (x < 0) x = 0; y = 28*128 - (buf[3] + 128* (buf[4] - 7)); if (y < 0) y = 0; x /= 8; y /= 8; act->flags = 0; act->obutton = act->button; act->dx = act->dy = act->dz = 0; clock_gettime(CLOCK_MONOTONIC_FAST, &now); if (buf[0] & 0x40) /* pen went out of reach */ status = S_IDLE; else if (status == S_IDLE) { /* pen is newly near the tablet */ act->flags |= MOUSE_POSCHANGED; /* force update */ status = S_PROXY; x_prev = x; y_prev = y; } old = now; act->dx = x - x_prev; act->dy = y - y_prev; if (act->dx || act->dy) act->flags |= MOUSE_POSCHANGED; x_prev = x; y_prev = y; if (b_prev != 0 && b_prev != buf[0]) { /* possibly record button change */ act->button = 0; if (buf[0] & 0x01) /* tip pressed */ act->button |= MOUSE_BUTTON1DOWN; if (buf[0] & 0x02) /* button pressed */ act->button |= MOUSE_BUTTON2DOWN; act->flags |= MOUSE_BUTTONSCHANGED; } b_prev = buf[0]; return (act->flags); } static int gtco_digipad (u_char rxc, mousestatus_t *act) { static u_char buf[5]; static int buflen = 0, b_prev = 0 , x_prev = -1, y_prev = -1; static k_status status = S_IDLE; int x, y; #define GTCO_HEADER 0x80 #define GTCO_PROXIMITY 0x40 #define GTCO_START (GTCO_HEADER|GTCO_PROXIMITY) #define GTCO_BUTTONMASK 0x3c if (buflen > 0 && ((rxc & GTCO_HEADER) != GTCO_HEADER)) { fprintf(stderr, "invalid code %d 0x%x\n", buflen, rxc); buflen = 0; } if (buflen == 0 && (rxc & GTCO_START) != GTCO_START) { fprintf(stderr, "invalid code 0 0x%x\n", rxc); return (0); /* invalid code, no action */ } buf[buflen++] = rxc; if (buflen < 5) return (0); buflen = 0; /* for next time... */ x = ((buf[2] & ~GTCO_START) << 6 | (buf[1] & ~GTCO_START)); y = 4768 - ((buf[4] & ~GTCO_START) << 6 | (buf[3] & ~GTCO_START)); x /= 2.5; y /= 2.5; act->flags = 0; act->obutton = act->button; act->dx = act->dy = act->dz = 0; if ((buf[0] & 0x40) == 0) /* pen went out of reach */ status = S_IDLE; else if (status == S_IDLE) { /* pen is newly near the tablet */ act->flags |= MOUSE_POSCHANGED; /* force update */ status = S_PROXY; x_prev = x; y_prev = y; } act->dx = x - x_prev; act->dy = y - y_prev; if (act->dx || act->dy) act->flags |= MOUSE_POSCHANGED; x_prev = x; y_prev = y; /* possibly record button change */ if (b_prev != 0 && b_prev != buf[0]) { act->button = 0; if (buf[0] & 0x04) { /* tip pressed/yellow */ act->button |= MOUSE_BUTTON1DOWN; } if (buf[0] & 0x08) { /* grey/white */ act->button |= MOUSE_BUTTON2DOWN; } if (buf[0] & 0x10) { /* black/green */ act->button |= MOUSE_BUTTON3DOWN; } if (buf[0] & 0x20) { /* tip+grey/blue */ act->button |= MOUSE_BUTTON4DOWN; } act->flags |= MOUSE_BUTTONSCHANGED; } b_prev = buf[0]; return (act->flags); } static void mremote_serversetup(void) { struct sockaddr_un ad; /* Open a UNIX domain stream socket to listen for mouse remote clients */ unlink(_PATH_MOUSEREMOTE); if ((rodent.mremsfd = socket(AF_UNIX, SOCK_STREAM, 0)) < 0) logerrx(1, "unable to create unix domain socket %s",_PATH_MOUSEREMOTE); umask(0111); bzero(&ad, sizeof(ad)); ad.sun_family = AF_UNIX; strcpy(ad.sun_path, _PATH_MOUSEREMOTE); #ifndef SUN_LEN #define SUN_LEN(unp) (((char *)(unp)->sun_path - (char *)(unp)) + \ strlen((unp)->path)) #endif if (bind(rodent.mremsfd, (struct sockaddr *) &ad, SUN_LEN(&ad)) < 0) logerrx(1, "unable to bind unix domain socket %s", _PATH_MOUSEREMOTE); listen(rodent.mremsfd, 1); } static void mremote_clientchg(int add) { struct sockaddr_un ad; socklen_t ad_len; int fd; if (rodent.rtype != MOUSE_PROTO_X10MOUSEREM) return; if (add) { /* Accept client connection, if we don't already have one */ ad_len = sizeof(ad); fd = accept(rodent.mremsfd, (struct sockaddr *) &ad, &ad_len); if (fd < 0) logwarnx("failed accept on mouse remote socket"); if (rodent.mremcfd < 0) { rodent.mremcfd = fd; debug("remote client connect...accepted"); } else { close(fd); debug("another remote client connect...disconnected"); } } else { /* Client disconnected */ debug("remote client disconnected"); close(rodent.mremcfd); rodent.mremcfd = -1; } }