/*

SDL - Simple DirectMedia Layer

Copyright (C) 1997, 1998, 1999, 2000, 2001 Sam Lantinga

This library is free software; you can redistribute it and/or

modify it under the terms of the GNU Library General Public

License as published by the Free Software Foundation; either

version 2 of the License, or (at your option) any later version.

This library is distributed in the hope that it will be useful,

but WITHOUT ANY WARRANTY; without even the implied warranty of

MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU

Library General Public License for more details.

You should have received a copy of the GNU Library General Public

License along with this library; if not, write to the Free

Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA

Sam Lantinga

slouken@devolution.com

*/

#ifdef SAVE_RCSID

static char rcsid =

"@(#) $Id$";

#endif

/* Handle the event stream, converting console events into SDL events */

#include <sys/types.h>

#include <sys/time.h>

#include <sys/ioctl.h>

#include <stdlib.h>

#include <stdio.h>

#include <unistd.h>

#include <fcntl.h>

#include <string.h>

#include <errno.h>

#include <limits.h>

/* For parsing /proc */

#include <dirent.h>

#include <ctype.h>

#include <linux/vt.h>

#include <linux/kd.h>

#include <linux/keyboard.h>

#include "SDL.h"

#include "SDL_mutex.h"

#include "SDL_sysevents.h"

#include "SDL_sysvideo.h"

#include "SDL_events_c.h"

#include "SDL_fbvideo.h"

#include "SDL_fbevents_c.h"

#include "SDL_fbkeys.h"

#include "SDL_fbelo.h"

#ifndef GPM_NODE_FIFO

#define GPM_NODE_FIFO "/dev/gpmdata"

#endif

/* The translation tables from a console scancode to a SDL keysym */

#define NUM_VGAKEYMAPS (1<<KG_CAPSSHIFT)

static Uint16 vga_keymap[NUM_VGAKEYMAPS][NR_KEYS];

static SDLKey keymap[128];

static Uint16 keymap_temp[128]; /* only used at startup */

static SDL_keysym *TranslateKey(int scancode, SDL_keysym *keysym);

/* Ugh, we have to duplicate the kernel's keysym mapping code...

Oh, it's not so bad. :-)

FIXME: Add keyboard LED handling code

*/

static void FB_vgainitkeymaps(int fd)

{

struct kbentry entry;

int map, i;

/* Don't do anything if we are passed a closed keyboard */

if ( fd < 0 ) {

return;

}

/* Load all the keysym mappings */

for ( map=0; map<NUM_VGAKEYMAPS; ++map ) {

memset(vga_keymap[map], 0, NR_KEYS*sizeof(Uint16));

for ( i=0; i<NR_KEYS; ++i ) {

entry.kb_table = map;

entry.kb_index = i;

if ( ioctl(fd, KDGKBENT, &entry) == 0 ) {

/* fill keytemp. This replaces SDL_fbkeys.h */

if ( (map == 0) && (i<128) ) {

keymap_temp[i] = entry.kb_value;

}

/* The "Enter" key is a special case */

if ( entry.kb_value == K_ENTER ) {

entry.kb_value = K(KT_ASCII,13);

}

/* Handle numpad specially as well */

if ( KTYP(entry.kb_value) == KT_PAD ) {

switch ( entry.kb_value ) {

case K_P0:

case K_P1:

case K_P2:

case K_P3:

case K_P4:

case K_P5:

case K_P6:

case K_P7:

case K_P8:

case K_P9:

vga_keymap[map][i]=entry.kb_value;

vga_keymap[map][i]+= '0';

break;

case K_PPLUS:

vga_keymap[map][i]=K(KT_ASCII,'+');

break;

case K_PMINUS:

vga_keymap[map][i]=K(KT_ASCII,'-');

break;

case K_PSTAR:

vga_keymap[map][i]=K(KT_ASCII,'*');

break;

case K_PSLASH:

vga_keymap[map][i]=K(KT_ASCII,'/');

break;

case K_PENTER:

vga_keymap[map][i]=K(KT_ASCII,'\r');

break;

case K_PCOMMA:

vga_keymap[map][i]=K(KT_ASCII,',');

break;

case K_PDOT:

vga_keymap[map][i]=K(KT_ASCII,'.');

break;

default:

break;

}

}

/* Do the normal key translation */

if ( (KTYP(entry.kb_value) == KT_LATIN) ||

(KTYP(entry.kb_value) == KT_ASCII) ||

(KTYP(entry.kb_value) == KT_LETTER) ) {

vga_keymap[map][i] = entry.kb_value;

}

}

}

}

}

