path: root/code/pnd/pnd_event.c

#include "pnd_event.h"
#include "pnd_type.h"

#include "../qcommon/q_shared.h"
#include "../client/keycodes.h"
#include "../qcommon/qcommon.h"

cvar_t* cvarKey;
cvar_t* cvarMouse;

unsigned char keymap[128] =
{
    0,  27, '1', '2', '3', '4', '5', '6', '7', '8',	/* 9 */
  '9', '0', '-', '=', K_BACKSPACE,	/* Backspace */
  K_TAB,			/* Tab */
  'q', 'w', 'e', 'r',	/* 19 */
  't', 'y', 'u', 'i', 'o', 'p', '[', ']', K_ENTER,	/* Enter key */
    K_CTRL,			/* 29   - Control */
  'a', 's', 'd', 'f', 'g', 'h', 'j', 'k', 'l', ';',	/* 39 */
 '\'', '`',   K_SHIFT,		/* Left shift */
 '\\', 'z', 'x', 'c', 'v', 'b', 'n',			/* 49 */
  'm', ',', '.', '/',   K_SHIFT,				/* Right shift */
  '*',
    K_ALT,	/* Alt */
  K_SPACE,	/* Space bar */
    0,	/* Caps lock */
    K_F1,	/* 59 - F1 key ... > */
    K_F2,   K_F3,   K_F4,   K_F5,   K_F6,   K_F7,   K_F8,   K_F9,
    K_F10,	/* < ... F10 */
    0,	/* 69 - Num lock*/
    0,	/* Scroll Lock */
    K_HOME,	/* Home key */
    K_UPARROW,	/* Up Arrow */
    K_PGUP,	/* Page Up */
  '-',
    K_LEFTARROW,	/* Left Arrow */
    0,
    K_RIGHTARROW,	/* Right Arrow */
  '+',
    K_END,	/* 79 - End key*/
    K_DOWNARROW,	/* Down Arrow */
    K_PGDN,	/* Page Down */
    K_INS,	/* Insert Key */
    K_DEL,	/* Delete Key */
    0,   0,   0,
    K_F11,	/* F11 Key */
    K_F12,	/* F12 Key */
    0,	/* All other keys are undefined */
};

char event_name[30];
int fd_usbk, fd_usbm, fd_gpio, fd_pndk, fd_nub1, fd_nub2, fd_ts, rd, i, j, k;
struct input_event ev[64];
int version;
unsigned short id[4];
unsigned long bit[EV_MAX][NBITS(KEY_MAX)];
char dev_name[256] = "Unknown";
int absolute[5];
int prevtime;

char pnd_ts[20]   = "ADS784x Touchscreen";
char pnd_nub1[9]  = "vsense66";
char pnd_nub2[9]  = "vsense67";
char pnd_key[19]  = "omap_twl4030keypad";
char pnd_gpio[10] = "gpio-keys";

#define DEV_TS	 0
#define DEV_NUB1 1
#define DEV_NUB2 2
#define DEV_PNDK 3
#define DEV_GPIO 4
#define DEV_USBK 5
#define DEV_USBM 6

#define NUB1_CUTOFF 100
#define NUB2_CUTOFF 5
#define NUB2_SCALE  10

int mx, my, buttonstate, lasttime;

void PND_Setup_Controls( void )
{
	int event_key = 0;
	int event_mouse = 0;

	printf( "Setting up Pandora Controls\n" );

	cvarKey = Cvar_Get("usbk", "0", 0);
	cvarMouse = Cvar_Get("usbm", "0", 0);

	event_key = cvarKey->value;
	event_mouse = cvarMouse->value;

	// Static Controls
	// Pandora keyboard
	fd_pndk = PND_OpenEventDeviceByName(pnd_key);
	// Pandora buttons
	fd_gpio = PND_OpenEventDeviceByName(pnd_gpio);
	// Pandora touchscreen
	fd_ts = PND_OpenEventDeviceByName(pnd_ts);
	// Pandora analog nub's
	fd_nub1 = PND_OpenEventDeviceByName(pnd_nub1);
	fd_nub2 = PND_OpenEventDeviceByName(pnd_nub2);

	// Dynamic Controls
	// USB keyboard
	if( event_key > 0 ) {
		fd_usbk = PND_OpenEventDeviceByID(event_key);
	} else {
		printf( "No device selected for USB keyboard\n" );
	}
	// USB mouse
	if( event_mouse > 0 ) {
		fd_usbm = PND_OpenEventDeviceByID(event_mouse);
	} else {
		printf( "No device selected for USB mouse\n" );
	}
}

