d/freebsd-skq
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity
b6f7c57ecf
freebsd-skq/usr.sbin/moused/moused.c
Maxim Sobolev dd8fb388f5 Fix serious ugliness introduced in 1.61, which leads to long delay in boot 
sequence when machine is started without attached USB mouse. Only do
repeated attempts to re-open device if the usb module has been actually
loaded. Also fix broken logic in doing delays between open attempts - do
delays between attempts, not after each attempt.

Due to previous behaviour being very annoying for notebook owners this
is a good 5.2 MFC candidate.

MFC after:	2 days
2004-01-10 13:09:21 +00:00

3027 lines
85 KiB
C
Raw Blame History

/**
** 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$");
#include <sys/param.h>
#include <sys/consio.h>
#include <sys/linker.h>
#include <sys/module.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 <limits.h>
#include <setjmp.h>
#include <signal.h>
#include <stdarg.h>
#include <stdio.h>
#include <stdlib.h>
#include <string.h>
#include <syslog.h>
#include <termios.h>
#include <unistd.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 */
/* 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 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)
#define debug(fmt, args...) do { \
if (debug && nodaemon) \
warnx(fmt, ##args); \
} while (0)
#define logerr(e, fmt, args...) do { \
log_or_warn(LOG_DAEMON | LOG_ERR, errno, fmt, ##args); \
exit(e); \
} while (0)
#define logerrx(e, fmt, args...) do { \
log_or_warn(LOG_DAEMON | LOG_ERR, 0, fmt, ##args); \
exit(e); \
} while (0)
#define logwarn(fmt, args...) \
log_or_warn(LOG_DAEMON | LOG_WARNING, errno, fmt, ##args)
#define logwarnx(fmt, args...) \
log_or_warn(LOG_DAEMON | LOG_WARNING, 0, fmt, ##args)
/* structures */
/* symbol table entry */
typedef struct {
char *name;
int val;
int val2;
} symtab_t;
/* serial PnP ID string */
typedef struct {
int revision; /* PnP revision, 100 for 1.00 */
char *eisaid; /* EISA ID including mfr ID and product ID */
char *serial; /* serial No, optional */
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 identify = ID_NONE;
int extioctl = FALSE;
char *pidfile = "/var/run/moused.pid";
/* local variables */
/* interface (the table must be ordered by MOUSE_IF_XXX in mouse.h) */
static symtab_t rifs[] = {
{ "serial", MOUSE_IF_SERIAL },
{ "bus", MOUSE_IF_BUS },
{ "inport", MOUSE_IF_INPORT },
{ "ps/2", MOUSE_IF_PS2 },
{ "sysmouse", MOUSE_IF_SYSMOUSE },
{ "usb", MOUSE_IF_USB },
{ NULL, MOUSE_IF_UNKNOWN },
};
/* types (the table must be ordered by MOUSE_PROTO_XXX in mouse.h) */
static char *rnames[] = {
"microsoft",
"mousesystems",
"logitech",
"mmseries",
"mouseman",
"busmouse",
"inportmouse",
"ps/2",
"mmhitab",
"glidepoint",
"intellimouse",
"thinkingmouse",
"sysmouse",
"x10mouseremote",
"kidspad",
"versapad",
"jogdial",
#if notyet
"mariqua",
#endif
NULL
};
/* models */
static symtab_t rmodels[] = {
{ "NetScroll", MOUSE_MODEL_NETSCROLL },
{ "NetMouse/NetScroll Optical", MOUSE_MODEL_NET },
{ "GlidePoint", MOUSE_MODEL_GLIDEPOINT },
{ "ThinkingMouse", MOUSE_MODEL_THINK },
{ "IntelliMouse", MOUSE_MODEL_INTELLI },
{ "EasyScroll/SmartScroll", MOUSE_MODEL_EASYSCROLL },
{ "MouseMan+", MOUSE_MODEL_MOUSEMANPLUS },
{ "Kidspad", MOUSE_MODEL_KIDSPAD },
{ "VersaPad", MOUSE_MODEL_VERSAPAD },
{ "IntelliMouse Explorer", MOUSE_MODEL_EXPLORER },
{ "4D Mouse", MOUSE_MODEL_4D },
{ "4D+ Mouse", MOUSE_MODEL_4DPLUS },
{ "generic", MOUSE_MODEL_GENERIC },
{ NULL, MOUSE_MODEL_UNKNOWN },
};
/* 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
};
static struct rodentparam {
int flags;
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 */
} 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,
};
/* button status */
struct button_state {
int count; /* 0: up, 1: single click, 2: double click,... */
struct timeval tv; /* 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 timeval mouse_button_state_tv;
static int mouse_move_delayed;
static jmp_buf env;
/* function prototypes */
static void moused(void);
static void hup(int sig);
static void cleanup(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 char *r_if(int type);
static char *r_name(int type);
static 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, char *s, int len);
static char *gettokenname(symtab_t *tab, int val);
static void mremote_serversetup();
static void mremote_clientchg(int add);
static int kidspad(u_char rxc, mousestatus_t *act);
static int usbmodule(void);
int
main(int argc, char *argv[])
{
int c;
int i;
int j;
int retry;
for (i = 0; i < MOUSE_MAXBUTTON; ++i)
mstate[i] = &bstate[i];
while ((c = getopt(argc, argv, "3C:DE:F:I:PRS: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 acceleration argument '%s'", optarg);
usage();
}
if (i == 1)
rodent.accely = rodent.accelx;
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 'I':
pidfile = optarg;
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':
if (strcmp(optarg, "auto") == 0) {
rodent.rtype = MOUSE_PROTO_UNKNOWN;
rodent.flags &= ~NoPnP;
rodent.level = -1;
break;
}
for (i = 0; rnames[i]; 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])
break;
warnx("no such mouse type `%s'", optarg);
usage();
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) {
if (usbmodule() != 0)
retry = 5;
}
for (;;) {
if (setjmp(env) == 0) {
signal(SIGHUP, hup);
signal(SIGINT , cleanup);
signal(SIGQUIT, cleanup);
signal(SIGTERM, cleanup);
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 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);
}
static int
usbmodule(void)
{
struct kld_file_stat fstat;
struct module_stat mstat;
int fileid, modid;
int loaded;
for (loaded = 0, fileid = kldnext(0); !loaded && fileid > 0;
fileid = kldnext(fileid)) {
fstat.version = sizeof(fstat);
if (kldstat(fileid, &fstat) < 0)
continue;
if (strncmp(fstat.name, "uhub/ums", 8) == 0) {
loaded = 1;
break;
}
for (modid = kldfirstmod(fileid); modid > 0;
modid = modfnext(modid)) {
mstat.version = sizeof(mstat);
if (modstat(modid, &mstat) < 0)
continue;
if (strncmp(mstat.name, "uhub/ums", 8) == 0) {
loaded = 1;
break;
}
}
}
if (!loaded) {
if (kldload("ums") != -1)
return 1;
if (errno != EEXIST)
logerr(1, "unable to load USB mouse driver");
}
return 0;
}
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;
FILE *fp;
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) {
if (daemon(0, 0)) {
logerr(1, "failed to become a daemon");
} else {
background = TRUE;
fp = fopen(pidfile, "w");
if (fp != NULL) {
fprintf(fp, "%d\n", getpid());
fclose(fp);
}
}
}
/* clear mouse data */
bzero(&action0, sizeof(action0));
bzero(&action, sizeof(action));
bzero(&action2, sizeof(action2));
bzero(&mouse, sizeof(mouse));
mouse_button_state = S0;
gettimeofday(&mouse_button_state_tv, NULL);
mouse_move_delayed = 0;
for (i = 0; i < MOUSE_MAXBUTTON; ++i) {
bstate[i].count = 0;
bstate[i].tv = mouse_button_state_tv;
}
for (i = 0; i < sizeof(zstate)/sizeof(zstate[0]); ++i) {
zstate[i].count = 0;
zstate[i].tv = mouse_button_state_tv;
}
/* 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) ? &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;
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 (extioctl) {
r_click(&action2);
if (action2.flags & MOUSE_POSCHANGED) {
mouse.operation = MOUSE_MOTION_EVENT;
mouse.u.data.buttons = action2.button;
mouse.u.data.x = action2.dx * rodent.accelx;
mouse.u.data.y = action2.dy * rodent.accely;
mouse.u.data.z = action2.dz;
if (debug < 2)
ioctl(rodent.cfd, CONS_MOUSECTL, &mouse);
}
} else {
mouse.operation = MOUSE_ACTION;
mouse.u.data.buttons = action2.button;
mouse.u.data.x = action2.dx * rodent.accelx;
mouse.u.data.y = action2.dy * rodent.accely;
mouse.u.data.z = action2.dz;
if (debug < 2)
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)
ioctl(rodent.cfd, CONS_MOUSECTL, &mouse);
}
}
}
}
/* NOT REACHED */
}
static void
hup(int sig)
{
longjmp(env, 1);
}
static void
cleanup(int sig)
{
if (rodent.rtype == MOUSE_PROTO_X10MOUSEREM)
unlink(_PATH_MOUSEREMOTE);
exit(0);
}
/**
** usage
**
** Complain, and free the CPU for more worthy tasks
**/
static void
usage(void)
{
fprintf(stderr, "%s\n%s\n%s\n%s\n",
"usage: moused [-DRcdfs] [-I file] [-F rate] [-r resolution] [-S baudrate]",
" [-a X [,Y]] [-C threshold] [-m N=M] [-w N] [-z N]",
" [-t <mousetype>] [-3 [-E timeout]] -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 >= 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 char *
r_if(int iftype)
{
char *s;
s = gettokenname(rifs, iftype);
return (s == NULL) ? "unknown" : s;
}
static char *
r_name(int type)
{
return ((type == MOUSE_PROTO_UNKNOWN)
|| (type > sizeof(rnames)/sizeof(rnames[0]) - 1))
? "unknown" : rnames[type];
}
static char *
r_model(int model)
{
char *s;
s = gettokenname(rmodels, model);
return (s == NULL) ? "unknown" : s;
}
static void
r_init(void)
{
unsigned char buf[16]; /* scrach buffer */
fd_set fds;
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) ;
/*
* 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)
gettimeofday(&mouse_button_state_tv, NULL);
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 timeval tv;
struct timeval tv1;
struct timeval tv2;
struct timeval tv3;
int button;
int mask;
int i;
mask = act->flags & MOUSE_BUTTONS;
#if 0
if (mask == 0)
return;
#endif
gettimeofday(&tv1, NULL);
/* double click threshold */
tv2.tv_sec = rodent.clickthreshold/1000;
tv2.tv_usec = (rodent.clickthreshold%1000)*1000;
timersub(&tv1, &tv2, &tv);
debug("tv: %ld %ld", tv.tv_sec, tv.tv_usec);
/* 3 button emulation timeout */
tv2.tv_sec = rodent.button2timeout/1000;
tv2.tv_usec = (rodent.button2timeout%1000)*1000;
timersub(&tv1, &tv2, &tv3);
button = MOUSE_BUTTON1DOWN;
for (i = 0; (i < MOUSE_MAXBUTTON) && (mask != 0); ++i) {
if (mask & 1) {
if (act->button & button) {
/* the button is down */
debug(" : %ld %ld",
bstate[i].tv.tv_sec, bstate[i].tv.tv_usec);
if (timercmp(&tv, &bstate[i].tv, >)) {
bstate[i].count = 1;
} else {
++bstate[i].count;
}
bstate[i].tv = tv1;
} else {
/* the button is up */
bstate[i].tv = tv1;
}
} else {
if (act->button & button) {
/* the button has been down */
if (timercmp(&tv3, &bstate[i].tv, >)) {
bstate[i].count = 1;
bstate[i].tv = tv1;
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 timeval tv;
struct timeval tv1;
struct timeval tv2;
if (states[mouse_button_state].timeout)
return TRUE;
gettimeofday(&tv1, NULL);
tv2.tv_sec = rodent.button2timeout/1000;
tv2.tv_usec = (rodent.button2timeout%1000)*1000;
timersub(&tv1, &tv2, &tv);
return timercmp(&tv, &mouse_button_state_tv, >);
}
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)
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;
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, 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 char *
gettokenname(symtab_t *tab, int val)
{
int i;
for (i = 0; tab[i].name != NULL; ++i) {
if (tab[i].val == val)
return tab[i].name;
}
return NULL;
}
/*
* 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 timeval 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 ;
gettimeofday(&now, NULL);
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 void
mremote_serversetup()
{
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;
int ad_len, 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;
}
}
Reference in New Issue View Git Blame Copy Permalink