int FB_InGraphicsMode(_THIS)

{

return((keyboard_fd >= 0) && (saved_kbd_mode >= 0));

}

int FB_EnterGraphicsMode(_THIS)

{

struct termios keyboard_termios;

/* Set medium-raw keyboard mode */

if ( (keyboard_fd >= 0) && !FB_InGraphicsMode(this) ) {

/* Switch to the correct virtual terminal */

if ( current_vt > 0 ) {

struct vt_stat vtstate;

if ( ioctl(keyboard_fd, VT_GETSTATE, &vtstate) == 0 ) {

saved_vt = vtstate.v_active;

}

if ( ioctl(keyboard_fd, VT_ACTIVATE, current_vt) == 0 ) {

ioctl(keyboard_fd, VT_WAITACTIVE, current_vt);

}

}

/* Set the terminal input mode */

if ( tcgetattr(keyboard_fd, &saved_kbd_termios) < 0 ) {

SDL_SetError("Unable to get terminal attributes");

if ( keyboard_fd > 0 ) {

close(keyboard_fd);

}

keyboard_fd = -1;

return(-1);

}

if ( ioctl(keyboard_fd, KDGKBMODE, &saved_kbd_mode) < 0 ) {

SDL_SetError("Unable to get current keyboard mode");

if ( keyboard_fd > 0 ) {

close(keyboard_fd);

}

keyboard_fd = -1;

return(-1);

}

keyboard_termios = saved_kbd_termios;

keyboard_termios.c_lflag &= ~(ICANON | ECHO | ISIG);

keyboard_termios.c_iflag &= ~(ISTRIP | IGNCR | ICRNL | INLCR | IXOFF | IXON);

keyboard_termios.c_cc[VMIN] = 0;

keyboard_termios.c_cc[VTIME] = 0;

if (tcsetattr(keyboard_fd, TCSAFLUSH, &keyboard_termios) < 0) {

FB_CloseKeyboard(this);

SDL_SetError("Unable to set terminal attributes");

return(-1);

}

/* This will fail if we aren't root or this isn't our tty */

if ( ioctl(keyboard_fd, KDSKBMODE, K_MEDIUMRAW) < 0 ) {

FB_CloseKeyboard(this);

SDL_SetError("Unable to set keyboard in raw mode");

return(-1);

}

if ( ioctl(keyboard_fd, KDSETMODE, KD_GRAPHICS) < 0 ) {

FB_CloseKeyboard(this);

SDL_SetError("Unable to set keyboard in graphics mode");

return(-1);

}

}

return(keyboard_fd);

}

void FB_LeaveGraphicsMode(_THIS)

{

if ( FB_InGraphicsMode(this) ) {

ioctl(keyboard_fd, KDSETMODE, KD_TEXT);

ioctl(keyboard_fd, KDSKBMODE, saved_kbd_mode);

tcsetattr(keyboard_fd, TCSAFLUSH, &saved_kbd_termios);

saved_kbd_mode = -1;

/* Head back over to the original virtual terminal */

if ( saved_vt > 0 ) {

ioctl(keyboard_fd, VT_ACTIVATE, saved_vt);

}

}

}

void FB_CloseKeyboard(_THIS)

{

if ( keyboard_fd >= 0 ) {

FB_LeaveGraphicsMode(this);

if ( keyboard_fd > 0 ) {

close(keyboard_fd);

}

}

keyboard_fd = -1;

}

int FB_OpenKeyboard(_THIS)