void PND_Close_Controls( void )
{
	printf( "Closing Pandora Controls\n" );

	if( fd_pndk > 0 )
		close(fd_pndk );
	if( fd_gpio > 0 )
		close(fd_gpio );
	if( fd_ts > 0 )
		close(fd_ts );
	if( fd_nub1 > 0 )
		close(fd_nub1 );
	if( fd_nub2 > 0 )
		close(fd_nub2 );
	if( fd_usbk > 0 )
		close(fd_usbk );
	if( fd_usbm > 0 )
		close(fd_usbm );
}

void PND_SendAllEvents( void )
{
	// Read the events from the controls
	PND_SendKeyEvents();
	PND_SendRelEvents();
	PND_SendAbsEvents();
}

void PND_SendKeyEvents( void )
{
	PND_ReadEvents( fd_pndk, DEV_PNDK );
	PND_ReadEvents( fd_gpio, DEV_GPIO );
	PND_ReadEvents( fd_usbk, DEV_USBK );
	PND_ReadEvents( fd_nub1, DEV_NUB1 );
}

void PND_SendRelEvents( void )
{
	PND_ReadEvents( fd_nub2, DEV_NUB2 );
	PND_ReadEvents( fd_usbm, DEV_USBM );
	
	if ( (mx != 0 || my != 0) && (Sys_Milliseconds() - lasttime > 5) )
	{
		Com_QueueEvent( 0, SE_MOUSE, mx, my, 0, NULL ); 
	}
	lasttime = Sys_Milliseconds();
}

void PND_SendAbsEvents( void )
{
	PND_ReadEvents( fd_ts,   DEV_TS );
}

void PND_ReadEvents( int fd, int device )
{
	if( fd != 0 )
	{
		rd = read(fd, ev, sizeof(struct input_event) * 64);

		if (rd > (int) sizeof(struct input_event))
		{
			for (i = 0; i < rd / sizeof(struct input_event); i++)
			{
				PND_CheckEvent( &ev[i], device );
			}
		}
	}
}

void PND_CheckEvent( struct input_event *event, int device )
{
	int sym, value;
	long rel_x, rel_y;

	//printf( "Device %d Type %d Code %d Value %d\n", device, event->type, event->code, event->value );

	rel_x	= 0;
	rel_y	= 0;
	sym	= 0;
	value	= event->value;
	switch( event->type )
	{
		case EV_KEY:
			switch( event->code )
			{
				case 103:
					sym = K_UPARROW;
					break;
				case 108:
					sym = K_DOWNARROW;
					break;
				case 105:
					sym = K_LEFTARROW;
					break;
				case 106:
					sym = K_RIGHTARROW;
					break;
				case 139:		// menu
					sym = K_F1;
					break;
				case 56:	// start
					sym = K_ENTER;
					break;
				case 29:	// select
					sym = K_ESCAPE;
					break;
				case 104:	// up (y)
					sym = 'y';
					break;
				case 102:	// right (a)
					sym = 'a';
					break;
				case 109:	// down (x)
					sym = 'x';
					break;
				case 107:	// left (b)
					sym = 'b';
					break;
/*
				case 54:	// left shoulder
					sym = 'l';
					break;
				case 97:	// right shoulder
					sym = 'r';
					break;
*/
				case 54:
					sym = K_MOUSE1;
					break;
				case 97:
					sym = K_MOUSE2;
					break;
				default:
					if( keymap[event->code]>0 )
						sym = keymap[event->code];
					break;
			}
			break;
		case EV_REL:
			switch( device )
			{
				case DEV_USBM:
					switch( event->code )
					{
						case REL_X:
							rel_x = value;
							break;
						case REL_Y:
							rel_y = value;
							break;
					}
					break;
			}
			break;
		case EV_ABS:
			switch( device )
			{
				case DEV_TS:
#if 0
					if( event->code == ABS_X ) {
						rel_x = abs_x - value;
						abs_x = value;
					}
					if( event->code == ABS_Y ) {
						rel_y = abs_y - value;
						abs_y = value;
					}
#endif
					break;
				case DEV_NUB1:
					if( event->code == ABS_X ) {
						//printf( "nub1 x %3d\n", value );
						if( abs(value) > NUB1_CUTOFF ) {
							if( value > 0 ) {
								sym   = K_RIGHTARROW;
								value = 1;
							}
							else if( value < 0 ) {
								sym   = K_LEFTARROW;
								value = 1;
							}
						}
						else
						{
							sym = 0;
							value = 0;
							Com_QueueEvent(0, SE_KEY, K_RIGHTARROW, 0, 0, NULL);
							Com_QueueEvent(0, SE_KEY, K_LEFTARROW, 0, 0, NULL);
						}
					}

					if( event->code == ABS_Y ) {
						//printf( "nub1 y %3d\n", value );
						if( abs(value) > NUB1_CUTOFF ) {
							if( value > 0 ) {
							      	sym   = K_DOWNARROW;
								value = 1;
							}
							else if( value < 0 ) {
								sym   = K_UPARROW;
								value = 1;
							}
						}
						else
						{
							sym = 0;
							value = 0;
							Com_QueueEvent(0, SE_KEY, K_DOWNARROW, 0, 0, NULL);
							Com_QueueEvent(0, SE_KEY, K_UPARROW, 0, 0, NULL);
						}
					}
					break;
				case DEV_NUB2:
					if(event->code == ABS_X)
					{
						if( abs(value) > NUB2_CUTOFF ) {
							mx = value / NUB2_SCALE;
						}
						else {
							mx = 0;
						}
					}

					if(event->code == ABS_Y)
					{
						if( abs(value) > NUB2_CUTOFF ) {
							my = value / NUB2_SCALE;
						}
						else {
							my = 0;
						}
					}
					break;
			}
			break;
	}

	if( sym > 0 ) {
		Com_QueueEvent(0, SE_KEY, sym, value, 0, NULL);
	}

	if( rel_x != 0 || rel_y != 0 )
	{
		Com_QueueEvent( 0, SE_MOUSE, rel_x, rel_y, 0, NULL ); 
	}

	//printf( "nub2 x %3d y %3d\n", nub2_x, nub2_y );
}

