154 lines
		
	
	
		
			3.4 KiB
		
	
	
	
		
			C
		
	
	
	
			
		
		
	
	
			154 lines
		
	
	
		
			3.4 KiB
		
	
	
	
		
			C
		
	
	
	
| /*
 | |
|  * $RCSId: xc/programs/Xserver/hw/kdrive/linux/ps2.c,v 1.6 2001/10/12 06:33:10 keithp Exp $
 | |
|  *
 | |
|  * Copyright © 1999 Keith Packard
 | |
|  *
 | |
|  * 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 Keith Packard not be used in
 | |
|  * advertising or publicity pertaining to distribution of the software without
 | |
|  * specific, written prior permission.  Keith Packard makes no
 | |
|  * representations about the suitability of this software for any purpose.  It
 | |
|  * is provided "as is" without express or implied warranty.
 | |
|  *
 | |
|  * KEITH PACKARD DISCLAIMS ALL WARRANTIES WITH REGARD TO THIS SOFTWARE,
 | |
|  * INCLUDING ALL IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS, IN NO
 | |
|  * EVENT SHALL KEITH PACKARD 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.
 | |
|  */
 | |
| 
 | |
| #ifdef HAVE_CONFIG_H
 | |
| #include <kdrive-config.h>
 | |
| #endif
 | |
| #define NEED_EVENTS
 | |
| #include <X11/X.h>
 | |
| #include <X11/Xproto.h>
 | |
| #include <X11/Xpoll.h>
 | |
| #include "inputstr.h"
 | |
| #include "scrnintstr.h"
 | |
| #include "kdrive.h"
 | |
| 
 | |
| static int
 | |
| Ps2ReadBytes (int fd, char *buf, int len, int min)
 | |
| {
 | |
|     int		    n, tot;
 | |
|     fd_set	    set;
 | |
|     struct timeval  tv;
 | |
| 
 | |
|     tot = 0;
 | |
|     while (len)
 | |
|     {
 | |
| 	n = read (fd, buf, len);
 | |
| 	if (n > 0)
 | |
| 	{
 | |
| 	    tot += n;
 | |
| 	    buf += n;
 | |
| 	    len -= n;
 | |
| 	}
 | |
| 	if (tot % min == 0)
 | |
| 	    break;
 | |
| 	FD_ZERO (&set);
 | |
| 	FD_SET (fd, &set);
 | |
| 	tv.tv_sec = 0;
 | |
| 	tv.tv_usec = 100 * 1000;
 | |
| 	n = select (fd + 1, &set, 0, 0, &tv);
 | |
| 	if (n <= 0)
 | |
| 	    break;
 | |
|     }
 | |
|     return tot;
 | |
| }
 | |
| 
 | |
| char	*Ps2Names[] = {
 | |
|     "/dev/psaux",
 | |
| /*    "/dev/mouse", */
 | |
|     "/dev/input/mice",
 | |
| };
 | |
| 
 | |
| #define NUM_PS2_NAMES	(sizeof (Ps2Names) / sizeof (Ps2Names[0]))
 | |
| 
 | |
| static void
 | |
| Ps2Read (int ps2Port, void *closure)
 | |
| {
 | |
|     unsigned char   buf[3 * 200];
 | |
|     unsigned char   *b;
 | |
|     int		    n;
 | |
|     int		    dx, dy;
 | |
|     unsigned long   flags;
 | |
|     unsigned long   left_button = KD_BUTTON_1;
 | |
|     unsigned long   right_button = KD_BUTTON_3;
 | |
| 
 | |
| #undef SWAP_USB
 | |
| #ifdef SWAP_USB
 | |
|     if (id == 2)
 | |
|     {
 | |
| 	left_button = KD_BUTTON_3;
 | |
| 	right_button = KD_BUTTON_1;
 | |
|     }
 | |
| #endif
 | |
|     while ((n = Ps2ReadBytes (ps2Port, (char *) buf, sizeof (buf), 3)) > 0)
 | |
|     {
 | |
| 	b = buf;
 | |
| 	while (n >= 3)
 | |
| 	{
 | |
| 	    flags = KD_MOUSE_DELTA;
 | |
| 	    if (b[0] & 4)
 | |
| 		flags |= KD_BUTTON_2;
 | |
| 	    if (b[0] & 2)
 | |
| 		flags |= right_button;
 | |
| 	    if (b[0] & 1)
 | |
| 		flags |= left_button;
 | |
| 		
 | |
| 	    dx = b[1];
 | |
| 	    if (b[0] & 0x10)
 | |
| 		dx -= 256;
 | |
| 	    dy = b[2];
 | |
| 	    if (b[0] & 0x20)
 | |
| 		dy -= 256;
 | |
| 	    dy = -dy;
 | |
| 	    n -= 3;
 | |
| 	    b += 3;
 | |
| 	    KdEnqueueMouseEvent (kdMouseInfo, flags, dx, dy);
 | |
| 	}
 | |
|     }
 | |
| }
 | |
| 
 | |
| int Ps2InputType;
 | |
| 
 | |
| static int
 | |
| Ps2Init (void)
 | |
| {
 | |
|     int	    i;
 | |
|     int	    ps2Port;
 | |
|     int	    n;
 | |
| 
 | |
|     if (!Ps2InputType)
 | |
| 	Ps2InputType = KdAllocInputType ();
 | |
|     n = 0;
 | |
|     for (i = 0; i < NUM_PS2_NAMES; i++)
 | |
|     {
 | |
| 	ps2Port = open (Ps2Names[i], 0);
 | |
| 	if (ps2Port >= 0)
 | |
| 	{
 | |
| 	    if (KdRegisterFd (Ps2InputType, ps2Port, Ps2Read, (void *) i))
 | |
| 		n++;
 | |
| 	}
 | |
|     }
 | |
|     return n;
 | |
| }
 | |
| 
 | |
| static void
 | |
| Ps2Fini (void)
 | |
| {
 | |
|     KdUnregisterFds (Ps2InputType, TRUE);
 | |
| }
 | |
| 
 | |
| KdMouseFuncs Ps2MouseFuncs = {
 | |
|     Ps2Init,
 | |
|     Ps2Fini
 | |
| };
 |