{

/* Open only if not already opened */

if ( keyboard_fd < 0 ) {

char *tty0[] = { "/dev/tty0", "/dev/vc/0", NULL };

char *vcs[] = { "/dev/vc/%d", "/dev/tty%d", NULL };

int i, tty0_fd;

/* Try to query for a free virtual terminal */

tty0_fd = -1;

for ( i=0; tty0[i] && (tty0_fd < 0); ++i ) {

tty0_fd = open(tty0[i], O_WRONLY, 0);

}

if ( tty0_fd < 0 ) {

tty0_fd = dup(0); /* Maybe stdin is a VT? */

}

ioctl(tty0_fd, VT_OPENQRY, &current_vt);

close(tty0_fd);

if ( (geteuid() == 0) && (current_vt > 0) ) {

for ( i=0; vcs[i] && (keyboard_fd < 0); ++i ) {

char vtpath[12];

sprintf(vtpath, vcs[i], current_vt);

keyboard_fd = open(vtpath, O_RDWR, 0);

#ifdef DEBUG_KEYBOARD

fprintf(stderr, "vtpath = %s, fd = %d\n",

vtpath, keyboard_fd);

#endif /* DEBUG_KEYBOARD */

/* This needs to be our controlling tty

so that the kernel ioctl() calls work

*/

if ( keyboard_fd >= 0 ) {

tty0_fd = open("/dev/tty", O_RDWR, 0);

if ( tty0_fd >= 0 ) {

ioctl(tty0_fd, TIOCNOTTY, 0);

close(tty0_fd);

}

}

}

}

if ( keyboard_fd < 0 ) {

/* Last resort, maybe our tty is a usable VT */

current_vt = 0;

keyboard_fd = open("/dev/tty", O_RDWR);

}

#ifdef DEBUG_KEYBOARD

fprintf(stderr, "Current VT: %d\n", current_vt);

#endif

saved_kbd_mode = -1;

/* Make sure that our input is a console terminal */

{ int dummy;

if ( ioctl(keyboard_fd, KDGKBMODE, &dummy) < 0 ) {

close(keyboard_fd);

keyboard_fd = -1;

SDL_SetError("Unable to open a console terminal");

}

}

/* Set up keymap */

FB_vgainitkeymaps(keyboard_fd);

}

return(keyboard_fd);

}

static enum {

MOUSE_NONE = -1,

MOUSE_GPM, /* Note: GPM uses the MSC protocol */

MOUSE_PS2,

MOUSE_IMPS2,

MOUSE_MS,

MOUSE_BM,

MOUSE_ELO,

NUM_MOUSE_DRVS

} mouse_drv = MOUSE_NONE;

void FB_CloseMouse(_THIS)

{

if ( mouse_fd > 0 ) {

close(mouse_fd);

}

mouse_fd = -1;

}

/* Returns processes listed in /proc with the desired name */

static int find_pid(DIR *proc, const char *wanted_name)

{

struct dirent *entry;

int pid;

/* First scan proc for the gpm process */

pid = 0;

while ( (pid == 0) && ((entry=readdir(proc)) != NULL) ) {

if ( isdigit(entry->d_name[0]) ) {

FILE *status;

char path[PATH_MAX];

char name[PATH_MAX];

sprintf(path, "/proc/%s/status", entry->d_name);

status=fopen(path, "r");

if ( status ) {

name[0] = '\0';

fscanf(status, "Name: %s", name);

if ( strcmp(name, wanted_name) == 0 ) {

pid = atoi(entry->d_name);

}

fclose(status);

}

}

}

return pid;

}

/* Returns true if /dev/gpmdata is being written to by gpm */

static int gpm_available(void)

{

int available;

DIR *proc;

int pid;

int cmdline, len, arglen;

char path[PATH_MAX];

char args[PATH_MAX], *arg;

/* Don't bother looking if the fifo isn't there */

if ( access(GPM_NODE_FIFO, F_OK) < 0 ) {

return(0);

}

available = 0;

proc = opendir("/proc");

if ( proc ) {

while ( (pid=find_pid(proc, "gpm")) > 0 ) {

sprintf(path, "/proc/%d/cmdline", pid);

cmdline = open(path, O_RDONLY, 0);

if ( cmdline >= 0 ) {

len = read(cmdline, args, sizeof(args));

arg = args;

while ( len > 0 ) {

if ( strcmp(arg, "-R") == 0 ) {

available = 1;

}

arglen = strlen(arg)+1;

len -= arglen;

arg += arglen;

}

close(cmdline);

}

}

closedir(proc);

}

return available;

}