int PND_OpenEventDeviceByID( int event_id )
{
	int fd;

	snprintf( event_name, sizeof(event_name), "/dev/input/event%d", event_id );
	printf( "Device: %s\n", event_name );
	if ((fd = open(event_name, O_RDONLY |  O_NDELAY)) < 0) {
		perror("ERROR: Could not open device");
		return 0;
	}

	if (ioctl(fd, EVIOCGVERSION, &version)) {
		perror("evtest: can't get version");
		return 0;
	}

	printf("Input driver version is %d.%d.%d\n",
		version >> 16, (version >> 8) & 0xff, version & 0xff);

	ioctl(fd, EVIOCGID, id);
	printf("Input device ID: bus 0x%x vendor 0x%x product 0x%x version 0x%x\n",
		id[ID_BUS], id[ID_VENDOR], id[ID_PRODUCT], id[ID_VERSION]);

	ioctl(fd, EVIOCGNAME(sizeof(dev_name)), dev_name);
	printf("Input device name: \"%s\"\n", dev_name);

	return fd;
}

int PND_OpenEventDeviceByName( char device_name[] )
{
	int fd;

	for (i = 0; 1; i++)
	{
		snprintf( event_name, sizeof(event_name), "/dev/input/event%d", i );
		//printf( "Device: %s\n", event_name );
		if ((fd = open(event_name, O_RDONLY |  O_NDELAY)) < 0) {
			perror("ERROR: Could not open device");
			return 0;
		}
		if (fd < 0) break; /* no more devices */

		ioctl(fd, EVIOCGNAME(sizeof(dev_name)), dev_name);
		if (strcmp(dev_name, device_name) == 0)
		{
			if (ioctl(fd, EVIOCGVERSION, &version)) {
				perror("evtest: can't get version");
				return 0;
			}

			printf("Input driver version is %d.%d.%d\n",
				version >> 16, (version >> 8) & 0xff, version & 0xff);

			ioctl(fd, EVIOCGID, id);
			printf("Input device ID: bus 0x%x vendor 0x%x product 0x%x version 0x%x\n",
				id[ID_BUS], id[ID_VENDOR], id[ID_PRODUCT], id[ID_VERSION]);

			ioctl(fd, EVIOCGNAME(sizeof(dev_name)), dev_name);
			printf("Input device name: \"%s\"\n", dev_name);
		  
			return fd;
		}
		close(fd); /* we don't need this device */
	}
	return 0;
}