www.nico.schottelius.org/software/gpm/browse_source/gpm-1.99.5/patches/todo/gpm-1.19.3-kernel2.4.9.patch

168 lines
5.1 KiB
Diff
Raw Normal View History

--- gpm.c
+++ gpm.c
@@ -321,7 +321,7 @@
/*-------------------------------------------------------------------*/
/*-------------------------------------------------------------------*/
/*-------------------------------------------------------------------*/
-static inline char *getMouseData(int fd, Gpm_Type *type, int kd_mode)
+static inline char *getMouseData(int fd, Gpm_Type *type, int kd_mode, int *restart)
{
static unsigned char data[32]; /* quite a big margin :) */
char *edata=data+type->packetlen;
@@ -336,6 +336,22 @@
return NULL;
}
+ if (data[0] == 0xaa) {
+ j=read(fd,&(data[1]),2);
+ if ((j < 1) || (data[1] != 0x0)) {
+ if (m_type->getextra) {
+ data[1]=GPM_EXTRA_MAGIC_1; data[2]=GPM_EXTRA_MAGIC_2;
+ gpm_debug_log(LOG_DEBUG,"Extra %02x",data[0]);
+ return data;
+ }
+ gpm_debug_log(LOG_DEBUG,"Error in protocol");
+ return NULL;
+ }
+ gpm_debug_log(LOG_DEBUG,"Mouse was replugged");
+ *restart = 1;
+ return NULL;
+ }
+
if (kd_mode!=KD_TEXT && fifofd != -1 && opt_rawrep)
write(fifofd, data, howmany);
@@ -402,6 +418,7 @@
fd_set fdSet;
static int newB=0, oldB=0, oldT=0; /* old buttons and Type to chain events */
/* static int buttonlock, buttonlockflag; */
+ int restart;
#define GET_TIME(tv) (gettimeofday(&tv, (struct timezone *)NULL))
#define DIF_TIME(t1,t2) ((t2.tv_sec -t1.tv_sec) *1000+ \
@@ -432,9 +449,11 @@
do /* cluster loop */
{
- if ( ((data=getMouseData(fd,m_type,kd_mode))==NULL)
+ restart = 0;
+ if ( ((data=getMouseData(fd,m_type,kd_mode,&restart))==NULL)
|| ((*(m_type->fun))(&nEvent,data)==-1) )
{
+ if (restart) return -1;
if (!i) return 0;
else break;
}
@@ -926,6 +945,40 @@
unlink(GPM_NODE_CTL);
}
+static inline int initMouse(int i, int *fd, int *maxfd)
+{
+ which_mouse=mouse_table+i; /* used to access options */
+
+ /* open the device with ndelay, to catch a locked device */
+ if (opt_dev)
+ {
+ if (!strcmp(opt_dev,"-"))
+ *fd=0;
+ else if ((*fd=open(opt_dev,O_RDWR | O_NDELAY))<0)
+ { oops(opt_dev); }
+ }
+ else /* use "/dev/mouse" */
+ {
+ opt_dev = "/dev/mouse";
+ if ((*fd=open(opt_dev,O_RDWR | O_NDELAY))<0)
+ { oops(opt_dev); }
+ }
+ /* and then reset the flag */
+ fcntl(*fd,F_SETFL,fcntl(*fd,F_GETFL) & ~O_NDELAY);
+ /* create argc and argv for this device */
+ mouse_argv[i] = build_argv(opt_type, opt_options, &mouse_argc[i], ',');
+
+ /* init the device, and use the return value as new mouse type */
+ if (m_type->init)
+ m_type=(m_type->init)(*fd, m_type->flags, m_type,
+ mouse_argc[i], mouse_argv[i]);
+ if (!m_type)
+ { oops("mouse initialization failed"); }
+
+ which_mouse->fd=*fd;
+ *maxfd=max(*fd, *maxfd);
+}
+
/*-------------------------------------------------------------------*/
int main(int argc, char **argv)
{
@@ -951,38 +1004,7 @@
for (i=1; i <= 1+opt_double; i++)
{
- which_mouse=mouse_table+i; /* used to access options */
-
- /* open the device with ndelay, to catch a locked device */
- if (opt_dev)
- {
- if (!strcmp(opt_dev,"-"))
- fd=0;
- else if ((fd=open(opt_dev,O_RDWR | O_NDELAY))<0)
- { oops(opt_dev); }
- }
- else /* use "/dev/mouse" */
- {
- opt_dev = "/dev/mouse";
- if ((fd=open(opt_dev,O_RDWR | O_NDELAY))<0)
- { oops(opt_dev); }
- }
-
- /* and then reset the flag */
- fcntl(fd,F_SETFL,fcntl(fd,F_GETFL) & ~O_NDELAY);
-
- /* create argc and argv for this device */
- mouse_argv[i] = build_argv(opt_type, opt_options, &mouse_argc[i], ',');
-
- /* init the device, and use the return value as new mouse type */
- if (m_type->init)
- m_type=(m_type->init)(fd, m_type->flags, m_type,
- mouse_argc[i], mouse_argv[i]);
- if (!m_type)
- { oops("mouse initialization failed"); }
-
- which_mouse->fd=fd;
- maxfd=max(fd, maxfd);
+ initMouse(i, &fd, &maxfd);
} /*for*/
/* FIXME: stderr must be closed at this point, as protocol init needs it */
@@ -1114,11 +1136,13 @@
for (i=1; i <= 1+opt_double; i++)
{
+ int rc;
which_mouse=mouse_table+i; /* used to access options */
if (FD_ISSET(which_mouse->fd,&selSet))
{
FD_CLR(which_mouse->fd,&selSet); pending--;
- if (processMouse(which_mouse->fd, &event, m_type, kd_mode))
+ rc = processMouse(which_mouse->fd, &event, m_type, kd_mode);
+ if (rc > 0) {
/*
* pass it to the client, if any
* or to the default handler, if any
@@ -1127,6 +1151,15 @@
(cinfo[event.vc] && do_client(cinfo[event.vc], &event))
|| (cinfo[0] && do_client(cinfo[0], &event))
|| do_selection(&event);
+ }
+ else
+ if (rc == -1) {
+ /* try to reinitialise the mouse */
+ FD_CLR(which_mouse->fd, &selSet);
+ close(which_mouse->fd);
+ initMouse(i, &fd, &maxfd);
+ FD_CLR(which_mouse->fd, &selSet);
+ }
}
}