/* Returns true if the mouse uses the IMPS/2 protocol */

static int detect_imps2(int fd)

{

int imps2;

imps2 = 0;

if ( getenv("SDL_MOUSEDEV_IMPS2") ) {

imps2 = 1;

}

if ( ! imps2 ) {

unsigned char query_ps2 = 0xF2;

fd_set fdset;

struct timeval tv;

/* Get rid of any mouse motion noise */

FD_ZERO(&fdset);

FD_SET(fd, &fdset);

tv.tv_sec = 0;

tv.tv_usec = 0;

while ( select(fd+1, &fdset, 0, 0, &tv) > 0 ) {

char temp[32];

read(fd, temp, sizeof(temp));

}

/* Query for the type of mouse protocol */

if ( write(fd, &query_ps2, 1) == 1 ) {

unsigned char ch = 0;

/* If you wanted to control the mouse mode:

Set IMPS/2 protocol:

{0xf3,200,0xf3,100,0xf3,80}

Reset mouse device:

{0xFF}

*/

/* Get the mouse protocol response */

do {

FD_ZERO(&fdset);

FD_SET(fd, &fdset);

tv.tv_sec = 1;

tv.tv_usec = 0;

if ( select(fd+1, &fdset, 0, 0, &tv) < 1 ) {

break;

}

} while ( (read(fd, &ch, 1) == 1) &&

((ch == 0xFA) || (ch == 0xAA)) );

/* Experimental values (Logitech wheelmouse) */

#ifdef DEBUG_MOUSE

fprintf(stderr, "Last mouse mode: 0x%x\n", ch);

#endif

if ( ch == 3 ) {

imps2 = 1;

}

}

}

return imps2;

}

int FB_OpenMouse(_THIS)

{

const char *mousedev;

const char *mousedrv;

mousedrv = getenv("SDL_MOUSEDRV");

mousedev = getenv("SDL_MOUSEDEV");

mouse_fd = -1;

/* ELO TOUCHSCREEN SUPPORT */

if( (mousedrv != NULL) && (strcmp(mousedrv, "ELO") == 0) ) {

mouse_fd = open(mousedev, O_RDWR);

if ( mouse_fd >= 0 ) {

if(eloInitController(mouse_fd)) {

#ifdef DEBUG_MOUSE

fprintf(stderr, "Using ELO touchscreen\n");

#endif

mouse_drv = MOUSE_ELO;

}

}

else if ( mouse_fd < 0 ) {

mouse_drv = MOUSE_NONE;

}

return(mouse_fd);

}

/* STD MICE */

if ( mousedev == NULL ) {

/* First try to use GPM in repeater mode */

if ( mouse_fd < 0 ) {

if ( gpm_available() ) {

mouse_fd = open(GPM_NODE_FIFO, O_RDONLY, 0);

if ( mouse_fd >= 0 ) {

#ifdef DEBUG_MOUSE

fprintf(stderr, "Using GPM mouse\n");

#endif

mouse_drv = MOUSE_GPM;

}

}

}

/* Now try to use the new HID unified mouse device */

if ( mouse_fd < 0 ) {

mouse_fd = open("/dev/input/mice", O_RDONLY, 0);

if ( mouse_fd >= 0 ) {

mouse_drv = MOUSE_IMPS2;

}

}

/* Now try to use a modern PS/2 port mouse */

if ( mouse_fd < 0 ) {

mouse_fd = open("/dev/psaux", O_RDWR, 0);

if ( mouse_fd < 0 ) {

mouse_fd = open("/dev/psaux", O_RDONLY, 0);

}

if ( mouse_fd >= 0 ) {

if ( detect_imps2(mouse_fd) ) {

#ifdef DEBUG_MOUSE

fprintf(stderr, "Using IMPS/2 mouse\n");

#endif

mouse_drv = MOUSE_IMPS2;

} else {

#ifdef DEBUG_MOUSE

fprintf(stderr, "Using PS/2 mouse\n");

#endif

mouse_drv = MOUSE_PS2;

}

}

}

/* Next try to use a PPC ADB port mouse */

if ( mouse_fd < 0 ) {

mouse_fd = open("/dev/adbmouse", O_RDONLY, 0);

if ( mouse_fd >= 0 ) {

#ifdef DEBUG_MOUSE

fprintf(stderr, "Using ADB mouse\n");

#endif

mouse_drv = MOUSE_BM;

}

}

}

/* Default to a serial Microsoft mouse */

if ( mouse_fd < 0 ) {

if ( mousedev == NULL ) {

mousedev = "/dev/mouse";

}

mouse_fd = open(mousedev, O_RDONLY, 0);

if ( mouse_fd >= 0 ) {

struct termios mouse_termios;

/* Set the sampling speed to 1200 baud */

tcgetattr(mouse_fd, &mouse_termios);

mouse_termios.c_iflag = IGNBRK | IGNPAR;

mouse_termios.c_oflag = 0;

mouse_termios.c_lflag = 0;

mouse_termios.c_line = 0;

mouse_termios.c_cc[VTIME] = 0;

mouse_termios.c_cc[VMIN] = 1;

mouse_termios.c_cflag = CREAD | CLOCAL | HUPCL;

mouse_termios.c_cflag |= CS8;

mouse_termios.c_cflag |= B1200;

tcsetattr(mouse_fd, TCSAFLUSH, &mouse_termios);

#ifdef DEBUG_MOUSE

fprintf(stderr, "Using Microsoft mouse on %s\n", mousedev);

#endif

mouse_drv = MOUSE_MS;

}

}

if ( mouse_fd < 0 ) {

mouse_drv = MOUSE_NONE;

}

return(mouse_fd);

}

