Home | History | Annotate | Download | only in fbcon
      1 /*
      2     SDL - Simple DirectMedia Layer
      3     Copyright (C) 1997-2006 Sam Lantinga
      4 
      5     This library is free software; you can redistribute it and/or
      6     modify it under the terms of the GNU Lesser General Public
      7     License as published by the Free Software Foundation; either
      8     version 2.1 of the License, or (at your option) any later version.
      9 
     10     This library is distributed in the hope that it will be useful,
     11     but WITHOUT ANY WARRANTY; without even the implied warranty of
     12     MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
     13     Lesser General Public License for more details.
     14 
     15     You should have received a copy of the GNU Lesser General Public
     16     License along with this library; if not, write to the Free Software
     17     Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
     18 
     19     Sam Lantinga
     20     slouken (at) libsdl.org
     21 */
     22 #include "SDL_config.h"
     23 
     24 /* Handle the event stream, converting console events into SDL events */
     25 
     26 #include <stdio.h>
     27 #include <sys/types.h>
     28 #include <sys/time.h>
     29 #include <sys/ioctl.h>
     30 #include <unistd.h>
     31 #include <fcntl.h>
     32 #include <errno.h>
     33 #include <limits.h>
     34 
     35 /* For parsing /proc */
     36 #include <dirent.h>
     37 #include <ctype.h>
     38 
     39 #include <linux/vt.h>
     40 #include <linux/kd.h>
     41 #include <linux/keyboard.h>
     42 
     43 #include "SDL_timer.h"
     44 #include "SDL_mutex.h"
     45 #include "../SDL_sysvideo.h"
     46 #include "../../events/SDL_sysevents.h"
     47 #include "../../events/SDL_events_c.h"
     48 #include "SDL_fbvideo.h"
     49 #include "SDL_fbevents_c.h"
     50 #include "SDL_fbkeys.h"
     51 
     52 #include "SDL_fbelo.h"
     53 
     54 #ifndef GPM_NODE_FIFO
     55 #define GPM_NODE_FIFO	"/dev/gpmdata"
     56 #endif
     57 
     58 /*#define DEBUG_KEYBOARD*/
     59 /*#define DEBUG_MOUSE*/
     60 
     61 /* The translation tables from a console scancode to a SDL keysym */
     62 #define NUM_VGAKEYMAPS	(1<<KG_CAPSSHIFT)
     63 static Uint16 vga_keymap[NUM_VGAKEYMAPS][NR_KEYS];
     64 static SDLKey keymap[128];
     65 static Uint16 keymap_temp[128]; /* only used at startup */
     66 static SDL_keysym *TranslateKey(int scancode, SDL_keysym *keysym);
     67 
     68 /* Ugh, we have to duplicate the kernel's keysym mapping code...
     69    Oh, it's not so bad. :-)
     70 
     71    FIXME: Add keyboard LED handling code
     72  */
     73 static void FB_vgainitkeymaps(int fd)
     74 {
     75 	struct kbentry entry;
     76 	int map, i;
     77 
     78 	/* Don't do anything if we are passed a closed keyboard */
     79 	if ( fd < 0 ) {
     80 		return;
     81 	}
     82 
     83 	/* Load all the keysym mappings */
     84 	for ( map=0; map<NUM_VGAKEYMAPS; ++map ) {
     85 		SDL_memset(vga_keymap[map], 0, NR_KEYS*sizeof(Uint16));
     86 		for ( i=0; i<NR_KEYS; ++i ) {
     87 			entry.kb_table = map;
     88 			entry.kb_index = i;
     89 			if ( ioctl(fd, KDGKBENT, &entry) == 0 ) {
     90 				/* fill keytemp. This replaces SDL_fbkeys.h */
     91 				if ( (map == 0) && (i<128) ) {
     92 					keymap_temp[i] = entry.kb_value;
     93 				}
     94 				/* The "Enter" key is a special case */
     95 				if ( entry.kb_value == K_ENTER ) {
     96 					entry.kb_value = K(KT_ASCII,13);
     97 				}
     98 				/* Handle numpad specially as well */
     99 				if ( KTYP(entry.kb_value) == KT_PAD ) {
    100 					switch ( entry.kb_value ) {
    101 					case K_P0:
    102 					case K_P1:
    103 					case K_P2:
    104 					case K_P3:
    105 					case K_P4:
    106 					case K_P5:
    107 					case K_P6:
    108 					case K_P7:
    109 					case K_P8:
    110 					case K_P9:
    111 						vga_keymap[map][i]=entry.kb_value;
    112 						vga_keymap[map][i]+= '0';
    113 						break;
    114 										case K_PPLUS:
    115 						vga_keymap[map][i]=K(KT_ASCII,'+');
    116 						break;
    117 										case K_PMINUS:
    118 						vga_keymap[map][i]=K(KT_ASCII,'-');
    119 						break;
    120 										case K_PSTAR:
    121 						vga_keymap[map][i]=K(KT_ASCII,'*');
    122 						break;
    123 										case K_PSLASH:
    124 						vga_keymap[map][i]=K(KT_ASCII,'/');
    125 						break;
    126 										case K_PENTER:
    127 						vga_keymap[map][i]=K(KT_ASCII,'\r');
    128 						break;
    129 										case K_PCOMMA:
    130 						vga_keymap[map][i]=K(KT_ASCII,',');
    131 						break;
    132 										case K_PDOT:
    133 						vga_keymap[map][i]=K(KT_ASCII,'.');
    134 						break;
    135 					default:
    136 						break;
    137 					}
    138 				}
    139 				/* Do the normal key translation */
    140 				if ( (KTYP(entry.kb_value) == KT_LATIN) ||
    141 					 (KTYP(entry.kb_value) == KT_ASCII) ||
    142 					 (KTYP(entry.kb_value) == KT_LETTER) ) {
    143 					vga_keymap[map][i] = entry.kb_value;
    144 				}
    145 			}
    146 		}
    147 	}
    148 }
    149 
    150 int FB_InGraphicsMode(_THIS)
    151 {
    152 	return((keyboard_fd >= 0) && (saved_kbd_mode >= 0));
    153 }
    154 
    155 int FB_EnterGraphicsMode(_THIS)
    156 {
    157 	struct termios keyboard_termios;
    158 
    159 	/* Set medium-raw keyboard mode */
    160 	if ( (keyboard_fd >= 0) && !FB_InGraphicsMode(this) ) {
    161 
    162 		/* Switch to the correct virtual terminal */
    163 		if ( current_vt > 0 ) {
    164 			struct vt_stat vtstate;
    165 
    166 			if ( ioctl(keyboard_fd, VT_GETSTATE, &vtstate) == 0 ) {
    167 				saved_vt = vtstate.v_active;
    168 			}
    169 			if ( ioctl(keyboard_fd, VT_ACTIVATE, current_vt) == 0 ) {
    170 				ioctl(keyboard_fd, VT_WAITACTIVE, current_vt);
    171 			}
    172 		}
    173 
    174 		/* Set the terminal input mode */
    175 		if ( tcgetattr(keyboard_fd, &saved_kbd_termios) < 0 ) {
    176 			SDL_SetError("Unable to get terminal attributes");
    177 			if ( keyboard_fd > 0 ) {
    178 				close(keyboard_fd);
    179 			}
    180 			keyboard_fd = -1;
    181 			return(-1);
    182 		}
    183 		if ( ioctl(keyboard_fd, KDGKBMODE, &saved_kbd_mode) < 0 ) {
    184 			SDL_SetError("Unable to get current keyboard mode");
    185 			if ( keyboard_fd > 0 ) {
    186 				close(keyboard_fd);
    187 			}
    188 			keyboard_fd = -1;
    189 			return(-1);
    190 		}
    191 		keyboard_termios = saved_kbd_termios;
    192 		keyboard_termios.c_lflag &= ~(ICANON | ECHO | ISIG);
    193 		keyboard_termios.c_iflag &= ~(ISTRIP | IGNCR | ICRNL | INLCR | IXOFF | IXON);
    194 		keyboard_termios.c_cc[VMIN] = 0;
    195 		keyboard_termios.c_cc[VTIME] = 0;
    196 		if (tcsetattr(keyboard_fd, TCSAFLUSH, &keyboard_termios) < 0) {
    197 			FB_CloseKeyboard(this);
    198 			SDL_SetError("Unable to set terminal attributes");
    199 			return(-1);
    200 		}
    201 		/* This will fail if we aren't root or this isn't our tty */
    202 		if ( ioctl(keyboard_fd, KDSKBMODE, K_MEDIUMRAW) < 0 ) {
    203 			FB_CloseKeyboard(this);
    204 			SDL_SetError("Unable to set keyboard in raw mode");
    205 			return(-1);
    206 		}
    207 		if ( ioctl(keyboard_fd, KDSETMODE, KD_GRAPHICS) < 0 ) {
    208 			FB_CloseKeyboard(this);
    209 			SDL_SetError("Unable to set keyboard in graphics mode");
    210 			return(-1);
    211 		}
    212 		/* Prevent switching the virtual terminal */
    213 		ioctl(keyboard_fd, VT_LOCKSWITCH, 1);
    214 	}
    215 	return(keyboard_fd);
    216 }
    217 
    218 void FB_LeaveGraphicsMode(_THIS)
    219 {
    220 	if ( FB_InGraphicsMode(this) ) {
    221 		ioctl(keyboard_fd, KDSETMODE, KD_TEXT);
    222 		ioctl(keyboard_fd, KDSKBMODE, saved_kbd_mode);
    223 		tcsetattr(keyboard_fd, TCSAFLUSH, &saved_kbd_termios);
    224 		saved_kbd_mode = -1;
    225 
    226 		/* Head back over to the original virtual terminal */
    227 		ioctl(keyboard_fd, VT_UNLOCKSWITCH, 1);
    228 		if ( saved_vt > 0 ) {
    229 			ioctl(keyboard_fd, VT_ACTIVATE, saved_vt);
    230 		}
    231 	}
    232 }
    233 
    234 void FB_CloseKeyboard(_THIS)
    235 {
    236 	if ( keyboard_fd >= 0 ) {
    237 		FB_LeaveGraphicsMode(this);
    238 		if ( keyboard_fd > 0 ) {
    239 			close(keyboard_fd);
    240 		}
    241 	}
    242 	keyboard_fd = -1;
    243 }
    244 
    245 int FB_OpenKeyboard(_THIS)
    246 {
    247 	/* Open only if not already opened */
    248  	if ( keyboard_fd < 0 ) {
    249 		static const char * const tty0[] = { "/dev/tty0", "/dev/vc/0", NULL };
    250 		static const char * const vcs[] = { "/dev/vc/%d", "/dev/tty%d", NULL };
    251 		int i, tty0_fd;
    252 
    253 		/* Try to query for a free virtual terminal */
    254 		tty0_fd = -1;
    255 		for ( i=0; tty0[i] && (tty0_fd < 0); ++i ) {
    256 			tty0_fd = open(tty0[i], O_WRONLY, 0);
    257 		}
    258 		if ( tty0_fd < 0 ) {
    259 			tty0_fd = dup(0); /* Maybe stdin is a VT? */
    260 		}
    261 		ioctl(tty0_fd, VT_OPENQRY, &current_vt);
    262 		close(tty0_fd);
    263 		if ( (geteuid() == 0) && (current_vt > 0) ) {
    264 			for ( i=0; vcs[i] && (keyboard_fd < 0); ++i ) {
    265 				char vtpath[12];
    266 
    267 				SDL_snprintf(vtpath, SDL_arraysize(vtpath), vcs[i], current_vt);
    268 				keyboard_fd = open(vtpath, O_RDWR, 0);
    269 #ifdef DEBUG_KEYBOARD
    270 				fprintf(stderr, "vtpath = %s, fd = %d\n",
    271 					vtpath, keyboard_fd);
    272 #endif /* DEBUG_KEYBOARD */
    273 
    274 				/* This needs to be our controlling tty
    275 				   so that the kernel ioctl() calls work
    276 				*/
    277 				if ( keyboard_fd >= 0 ) {
    278 					tty0_fd = open("/dev/tty", O_RDWR, 0);
    279 					if ( tty0_fd >= 0 ) {
    280 						ioctl(tty0_fd, TIOCNOTTY, 0);
    281 						close(tty0_fd);
    282 					}
    283 				}
    284 			}
    285 		}
    286  		if ( keyboard_fd < 0 ) {
    287 			/* Last resort, maybe our tty is a usable VT */
    288 			struct vt_stat vtstate;
    289 
    290 			keyboard_fd = open("/dev/tty", O_RDWR);
    291 
    292 			if ( ioctl(keyboard_fd, VT_GETSTATE, &vtstate) == 0 ) {
    293 				current_vt = vtstate.v_active;
    294 			} else {
    295 				current_vt = 0;
    296 			}
    297  		}
    298 #ifdef DEBUG_KEYBOARD
    299 		fprintf(stderr, "Current VT: %d\n", current_vt);
    300 #endif
    301  		saved_kbd_mode = -1;
    302 
    303 		/* Make sure that our input is a console terminal */
    304 		{ int dummy;
    305 		  if ( ioctl(keyboard_fd, KDGKBMODE, &dummy) < 0 ) {
    306 			close(keyboard_fd);
    307 			keyboard_fd = -1;
    308 			SDL_SetError("Unable to open a console terminal");
    309 		  }
    310 		}
    311 
    312 		/* Set up keymap */
    313 		FB_vgainitkeymaps(keyboard_fd);
    314  	}
    315  	return(keyboard_fd);
    316 }
    317 
    318 static enum {
    319 	MOUSE_NONE = -1,
    320 	MOUSE_MSC,	/* Note: GPM uses the MSC protocol */
    321 	MOUSE_PS2,
    322 	MOUSE_IMPS2,
    323 	MOUSE_MS,
    324 	MOUSE_BM,
    325 	MOUSE_ELO,
    326 	MOUSE_TSLIB,
    327 	NUM_MOUSE_DRVS
    328 } mouse_drv = MOUSE_NONE;
    329 
    330 void FB_CloseMouse(_THIS)
    331 {
    332 #if SDL_INPUT_TSLIB
    333 	if (ts_dev != NULL) {
    334 		ts_close(ts_dev);
    335 		ts_dev = NULL;
    336 		mouse_fd = -1;
    337 	}
    338 #endif /* SDL_INPUT_TSLIB */
    339 	if ( mouse_fd > 0 ) {
    340 		close(mouse_fd);
    341 	}
    342 	mouse_fd = -1;
    343 }
    344 
    345 /* Returns processes listed in /proc with the desired name */
    346 static int find_pid(DIR *proc, const char *wanted_name)
    347 {
    348 	struct dirent *entry;
    349 	int pid;
    350 
    351 	/* First scan proc for the gpm process */
    352 	pid = 0;
    353 	while ( (pid == 0) && ((entry=readdir(proc)) != NULL) ) {
    354 		if ( isdigit(entry->d_name[0]) ) {
    355 			FILE *status;
    356 			char path[PATH_MAX];
    357 			char name[PATH_MAX];
    358 
    359 			SDL_snprintf(path, SDL_arraysize(path), "/proc/%s/status", entry->d_name);
    360 			status=fopen(path, "r");
    361 			if ( status ) {
    362 				name[0] = '\0';
    363 				fscanf(status, "Name: %s", name);
    364 				if ( SDL_strcmp(name, wanted_name) == 0 ) {
    365 					pid = SDL_atoi(entry->d_name);
    366 				}
    367 				fclose(status);
    368 			}
    369 		}
    370 	}
    371 	return pid;
    372 }
    373 
    374 /* Returns true if /dev/gpmdata is being written to by gpm */
    375 static int gpm_available(char *proto, size_t protolen)
    376 {
    377 	int available;
    378 	DIR *proc;
    379 	int pid;
    380 	int cmdline, len, arglen;
    381 	char path[PATH_MAX];
    382 	char args[PATH_MAX], *arg;
    383 
    384 	/* Don't bother looking if the fifo isn't there */
    385 #ifdef DEBUG_MOUSE
    386 	fprintf(stderr,"testing gpm\n");
    387 #endif
    388 	if ( access(GPM_NODE_FIFO, F_OK) < 0 ) {
    389 		return(0);
    390 	}
    391 
    392 	available = 0;
    393 	proc = opendir("/proc");
    394 	if ( proc ) {
    395 		char raw_proto[10] = { '\0' };
    396 		char repeat_proto[10] = { '\0' };
    397 		while ( !available && (pid=find_pid(proc, "gpm")) > 0 ) {
    398 			SDL_snprintf(path, SDL_arraysize(path), "/proc/%d/cmdline", pid);
    399 			cmdline = open(path, O_RDONLY, 0);
    400 			if ( cmdline >= 0 ) {
    401 				len = read(cmdline, args, sizeof(args));
    402 				arg = args;
    403 				while ( len > 0 ) {
    404 					arglen = SDL_strlen(arg)+1;
    405 #ifdef DEBUG_MOUSE
    406 				        fprintf(stderr,"gpm arg %s len %d\n",arg,arglen);
    407 #endif
    408 					if ( SDL_strcmp(arg, "-t") == 0) {
    409 						/* protocol string, keep it for later */
    410 						char *t, *s;
    411 						t = arg + arglen;
    412 						s = SDL_strchr(t, ' ');
    413 						if (s) *s = 0;
    414 						SDL_strlcpy(raw_proto, t, SDL_arraysize(raw_proto));
    415 						if (s) *s = ' ';
    416 					}
    417 					if ( SDL_strncmp(arg, "-R", 2) == 0 ) {
    418 						char *t, *s;
    419 						available = 1;
    420 						t = arg + 2;
    421 						s = SDL_strchr(t, ' ');
    422 						if (s) *s = 0;
    423 						SDL_strlcpy(repeat_proto, t, SDL_arraysize(repeat_proto));
    424 						if (s) *s = ' ';
    425 					}
    426 					len -= arglen;
    427 					arg += arglen;
    428 				}
    429 				close(cmdline);
    430 			}
    431 		}
    432 		closedir(proc);
    433 
    434 		if ( available ) {
    435 			if ( SDL_strcmp(repeat_proto, "raw") == 0 ) {
    436 				SDL_strlcpy(proto, raw_proto, protolen);
    437 			} else if ( *repeat_proto ) {
    438 				SDL_strlcpy(proto, repeat_proto, protolen);
    439 			} else {
    440 				SDL_strlcpy(proto, "msc", protolen);
    441 			}
    442 		}
    443 	}
    444 	return available;
    445 }
    446 
    447 
    448 /* rcg06112001 Set up IMPS/2 mode, if possible. This gives
    449  *  us access to the mousewheel, etc. Returns zero if
    450  *  writes to device failed, but you still need to query the
    451  *  device to see which mode it's actually in.
    452  */
    453 static int set_imps2_mode(int fd)
    454 {
    455 	/* If you wanted to control the mouse mode (and we do :)  ) ...
    456 		Set IMPS/2 protocol:
    457 			{0xf3,200,0xf3,100,0xf3,80}
    458 		Reset mouse device:
    459 			{0xFF}
    460 	*/
    461 	Uint8 set_imps2[] = {0xf3, 200, 0xf3, 100, 0xf3, 80};
    462 	/*Uint8 reset = 0xff;*/
    463 	fd_set fdset;
    464 	struct timeval tv;
    465 	int retval = 0;
    466 
    467 	if ( write(fd, &set_imps2, sizeof(set_imps2)) == sizeof(set_imps2) ) {
    468 		/* Don't reset it, that'll clear IMPS/2 mode on some mice
    469 		if (write(fd, &reset, sizeof (reset)) == sizeof (reset) ) {
    470 			retval = 1;
    471 		}
    472 		*/
    473 	}
    474 
    475 	/* Get rid of any chatter from the above */
    476 	FD_ZERO(&fdset);
    477 	FD_SET(fd, &fdset);
    478 	tv.tv_sec = 0;
    479 	tv.tv_usec = 0;
    480 	while ( select(fd+1, &fdset, 0, 0, &tv) > 0 ) {
    481 		char temp[32];
    482 		read(fd, temp, sizeof(temp));
    483 	}
    484 
    485 	return retval;
    486 }
    487 
    488 
    489 /* Returns true if the mouse uses the IMPS/2 protocol */
    490 static int detect_imps2(int fd)
    491 {
    492 	int imps2;
    493 
    494 	imps2 = 0;
    495 
    496 	if ( SDL_getenv("SDL_MOUSEDEV_IMPS2") ) {
    497 		imps2 = 1;
    498 	}
    499 	if ( ! imps2 ) {
    500 		Uint8 query_ps2 = 0xF2;
    501 		fd_set fdset;
    502 		struct timeval tv;
    503 
    504 		/* Get rid of any mouse motion noise */
    505 		FD_ZERO(&fdset);
    506 		FD_SET(fd, &fdset);
    507 		tv.tv_sec = 0;
    508 		tv.tv_usec = 0;
    509 		while ( select(fd+1, &fdset, 0, 0, &tv) > 0 ) {
    510 			char temp[32];
    511 			read(fd, temp, sizeof(temp));
    512 		}
    513 
    514    		/* Query for the type of mouse protocol */
    515    		if ( write(fd, &query_ps2, sizeof (query_ps2)) == sizeof (query_ps2)) {
    516    			Uint8 ch = 0;
    517 
    518 			/* Get the mouse protocol response */
    519 			do {
    520 				FD_ZERO(&fdset);
    521 				FD_SET(fd, &fdset);
    522 				tv.tv_sec = 1;
    523 				tv.tv_usec = 0;
    524 				if ( select(fd+1, &fdset, 0, 0, &tv) < 1 ) {
    525 					break;
    526 				}
    527 			} while ( (read(fd, &ch, sizeof (ch)) == sizeof (ch)) &&
    528 			          ((ch == 0xFA) || (ch == 0xAA)) );
    529 
    530 			/* Experimental values (Logitech wheelmouse) */
    531 #ifdef DEBUG_MOUSE
    532 fprintf(stderr, "Last mouse mode: 0x%x\n", ch);
    533 #endif
    534 			if ( (ch == 3) || (ch == 4) ) {
    535 				imps2 = 1;
    536 			}
    537 		}
    538 	}
    539 	return imps2;
    540 }
    541 
    542 int FB_OpenMouse(_THIS)
    543 {
    544 	int i;
    545 	const char *mousedev;
    546 	const char *mousedrv;
    547 
    548 	mousedrv = SDL_getenv("SDL_MOUSEDRV");
    549 	mousedev = SDL_getenv("SDL_MOUSEDEV");
    550 	mouse_fd = -1;
    551 
    552 #if SDL_INPUT_TSLIB
    553 	if ( mousedrv && (SDL_strcmp(mousedrv, "TSLIB") == 0) ) {
    554 		if (mousedev == NULL) mousedev = SDL_getenv("TSLIB_TSDEVICE");
    555 		if (mousedev != NULL) {
    556 			ts_dev = ts_open(mousedev, 1);
    557 			if ((ts_dev != NULL) && (ts_config(ts_dev) >= 0)) {
    558 #ifdef DEBUG_MOUSE
    559 				fprintf(stderr, "Using tslib touchscreen\n");
    560 #endif
    561 				mouse_drv = MOUSE_TSLIB;
    562 				mouse_fd = ts_fd(ts_dev);
    563 				return mouse_fd;
    564 			}
    565 		}
    566 		mouse_drv = MOUSE_NONE;
    567 		return mouse_fd;
    568 	}
    569 #endif /* SDL_INPUT_TSLIB */
    570 
    571 	/* ELO TOUCHSCREEN SUPPORT */
    572 
    573 	if ( mousedrv && (SDL_strcmp(mousedrv, "ELO") == 0) ) {
    574 		mouse_fd = open(mousedev, O_RDWR);
    575 		if ( mouse_fd >= 0 ) {
    576 			if(eloInitController(mouse_fd)) {
    577 #ifdef DEBUG_MOUSE
    578 fprintf(stderr, "Using ELO touchscreen\n");
    579 #endif
    580    				mouse_drv = MOUSE_ELO;
    581 			}
    582 
    583 		}
    584 		else if ( mouse_fd < 0 ) {
    585 			mouse_drv = MOUSE_NONE;
    586 		}
    587 
    588 		return(mouse_fd);
    589 	}
    590 
    591 	/* STD MICE */
    592 
    593 	if ( mousedev == NULL ) {
    594 		/* FIXME someday... allow multiple mice in this driver */
    595 		static const char *ps2mice[] = {
    596 		    "/dev/input/mice", "/dev/usbmouse", "/dev/psaux", NULL
    597 		};
    598 		/* First try to use GPM in repeater mode */
    599 		if ( mouse_fd < 0 ) {
    600 			char proto[10];
    601 			if ( gpm_available(proto, SDL_arraysize(proto)) ) {
    602 				mouse_fd = open(GPM_NODE_FIFO, O_RDONLY, 0);
    603 				if ( mouse_fd >= 0 ) {
    604 					if ( SDL_strcmp(proto, "msc") == 0 ) {
    605 						mouse_drv = MOUSE_MSC;
    606 					} else if ( SDL_strcmp(proto, "ps2") == 0 ) {
    607 						mouse_drv = MOUSE_PS2;
    608 					} else if ( SDL_strcmp(proto, "imps2") == 0 ) {
    609 						mouse_drv = MOUSE_IMPS2;
    610 					} else if ( SDL_strcmp(proto, "ms") == 0 ||
    611 					            SDL_strcmp(proto, "bare") == 0 ) {
    612 						mouse_drv = MOUSE_MS;
    613 					} else if ( SDL_strcmp(proto, "bm") == 0 ) {
    614 						mouse_drv = MOUSE_BM;
    615 					} else {
    616 						/* Unknown protocol... */
    617 #ifdef DEBUG_MOUSE
    618 						fprintf(stderr, "GPM mouse using unknown protocol = %s\n", proto);
    619 #endif
    620 						close(mouse_fd);
    621 						mouse_fd = -1;
    622 					}
    623 				}
    624 #ifdef DEBUG_MOUSE
    625 				if ( mouse_fd >= 0 ) {
    626 					fprintf(stderr, "Using GPM mouse, protocol = %s\n", proto);
    627 				}
    628 #endif /* DEBUG_MOUSE */
    629 			}
    630 		}
    631 		/* Now try to use a modern PS/2 mouse */
    632 		for ( i=0; (mouse_fd < 0) && ps2mice[i]; ++i ) {
    633 			mouse_fd = open(ps2mice[i], O_RDWR, 0);
    634 			if (mouse_fd < 0) {
    635 				mouse_fd = open(ps2mice[i], O_RDONLY, 0);
    636 			}
    637 			if (mouse_fd >= 0) {
    638 				/* rcg06112001 Attempt to set IMPS/2 mode */
    639 				set_imps2_mode(mouse_fd);
    640 				if (detect_imps2(mouse_fd)) {
    641 #ifdef DEBUG_MOUSE
    642 fprintf(stderr, "Using IMPS2 mouse\n");
    643 #endif
    644 					mouse_drv = MOUSE_IMPS2;
    645 				} else {
    646 #ifdef DEBUG_MOUSE
    647 fprintf(stderr, "Using PS2 mouse\n");
    648 #endif
    649 					mouse_drv = MOUSE_PS2;
    650 				}
    651 			}
    652 		}
    653 		/* Next try to use a PPC ADB port mouse */
    654 		if ( mouse_fd < 0 ) {
    655 			mouse_fd = open("/dev/adbmouse", O_RDONLY, 0);
    656 			if ( mouse_fd >= 0 ) {
    657 #ifdef DEBUG_MOUSE
    658 fprintf(stderr, "Using ADB mouse\n");
    659 #endif
    660 				mouse_drv = MOUSE_BM;
    661 			}
    662 		}
    663 	}
    664 	/* Default to a serial Microsoft mouse */
    665 	if ( mouse_fd < 0 ) {
    666 		if ( mousedev == NULL ) {
    667 			mousedev = "/dev/mouse";
    668 		}
    669 		mouse_fd = open(mousedev, O_RDONLY, 0);
    670 		if ( mouse_fd >= 0 ) {
    671 			struct termios mouse_termios;
    672 
    673 			/* Set the sampling speed to 1200 baud */
    674 			tcgetattr(mouse_fd, &mouse_termios);
    675 			mouse_termios.c_iflag = IGNBRK | IGNPAR;
    676 			mouse_termios.c_oflag = 0;
    677 			mouse_termios.c_lflag = 0;
    678 			mouse_termios.c_line = 0;
    679 			mouse_termios.c_cc[VTIME] = 0;
    680 			mouse_termios.c_cc[VMIN] = 1;
    681 			mouse_termios.c_cflag = CREAD | CLOCAL | HUPCL;
    682 			mouse_termios.c_cflag |= CS8;
    683 			mouse_termios.c_cflag |= B1200;
    684 			tcsetattr(mouse_fd, TCSAFLUSH, &mouse_termios);
    685 			if ( mousedrv && (SDL_strcmp(mousedrv, "PS2") == 0) ) {
    686 #ifdef DEBUG_MOUSE
    687 fprintf(stderr, "Using (user specified) PS2 mouse on %s\n", mousedev);
    688 #endif
    689 				mouse_drv = MOUSE_PS2;
    690 			} else {
    691 #ifdef DEBUG_MOUSE
    692 fprintf(stderr, "Using (default) MS mouse on %s\n", mousedev);
    693 #endif
    694 				mouse_drv = MOUSE_MS;
    695 			}
    696 		}
    697 	}
    698 	if ( mouse_fd < 0 ) {
    699 		mouse_drv = MOUSE_NONE;
    700 	}
    701 	return(mouse_fd);
    702 }
    703 
    704 static int posted = 0;
    705 
    706 void FB_vgamousecallback(int button, int relative, int dx, int dy)
    707 {
    708 	int button_1, button_3;
    709 	int button_state;
    710 	int state_changed;
    711 	int i;
    712 	Uint8 state;
    713 
    714 	if ( dx || dy ) {
    715 		posted += SDL_PrivateMouseMotion(0, relative, dx, dy);
    716 	}
    717 
    718 	/* Swap button 1 and 3 */
    719 	button_1 = (button & 0x04) >> 2;
    720 	button_3 = (button & 0x01) << 2;
    721 	button &= ~0x05;
    722 	button |= (button_1|button_3);
    723 
    724 	/* See what changed */
    725 	button_state = SDL_GetMouseState(NULL, NULL);
    726 	state_changed = button_state ^ button;
    727 	for ( i=0; i<8; ++i ) {
    728 		if ( state_changed & (1<<i) ) {
    729 			if ( button & (1<<i) ) {
    730 				state = SDL_PRESSED;
    731 			} else {
    732 				state = SDL_RELEASED;
    733 			}
    734 			posted += SDL_PrivateMouseButton(state, i+1, 0, 0);
    735 		}
    736 	}
    737 }
    738 
    739 /* Handle input from tslib */
    740 #if SDL_INPUT_TSLIB
    741 static void handle_tslib(_THIS)
    742 {
    743 	struct ts_sample sample;
    744 	int button;
    745 
    746 	while (ts_read(ts_dev, &sample, 1) > 0) {
    747 		button = (sample.pressure > 0) ? 1 : 0;
    748 		button <<= 2;	/* must report it as button 3 */
    749 		FB_vgamousecallback(button, 0, sample.x, sample.y);
    750 	}
    751 	return;
    752 }
    753 #endif /* SDL_INPUT_TSLIB */
    754 
    755 /* For now, use MSC, PS/2, and MS protocols
    756    Driver adapted from the SVGAlib mouse driver code (taken from gpm, etc.)
    757  */
    758 static void handle_mouse(_THIS)
    759 {
    760 	static int start = 0;
    761 	static unsigned char mousebuf[BUFSIZ];
    762 	static int relative = 1;
    763 
    764 	int i, nread;
    765 	int button = 0;
    766 	int dx = 0, dy = 0;
    767 	int packetsize = 0;
    768 	int realx, realy;
    769 
    770 	/* Figure out the mouse packet size */
    771 	switch (mouse_drv) {
    772 		case MOUSE_NONE:
    773 			/* Ack! */
    774 			read(mouse_fd, mousebuf, BUFSIZ);
    775 			return;
    776 		case MOUSE_MSC:
    777 			packetsize = 5;
    778 			break;
    779 		case MOUSE_IMPS2:
    780 			packetsize = 4;
    781 			break;
    782 		case MOUSE_PS2:
    783 		case MOUSE_MS:
    784 		case MOUSE_BM:
    785 			packetsize = 3;
    786 			break;
    787 		case MOUSE_ELO:
    788 			/* try to read the next packet */
    789 			if(eloReadPosition(this, mouse_fd, &dx, &dy, &button, &realx, &realy)) {
    790 				button = (button & 0x01) << 2;
    791 				FB_vgamousecallback(button, 0, dx, dy);
    792 			}
    793 			return; /* nothing left to do */
    794 		case MOUSE_TSLIB:
    795 #if SDL_INPUT_TSLIB
    796 			handle_tslib(this);
    797 #endif
    798 			return; /* nothing left to do */
    799 		default:
    800 			/* Uh oh.. */
    801 			packetsize = 0;
    802 			break;
    803 	}
    804 
    805 	/* Special handling for the quite sensitive ELO controller */
    806 	if (mouse_drv == MOUSE_ELO) {
    807 
    808 	}
    809 
    810 	/* Read as many packets as possible */
    811 	nread = read(mouse_fd, &mousebuf[start], BUFSIZ-start);
    812 	if ( nread < 0 ) {
    813 		return;
    814 	}
    815 	nread += start;
    816 #ifdef DEBUG_MOUSE
    817 	fprintf(stderr, "Read %d bytes from mouse, start = %d\n", nread, start);
    818 #endif
    819 	for ( i=0; i<(nread-(packetsize-1)); i += packetsize ) {
    820 		switch (mouse_drv) {
    821 			case MOUSE_NONE:
    822 				break;
    823 			case MOUSE_MSC:
    824 				/* MSC protocol has 0x80 in high byte */
    825 				if ( (mousebuf[i] & 0xF8) != 0x80 ) {
    826 					/* Go to next byte */
    827 					i -= (packetsize-1);
    828 					continue;
    829 				}
    830 				/* Get current mouse state */
    831 				button = (~mousebuf[i]) & 0x07;
    832 				dx =   (signed char)(mousebuf[i+1]) +
    833 				       (signed char)(mousebuf[i+3]);
    834 				dy = -((signed char)(mousebuf[i+2]) +
    835 				       (signed char)(mousebuf[i+4]));
    836 				break;
    837 			case MOUSE_PS2:
    838 				/* PS/2 protocol has nothing in high byte */
    839 				if ( (mousebuf[i] & 0xC0) != 0 ) {
    840 					/* Go to next byte */
    841 					i -= (packetsize-1);
    842 					continue;
    843 				}
    844 				/* Get current mouse state */
    845 				button = (mousebuf[i] & 0x04) >> 1 | /*Middle*/
    846 		  			 (mousebuf[i] & 0x02) >> 1 | /*Right*/
    847 		  			 (mousebuf[i] & 0x01) << 2;  /*Left*/
    848 		  		dx = (mousebuf[i] & 0x10) ?
    849 		  		      mousebuf[i+1] - 256 : mousebuf[i+1];
    850 		  		dy = (mousebuf[i] & 0x20) ?
    851 		  		      -(mousebuf[i+2] - 256) : -mousebuf[i+2];
    852 				break;
    853 			case MOUSE_IMPS2:
    854 				/* Get current mouse state */
    855 				button = (mousebuf[i] & 0x04) >> 1 | /*Middle*/
    856 		  			 (mousebuf[i] & 0x02) >> 1 | /*Right*/
    857 		  			 (mousebuf[i] & 0x01) << 2 | /*Left*/
    858 		  			 (mousebuf[i] & 0x40) >> 3 | /* 4 */
    859 		  			 (mousebuf[i] & 0x80) >> 3;  /* 5 */
    860 		  		dx = (mousebuf[i] & 0x10) ?
    861 		  		      mousebuf[i+1] - 256 : mousebuf[i+1];
    862 		  		dy = (mousebuf[i] & 0x20) ?
    863 		  		      -(mousebuf[i+2] - 256) : -mousebuf[i+2];
    864 				switch (mousebuf[i+3]&0x0F) {
    865 				    case 0x0E: /* DX = +1 */
    866 				    case 0x02: /* DX = -1 */
    867 					break;
    868 				    case 0x0F: /* DY = +1 (map button 4) */
    869                                        FB_vgamousecallback(button | (1<<3),
    870                                                            1, 0, 0);
    871 					break;
    872 				    case 0x01: /* DY = -1 (map button 5) */
    873                                        FB_vgamousecallback(button | (1<<4),
    874                                                            1, 0, 0);
    875 					break;
    876 				}
    877 				break;
    878 			case MOUSE_MS:
    879 				/* Microsoft protocol has 0x40 in high byte */
    880 				if ( (mousebuf[i] & 0x40) != 0x40 ) {
    881 					/* Go to next byte */
    882 					i -= (packetsize-1);
    883 					continue;
    884 				}
    885 				/* Get current mouse state */
    886 				button = ((mousebuf[i] & 0x20) >> 3) |
    887 				         ((mousebuf[i] & 0x10) >> 4);
    888 				dx = (signed char)(((mousebuf[i] & 0x03) << 6) |
    889 				                   (mousebuf[i + 1] & 0x3F));
    890 				dy = (signed char)(((mousebuf[i] & 0x0C) << 4) |
    891 				                    (mousebuf[i + 2] & 0x3F));
    892 				break;
    893 			case MOUSE_BM:
    894 				/* BusMouse protocol has 0xF8 in high byte */
    895 				if ( (mousebuf[i] & 0xF8) != 0x80 ) {
    896 					/* Go to next byte */
    897 					i -= (packetsize-1);
    898 					continue;
    899 				}
    900 				/* Get current mouse state */
    901 				button = (~mousebuf[i]) & 0x07;
    902 				dx =  (signed char)mousebuf[i+1];
    903 				dy = -(signed char)mousebuf[i+2];
    904 				break;
    905 			default:
    906 				/* Uh oh.. */
    907 				dx = 0;
    908 				dy = 0;
    909 				break;
    910 		}
    911 		FB_vgamousecallback(button, relative, dx, dy);
    912 	}
    913 	if ( i < nread ) {
    914 		SDL_memcpy(mousebuf, &mousebuf[i], (nread-i));
    915 		start = (nread-i);
    916 	} else {
    917 		start = 0;
    918 	}
    919 	return;
    920 }
    921 
    922 /* Handle switching to another VC, returns when our VC is back */
    923 static void switch_vt_prep(_THIS)
    924 {
    925 	SDL_Surface *screen = SDL_VideoSurface;
    926 
    927 	SDL_PrivateAppActive(0, (SDL_APPACTIVE|SDL_APPINPUTFOCUS|SDL_APPMOUSEFOCUS));
    928 
    929 	/* Save the contents of the screen, and go to text mode */
    930 	wait_idle(this);
    931 	screen_arealen = ((screen->h + (2*this->offset_y)) * screen->pitch);
    932 	screen_contents = (Uint8 *)SDL_malloc(screen_arealen);
    933 	if ( screen_contents ) {
    934 		SDL_memcpy(screen_contents, screen->pixels, screen_arealen);
    935 	}
    936 	FB_SavePaletteTo(this, 256, screen_palette);
    937 	ioctl(console_fd, FBIOGET_VSCREENINFO, &screen_vinfo);
    938 	ioctl(keyboard_fd, KDSETMODE, KD_TEXT);
    939 	ioctl(keyboard_fd, VT_UNLOCKSWITCH, 1);
    940 }
    941 static void switch_vt_done(_THIS)
    942 {
    943 	SDL_Surface *screen = SDL_VideoSurface;
    944 
    945 	/* Restore graphics mode and the contents of the screen */
    946 	ioctl(keyboard_fd, VT_LOCKSWITCH, 1);
    947 	ioctl(keyboard_fd, KDSETMODE, KD_GRAPHICS);
    948 	ioctl(console_fd, FBIOPUT_VSCREENINFO, &screen_vinfo);
    949 	FB_RestorePaletteFrom(this, 256, screen_palette);
    950 	if ( screen_contents ) {
    951 		SDL_memcpy(screen->pixels, screen_contents, screen_arealen);
    952 		SDL_free(screen_contents);
    953 		screen_contents = NULL;
    954 	}
    955 
    956 	/* Get updates to the shadow surface while switched away */
    957 	if ( SDL_ShadowSurface ) {
    958 		SDL_UpdateRect(SDL_ShadowSurface, 0, 0, 0, 0);
    959 	}
    960 
    961 	SDL_PrivateAppActive(1, (SDL_APPACTIVE|SDL_APPINPUTFOCUS|SDL_APPMOUSEFOCUS));
    962 }
    963 static void switch_vt(_THIS, unsigned short which)
    964 {
    965 	struct vt_stat vtstate;
    966 
    967 	/* Figure out whether or not we're switching to a new console */
    968 	if ( (ioctl(keyboard_fd, VT_GETSTATE, &vtstate) < 0) ||
    969 	     (which == vtstate.v_active) ) {
    970 		return;
    971 	}
    972 
    973 	/* New console, switch to it */
    974 	SDL_mutexP(hw_lock);
    975 	switch_vt_prep(this);
    976 	if ( ioctl(keyboard_fd, VT_ACTIVATE, which) == 0 ) {
    977 		ioctl(keyboard_fd, VT_WAITACTIVE, which);
    978 		switched_away = 1;
    979 	} else {
    980 		switch_vt_done(this);
    981 	}
    982 	SDL_mutexV(hw_lock);
    983 }
    984 
    985 static void handle_keyboard(_THIS)
    986 {
    987 	unsigned char keybuf[BUFSIZ];
    988 	int i, nread;
    989 	int pressed;
    990 	int scancode;
    991 	SDL_keysym keysym;
    992 
    993 	nread = read(keyboard_fd, keybuf, BUFSIZ);
    994 	for ( i=0; i<nread; ++i ) {
    995 		scancode = keybuf[i] & 0x7F;
    996 		if ( keybuf[i] & 0x80 ) {
    997 			pressed = SDL_RELEASED;
    998 		} else {
    999 			pressed = SDL_PRESSED;
   1000 		}
   1001 		TranslateKey(scancode, &keysym);
   1002 		/* Handle Ctrl-Alt-FN for vt switch */
   1003 		switch (keysym.sym) {
   1004 		    case SDLK_F1:
   1005 		    case SDLK_F2:
   1006 		    case SDLK_F3:
   1007 		    case SDLK_F4:
   1008 		    case SDLK_F5:
   1009 		    case SDLK_F6:
   1010 		    case SDLK_F7:
   1011 		    case SDLK_F8:
   1012 		    case SDLK_F9:
   1013 		    case SDLK_F10:
   1014 		    case SDLK_F11:
   1015 		    case SDLK_F12:
   1016 			if ( (SDL_GetModState() & KMOD_CTRL) &&
   1017 			     (SDL_GetModState() & KMOD_ALT) ) {
   1018 				if ( pressed ) {
   1019 					switch_vt(this, (keysym.sym-SDLK_F1)+1);
   1020 				}
   1021 				break;
   1022 			}
   1023 			/* Fall through to normal processing */
   1024 		    default:
   1025 			posted += SDL_PrivateKeyboard(pressed, &keysym);
   1026 			break;
   1027 		}
   1028 	}
   1029 }
   1030 
   1031 void FB_PumpEvents(_THIS)
   1032 {
   1033 	fd_set fdset;
   1034 	int max_fd;
   1035 	static struct timeval zero;
   1036 
   1037 	do {
   1038 		if ( switched_away ) {
   1039 			struct vt_stat vtstate;
   1040 
   1041 			SDL_mutexP(hw_lock);
   1042 			if ( (ioctl(keyboard_fd, VT_GETSTATE, &vtstate) == 0) &&
   1043 			     vtstate.v_active == current_vt ) {
   1044 				switched_away = 0;
   1045 				switch_vt_done(this);
   1046 			}
   1047 			SDL_mutexV(hw_lock);
   1048 		}
   1049 
   1050 		posted = 0;
   1051 
   1052 		FD_ZERO(&fdset);
   1053 		max_fd = 0;
   1054 		if ( keyboard_fd >= 0 ) {
   1055 			FD_SET(keyboard_fd, &fdset);
   1056 			if ( max_fd < keyboard_fd ) {
   1057 				max_fd = keyboard_fd;
   1058 			}
   1059 		}
   1060 		if ( mouse_fd >= 0 ) {
   1061 			FD_SET(mouse_fd, &fdset);
   1062 			if ( max_fd < mouse_fd ) {
   1063 				max_fd = mouse_fd;
   1064 			}
   1065 		}
   1066 		if ( select(max_fd+1, &fdset, NULL, NULL, &zero) > 0 ) {
   1067 			if ( keyboard_fd >= 0 ) {
   1068 				if ( FD_ISSET(keyboard_fd, &fdset) ) {
   1069 					handle_keyboard(this);
   1070 				}
   1071 			}
   1072 			if ( mouse_fd >= 0 ) {
   1073 				if ( FD_ISSET(mouse_fd, &fdset) ) {
   1074 					handle_mouse(this);
   1075 				}
   1076 			}
   1077 		}
   1078 	} while ( posted );
   1079 }
   1080 
   1081 void FB_InitOSKeymap(_THIS)
   1082 {
   1083 	int i;
   1084 
   1085 	/* Initialize the Linux key translation table */
   1086 
   1087 	/* First get the ascii keys and others not well handled */
   1088 	for (i=0; i<SDL_arraysize(keymap); ++i) {
   1089 	  switch(i) {
   1090 	  /* These aren't handled by the x86 kernel keymapping (?) */
   1091 	  case SCANCODE_PRINTSCREEN:
   1092 	    keymap[i] = SDLK_PRINT;
   1093 	    break;
   1094 	  case SCANCODE_BREAK:
   1095 	    keymap[i] = SDLK_BREAK;
   1096 	    break;
   1097 	  case SCANCODE_BREAK_ALTERNATIVE:
   1098 	    keymap[i] = SDLK_PAUSE;
   1099 	    break;
   1100 	  case SCANCODE_LEFTSHIFT:
   1101 	    keymap[i] = SDLK_LSHIFT;
   1102 	    break;
   1103 	  case SCANCODE_RIGHTSHIFT:
   1104 	    keymap[i] = SDLK_RSHIFT;
   1105 	    break;
   1106 	  case SCANCODE_LEFTCONTROL:
   1107 	    keymap[i] = SDLK_LCTRL;
   1108 	    break;
   1109 	  case SCANCODE_RIGHTCONTROL:
   1110 	    keymap[i] = SDLK_RCTRL;
   1111 	    break;
   1112 	  case SCANCODE_RIGHTWIN:
   1113 	    keymap[i] = SDLK_RSUPER;
   1114 	    break;
   1115 	  case SCANCODE_LEFTWIN:
   1116 	    keymap[i] = SDLK_LSUPER;
   1117 	    break;
   1118 	  case SCANCODE_LEFTALT:
   1119 	    keymap[i] = SDLK_LALT;
   1120 	    break;
   1121 	  case SCANCODE_RIGHTALT:
   1122 	    keymap[i] = SDLK_RALT;
   1123 	    break;
   1124 	  case 127:
   1125 	    keymap[i] = SDLK_MENU;
   1126 	    break;
   1127 	  /* this should take care of all standard ascii keys */
   1128 	  default:
   1129 	    keymap[i] = KVAL(vga_keymap[0][i]);
   1130 	    break;
   1131           }
   1132 	}
   1133 	for (i=0; i<SDL_arraysize(keymap); ++i) {
   1134 	  switch(keymap_temp[i]) {
   1135 	    case K_F1:  keymap[i] = SDLK_F1;  break;
   1136 	    case K_F2:  keymap[i] = SDLK_F2;  break;
   1137 	    case K_F3:  keymap[i] = SDLK_F3;  break;
   1138 	    case K_F4:  keymap[i] = SDLK_F4;  break;
   1139 	    case K_F5:  keymap[i] = SDLK_F5;  break;
   1140 	    case K_F6:  keymap[i] = SDLK_F6;  break;
   1141 	    case K_F7:  keymap[i] = SDLK_F7;  break;
   1142 	    case K_F8:  keymap[i] = SDLK_F8;  break;
   1143 	    case K_F9:  keymap[i] = SDLK_F9;  break;
   1144 	    case K_F10: keymap[i] = SDLK_F10; break;
   1145 	    case K_F11: keymap[i] = SDLK_F11; break;
   1146 	    case K_F12: keymap[i] = SDLK_F12; break;
   1147 
   1148 	    case K_DOWN:  keymap[i] = SDLK_DOWN;  break;
   1149 	    case K_LEFT:  keymap[i] = SDLK_LEFT;  break;
   1150 	    case K_RIGHT: keymap[i] = SDLK_RIGHT; break;
   1151 	    case K_UP:    keymap[i] = SDLK_UP;    break;
   1152 
   1153 	    case K_P0:     keymap[i] = SDLK_KP0; break;
   1154 	    case K_P1:     keymap[i] = SDLK_KP1; break;
   1155 	    case K_P2:     keymap[i] = SDLK_KP2; break;
   1156 	    case K_P3:     keymap[i] = SDLK_KP3; break;
   1157 	    case K_P4:     keymap[i] = SDLK_KP4; break;
   1158 	    case K_P5:     keymap[i] = SDLK_KP5; break;
   1159 	    case K_P6:     keymap[i] = SDLK_KP6; break;
   1160 	    case K_P7:     keymap[i] = SDLK_KP7; break;
   1161 	    case K_P8:     keymap[i] = SDLK_KP8; break;
   1162 	    case K_P9:     keymap[i] = SDLK_KP9; break;
   1163 	    case K_PPLUS:  keymap[i] = SDLK_KP_PLUS; break;
   1164 	    case K_PMINUS: keymap[i] = SDLK_KP_MINUS; break;
   1165 	    case K_PSTAR:  keymap[i] = SDLK_KP_MULTIPLY; break;
   1166 	    case K_PSLASH: keymap[i] = SDLK_KP_DIVIDE; break;
   1167 	    case K_PENTER: keymap[i] = SDLK_KP_ENTER; break;
   1168 	    case K_PDOT:   keymap[i] = SDLK_KP_PERIOD; break;
   1169 
   1170 	    case K_SHIFT:  if ( keymap[i] != SDLK_RSHIFT )
   1171 	                     keymap[i] = SDLK_LSHIFT;
   1172 	                   break;
   1173 	    case K_SHIFTL: keymap[i] = SDLK_LSHIFT; break;
   1174 	    case K_SHIFTR: keymap[i] = SDLK_RSHIFT; break;
   1175 	    case K_CTRL:  if ( keymap[i] != SDLK_RCTRL )
   1176 	                     keymap[i] = SDLK_LCTRL;
   1177 	                   break;
   1178 	    case K_CTRLL:  keymap[i] = SDLK_LCTRL;  break;
   1179 	    case K_CTRLR:  keymap[i] = SDLK_RCTRL;  break;
   1180 	    case K_ALT:    keymap[i] = SDLK_LALT;   break;
   1181 	    case K_ALTGR:  keymap[i] = SDLK_RALT;   break;
   1182 
   1183 	    case K_INSERT: keymap[i] = SDLK_INSERT;   break;
   1184 	    case K_REMOVE: keymap[i] = SDLK_DELETE;   break;
   1185 	    case K_PGUP:   keymap[i] = SDLK_PAGEUP;   break;
   1186 	    case K_PGDN:   keymap[i] = SDLK_PAGEDOWN; break;
   1187 	    case K_FIND:   keymap[i] = SDLK_HOME;     break;
   1188 	    case K_SELECT: keymap[i] = SDLK_END;      break;
   1189 
   1190 	    case K_NUM:  keymap[i] = SDLK_NUMLOCK;   break;
   1191 	    case K_CAPS: keymap[i] = SDLK_CAPSLOCK;  break;
   1192 
   1193 	    case K_F13:   keymap[i] = SDLK_PRINT;     break;
   1194 	    case K_HOLD:  keymap[i] = SDLK_SCROLLOCK; break;
   1195 	    case K_PAUSE: keymap[i] = SDLK_PAUSE;     break;
   1196 
   1197 	    case 127: keymap[i] = SDLK_BACKSPACE; break;
   1198 
   1199 	    default: break;
   1200 	  }
   1201 	}
   1202 }
   1203 
   1204 static SDL_keysym *TranslateKey(int scancode, SDL_keysym *keysym)
   1205 {
   1206 	/* Set the keysym information */
   1207 	keysym->scancode = scancode;
   1208 	keysym->sym = keymap[scancode];
   1209 	keysym->mod = KMOD_NONE;
   1210 
   1211 	/* If UNICODE is on, get the UNICODE value for the key */
   1212 	keysym->unicode = 0;
   1213 	if ( SDL_TranslateUNICODE ) {
   1214 		int map;
   1215 		SDLMod modstate;
   1216 
   1217 		modstate = SDL_GetModState();
   1218 		map = 0;
   1219 		if ( modstate & KMOD_SHIFT ) {
   1220 			map |= (1<<KG_SHIFT);
   1221 		}
   1222 		if ( modstate & KMOD_CTRL ) {
   1223 			map |= (1<<KG_CTRL);
   1224 		}
   1225 		if ( modstate & KMOD_LALT ) {
   1226 			map |= (1<<KG_ALT);
   1227 		}
   1228 		if ( modstate & KMOD_RALT ) {
   1229 			map |= (1<<KG_ALTGR);
   1230 		}
   1231 		if ( KTYP(vga_keymap[map][scancode]) == KT_LETTER ) {
   1232 			if ( modstate & KMOD_CAPS ) {
   1233 				map ^= (1<<KG_SHIFT);
   1234 			}
   1235 		}
   1236 		if ( KTYP(vga_keymap[map][scancode]) == KT_PAD ) {
   1237 			if ( modstate & KMOD_NUM ) {
   1238 				keysym->unicode=KVAL(vga_keymap[map][scancode]);
   1239 			}
   1240 		} else {
   1241 			keysym->unicode = KVAL(vga_keymap[map][scancode]);
   1242 		}
   1243 	}
   1244 	return(keysym);
   1245 }
   1246