src/video/fbcon/SDL_fbevents.c

   1 /*
   2     SDL - Simple DirectMedia Layer
   3     Copyright (C) 1997-2009 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@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 }