static int posted = 0;

void FB_vgamousecallback(int button, int relative, int dx, int dy)

{

int button_1, button_3;

int button_state;

int state_changed;

int i;

Uint8 state;

if ( dx || dy ) {

posted += SDL_PrivateMouseMotion(0, relative, dx, dy);

}

/* Swap button 1 and 3 */

button_1 = (button & 0x04) >> 2;

button_3 = (button & 0x01) << 2;

button &= ~0x05;

button |= (button_1|button_3);

/* See what changed */

button_state = SDL_GetMouseState(NULL, NULL);

state_changed = button_state ^ button;

for ( i=0; i<8; ++i ) {

if ( state_changed & (1<<i) ) {

if ( button & (1<<i) ) {

state = SDL_PRESSED;

} else {

state = SDL_RELEASED;

}

posted += SDL_PrivateMouseButton(state, i+1, 0, 0);

}

}

}

/* For now, use GPM, PS/2, and MS protocols

Driver adapted from the SVGAlib mouse driver code (taken from gpm, etc.)

*/

static void handle_mouse(_THIS)

{

static int start = 0;

static unsigned char mousebuf[BUFSIZ];

static int relative = 1;

int i, nread;

int button = 0;

int dx = 0, dy = 0;

int packetsize = 0;

/* Figure out the mouse packet size */

switch (mouse_drv) {

case MOUSE_NONE:

/* Ack! */

read(mouse_fd, mousebuf, BUFSIZ);

return;

case MOUSE_GPM:

packetsize = 5;

break;

case MOUSE_IMPS2:

packetsize = 4;

break;

case MOUSE_PS2:

case MOUSE_MS:

case MOUSE_BM:

packetsize = 3;

break;

case MOUSE_ELO:

packetsize = ELO_PACKET_SIZE;

relative = 0;

break;

case NUM_MOUSE_DRVS:

/* Uh oh.. */

packetsize = 0;

break;

}

/* Read as many packets as possible */

nread = read(mouse_fd, &mousebuf[start], BUFSIZ-start);

if ( nread < 0 ) {

return;

}

nread += start;

#ifdef DEBUG_MOUSE

fprintf(stderr, "Read %d bytes from mouse, start = %d\n", nread, start);

#endif

for ( i=0; i<(nread-(packetsize-1)); i += packetsize ) {

switch (mouse_drv) {

case MOUSE_NONE:

break;

case MOUSE_GPM:

/* GPM protocol has 0x80 in high byte */

if ( (mousebuf[i] & 0xF8) != 0x80 ) {

/* Go to next byte */

i -= (packetsize-1);

continue;

}

/* Get current mouse state */

button = (~mousebuf[i]) & 0x07;

dx = (signed char)(mousebuf[i+1]) +

(signed char)(mousebuf[i+3]);

dy = -((signed char)(mousebuf[i+2]) +

(signed char)(mousebuf[i+4]));

break;

case MOUSE_PS2:

/* PS/2 protocol has nothing in high byte */

if ( (mousebuf[i] & 0xC0) != 0 ) {

/* Go to next byte */

i -= (packetsize-1);

continue;

}

/* Get current mouse state */

button = (mousebuf[i] & 0x04) >> 1 | /*Middle*/

(mousebuf[i] & 0x02) >> 1 | /*Right*/

(mousebuf[i] & 0x01) << 2; /*Left*/

dx = (mousebuf[i] & 0x10) ?

mousebuf[i+1] - 256 : mousebuf[i+1];

dy = (mousebuf[i] & 0x20) ?

-(mousebuf[i+2] - 256) : -mousebuf[i+2];

break;

case MOUSE_IMPS2:

/* Get current mouse state */

button = (mousebuf[i] & 0x04) >> 1 | /*Middle*/

(mousebuf[i] & 0x02) >> 1 | /*Right*/

(mousebuf[i] & 0x01) << 2 | /*Left*/

(mousebuf[i] & 0x40) >> 3 | /* 4 */

(mousebuf[i] & 0x80) >> 3; /* 5 */

dx = (mousebuf[i] & 0x10) ?

mousebuf[i+1] - 256 : mousebuf[i+1];

dy = (mousebuf[i] & 0x20) ?

-(mousebuf[i+2] - 256) : -mousebuf[i+2];

switch (mousebuf[i+3]&0x0F) {

case 0x0E: /* DX = +1 */

case 0x02: /* DX = -1 */

break;

case 0x0F: /* DY = +1 (map button 4) */

button |= (1<<3);

break;

case 0x01: /* DY = -1 (map button 5) */

button |= (1<<4);

break;

}

break;

case MOUSE_MS:

/* Microsoft protocol has 0x40 in high byte */

if ( (mousebuf[i] & 0x40) != 0x40 ) {

/* Go to next byte */

i -= (packetsize-1);

continue;

}

/* Get current mouse state */

button = ((mousebuf[i] & 0x20) >> 3) |

((mousebuf[i] & 0x10) >> 4);

dx = (signed char)(((mousebuf[i] & 0x03) << 6) |

(mousebuf[i + 1] & 0x3F));

dy = (signed char)(((mousebuf[i] & 0x0C) << 4) |

(mousebuf[i + 2] & 0x3F));

break;

case MOUSE_BM:

/* BusMouse protocol has 0xF8 in high byte */

if ( (mousebuf[i] & 0xF8) != 0x80 ) {

/* Go to next byte */

i -= (packetsize-1);

continue;

}

/* Get current mouse state */

button = (~mousebuf[i]) & 0x07;

dx = (signed char)mousebuf[i+1];

dy = -(signed char)mousebuf[i+2];

break;

case MOUSE_ELO:

/* ELO protocol has ELO_START_BYTE as first byte */

if ( mousebuf[i] != ELO_START_BYTE ) {

/* Go to next byte */

i -= (packetsize-1);

continue;

}

/* parse the packet */

if(!eloParsePacket(&(mousebuf[i]), &dx, &dy, &button)) {

break;

}

button = (button & 0x01) << 2;

/* convert to screen coordinates */

eloConvertXY(this, &dx, &dy);

break;

case NUM_MOUSE_DRVS:

/* Uh oh.. */

dx = 0;

dy = 0;

break;

}

FB_vgamousecallback(button, relative, dx, dy);

}

if ( i < nread ) {

memcpy(mousebuf, &mousebuf[i], (nread-i));

start = (nread-i);

} else {

start = 0;

}

return;

}

/* Handle switching to another VC, returns when our VC is back */

static void switch_vt(_THIS, unsigned short which)

{

struct vt_stat vtstate;

unsigned short current;

SDL_Surface *screen;

__u16 saved_pal[3*256];

Uint32 screen_arealen;

Uint8 *screen_contents;

/* Figure out whether or not we're switching to a new console */

if ( (ioctl(keyboard_fd, VT_GETSTATE, &vtstate) < 0) ||

(which == vtstate.v_active) ) {

return;

}

current = vtstate.v_active;

/* Save the contents of the screen, and go to text mode */

SDL_mutexP(hw_lock);

screen = SDL_VideoSurface;

screen_arealen = (screen->h*screen->pitch);

screen_contents = (Uint8 *)malloc(screen_arealen);

if ( screen_contents ) {

memcpy(screen_contents, screen->pixels, screen_arealen);

}

FB_SavePaletteTo(this, 256, saved_pal);

ioctl(keyboard_fd, KDSETMODE, KD_TEXT);

/* New console, switch to it */

if ( ioctl(keyboard_fd, VT_ACTIVATE, which) == 0 ) {

/* Wait for our console to be activated again */

ioctl(keyboard_fd, VT_WAITACTIVE, which);

while ( ioctl(keyboard_fd, VT_WAITACTIVE, current) < 0 ) {

if ( (errno != EINTR) && (errno != EAGAIN) ) {

/* Unknown VT error - cancel this */

break;

}

SDL_Delay(500);

}

}

/* Restore graphics mode and the contents of the screen */

ioctl(keyboard_fd, KDSETMODE, KD_GRAPHICS);

FB_RestorePaletteFrom(this, 256, saved_pal);

if ( screen_contents ) {

memcpy(screen->pixels, screen_contents, screen_arealen);

free(screen_contents);

}

SDL_mutexV(hw_lock);

}

static void handle_keyboard(_THIS)

{

unsigned char keybuf[BUFSIZ];

int i, nread;

int pressed;

int scancode;

SDL_keysym keysym;

nread = read(keyboard_fd, keybuf, BUFSIZ);

for ( i=0; i<nread; ++i ) {

scancode = keybuf[i] & 0x7F;

if ( keybuf[i] & 0x80 ) {

pressed = SDL_RELEASED;

} else {

pressed = SDL_PRESSED;

}

TranslateKey(scancode, &keysym);

/* Handle Alt-FN for vt switch */

switch (keysym.sym) {

case SDLK_F1:

case SDLK_F2:

case SDLK_F3:

case SDLK_F4:

case SDLK_F5:

case SDLK_F6:

case SDLK_F7:

case SDLK_F8:

case SDLK_F9:

case SDLK_F10:

case SDLK_F11:

case SDLK_F12:

if ( SDL_GetModState() & KMOD_ALT ) {

switch_vt(this, (keysym.sym-SDLK_F1)+1);

break;

}

/* Fall through to normal processing */

default:

posted += SDL_PrivateKeyboard(pressed, &keysym);

break;

}

}

}

void FB_PumpEvents(_THIS)

{

fd_set fdset;

int max_fd;

static struct timeval zero;

do {

posted = 0;

FD_ZERO(&fdset);

max_fd = 0;

if ( keyboard_fd >= 0 ) {

FD_SET(keyboard_fd, &fdset);

if ( max_fd < keyboard_fd ) {

max_fd = keyboard_fd;

}

}

if ( mouse_fd >= 0 ) {

FD_SET(mouse_fd, &fdset);

if ( max_fd < mouse_fd ) {

max_fd = mouse_fd;

}

}

if ( select(max_fd+1, &fdset, NULL, NULL, &zero) > 0 ) {

if ( keyboard_fd >= 0 ) {

if ( FD_ISSET(keyboard_fd, &fdset) ) {

handle_keyboard(this);

}

}

if ( mouse_fd >= 0 ) {

if ( FD_ISSET(mouse_fd, &fdset) ) {

handle_mouse(this);

}

}

}

} while ( posted );

}

void FB_InitOSKeymap(_THIS)

{

int i;

/* Initialize the Linux key translation table */

/* First get the ascii keys and others not well handled */

for (i=0; i<SDL_TABLESIZE(keymap); ++i) {

switch(i) {

/* These aren't handled by the x86 kernel keymapping (?) */

case SCANCODE_PRINTSCREEN:

keymap[i] = SDLK_PRINT;

break;

case SCANCODE_BREAK:

keymap[i] = SDLK_BREAK;

break;

case SCANCODE_BREAK_ALTERNATIVE:

keymap[i] = SDLK_PAUSE;

break;

case SCANCODE_LEFTSHIFT:

keymap[i] = SDLK_LSHIFT;

break;

case SCANCODE_RIGHTSHIFT:

keymap[i] = SDLK_RSHIFT;

break;

case SCANCODE_LEFTCONTROL:

keymap[i] = SDLK_LCTRL;

break;

case SCANCODE_RIGHTCONTROL:

keymap[i] = SDLK_RCTRL;

break;

case SCANCODE_RIGHTWIN:

keymap[i] = SDLK_RSUPER;

break;

case SCANCODE_LEFTWIN:

keymap[i] = SDLK_LSUPER;

break;

case 127:

keymap[i] = SDLK_MENU;

break;

/* this should take care of all standard ascii keys */

default:

keymap[i] = KVAL(vga_keymap[0][i]);

break;

}

}

for (i=0; i<SDL_TABLESIZE(keymap); ++i) {

switch(keymap_temp[i]) {

case K_F1: keymap[i] = SDLK_F1; break;

case K_F2: keymap[i] = SDLK_F2; break;

case K_F3: keymap[i] = SDLK_F3; break;

case K_F4: keymap[i] = SDLK_F4; break;

case K_F5: keymap[i] = SDLK_F5; break;

case K_F6: keymap[i] = SDLK_F6; break;

case K_F7: keymap[i] = SDLK_F7; break;

case K_F8: keymap[i] = SDLK_F8; break;

case K_F9: keymap[i] = SDLK_F9; break;

case K_F10: keymap[i] = SDLK_F10; break;

case K_F11: keymap[i] = SDLK_F11; break;

case K_F12: keymap[i] = SDLK_F12; break;

case K_DOWN: keymap[i] = SDLK_DOWN; break;

case K_LEFT: keymap[i] = SDLK_LEFT; break;

case K_RIGHT: keymap[i] = SDLK_RIGHT; break;

case K_UP: keymap[i] = SDLK_UP; break;

case K_P0: keymap[i] = SDLK_KP0; break;

case K_P1: keymap[i] = SDLK_KP1; break;

case K_P2: keymap[i] = SDLK_KP2; break;

case K_P3: keymap[i] = SDLK_KP3; break;

case K_P4: keymap[i] = SDLK_KP4; break;

case K_P5: keymap[i] = SDLK_KP5; break;

case K_P6: keymap[i] = SDLK_KP6; break;

case K_P7: keymap[i] = SDLK_KP7; break;

case K_P8: keymap[i] = SDLK_KP8; break;

case K_P9: keymap[i] = SDLK_KP9; break;

case K_PPLUS: keymap[i] = SDLK_KP_PLUS; break;

case K_PMINUS: keymap[i] = SDLK_KP_MINUS; break;

case K_PSTAR: keymap[i] = SDLK_KP_MULTIPLY; break;

case K_PSLASH: keymap[i] = SDLK_KP_DIVIDE; break;

case K_PENTER: keymap[i] = SDLK_KP_ENTER; break;

case K_PDOT: keymap[i] = SDLK_KP_PERIOD; break;

case K_SHIFT: if ( keymap[i] != SDLK_RSHIFT )

keymap[i] = SDLK_LSHIFT;

break;

case K_SHIFTL: keymap[i] = SDLK_LSHIFT; break;

case K_SHIFTR: keymap[i] = SDLK_RSHIFT; break;

case K_CTRL: if ( keymap[i] != SDLK_RCTRL )

keymap[i] = SDLK_LCTRL;