SDL - Simple DirectMedia Layer

Copyright (C) 1997-2006 Sam Lantinga

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

modify it under the terms of the GNU Lesser General Public

License as published by the Free Software Foundation; either

version 2.1 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

Lesser General Public License for more details.

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

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

Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA

Sam Lantinga

slouken@libsdl.org

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

#include <sys/types.h>

#include <sys/time.h>

#include <sys/ioctl.h>

#include <unistd.h>

#include <fcntl.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_sysvideo.h"

#include "../../events/SDL_sysevents.h"

#include "../../events/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 ) {

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 ) {

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

static const char * const 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];

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_PS2,

MOUSE_IMPS2,

MOUSE_MS,

MOUSE_BM,

MOUSE_ELO,

NUM_MOUSE_DRVS

} mouse_drv = MOUSE_NONE;

void FB_CloseMouse(_THIS)

{

if (ts_dev != NULL) {

ts_close(ts_dev);

ts_dev = NULL;

mouse_fd = -1;

}

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];

status=fopen(path, "r");

if ( status ) {

name[0] = '\0';

fscanf(status, "Name: %s", 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 ) {

cmdline = open(path, O_RDONLY, 0);

if ( cmdline >= 0 ) {

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

arg = args;

while ( len > 0 ) {

available = 1;

}

len -= arglen;

arg += arglen;

}

close(cmdline);

}

}

closedir(proc);

}

return available;

}

/* rcg06112001 Set up IMPS/2 mode, if possible. This gives

* us access to the mousewheel, etc. Returns zero if

* writes to device failed, but you still need to query the

* device to see which mode it's actually in.

*/

static int set_imps2_mode(int fd)

{

/* If you wanted to control the mouse mode (and we do :) ) ...

Set IMPS/2 protocol:

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

Reset mouse device:

{0xFF}

*/

Uint8 set_imps2[] = {0xf3, 200, 0xf3, 100, 0xf3, 80};

Uint8 reset = 0xff;

fd_set fdset;

struct timeval tv;

int retval = 0;

if ( write(fd, &set_imps2, sizeof(set_imps2)) == sizeof(set_imps2) ) {

if (write(fd, &reset, sizeof (reset)) == sizeof (reset) ) {

retval = 1;

}

}

/* Get rid of any chatter from the above */

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));

}

return retval;

}

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

static int detect_imps2(int fd)

{

int imps2;

imps2 = 0;

imps2 = 1;

}

if ( ! imps2 ) {

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, sizeof (query_ps2)) == sizeof (query_ps2)) {

Uint8 ch = 0;

/* 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;

}

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

/* Experimental values (Logitech wheelmouse) */

#ifdef DEBUG_MOUSE

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

#endif

imps2 = 1;

}

}

}

return imps2;

}

int FB_OpenMouse(_THIS)

{

const char *mousedev;

const char *mousedrv;

mousedrv = SDL_getenv("SDL_MOUSEDRV");

mousedev = SDL_getenv("SDL_MOUSEDEV");

mouse_fd = -1;

if (mousedev != NULL) {

ts_dev = ts_open(mousedev, 1);

if ((ts_dev != NULL) && (ts_config(ts_dev) >= 0)) {

#ifdef DEBUG_MOUSE

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

#endif

mouse_drv = MOUSE_TSLIB;

mouse_fd = ts_fd(ts_dev);

return mouse_fd;

}

}

mouse_drv = MOUSE_NONE;

return mouse_fd;

}

/* ELO TOUCHSCREEN SUPPORT */

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 ) {

"/dev/input/mice", "/dev/usbmouse", "/dev/psaux", 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

}

}

}

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

for ( i=0; (mouse_fd < 0) && ps2mice[i]; ++i ) {

mouse_fd = open(ps2mice[i], O_RDWR, 0);

}

if (mouse_fd >= 0) {

#endif

mouse_drv = MOUSE_IMPS2;

} else {

#ifdef DEBUG_MOUSE

#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);

mouse_drv = MOUSE_PS2;

} else {

#ifdef DEBUG_MOUSE

fprintf(stderr, "Using (default) MS 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);

}

}

}

static void handle_tslib(_THIS)

{

struct ts_sample sample;

int button;

while (ts_read(ts_dev, &sample, 1) > 0) {

button = (sample.pressure > 0) ? 1 : 0;

button <<= 2; /* must report it as button 3 */

}

return;

}

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;

int realx, realy;

/* Figure out the mouse packet size */

switch (mouse_drv) {

case MOUSE_NONE:

/* Ack! */

read(mouse_fd, mousebuf, BUFSIZ);

return;

packetsize = 5;

break;

case MOUSE_IMPS2:

packetsize = 4;

break;

case MOUSE_PS2:

case MOUSE_MS:

case MOUSE_BM:

packetsize = 3;

break;

case MOUSE_ELO:

/* try to read the next packet */

if(eloReadPosition(this, mouse_fd, &dx, &dy, &button, &realx, &realy)) {

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

FB_vgamousecallback(button, 0, dx, dy);

}

return; /* nothing left to do */

handle_tslib(this);

#endif

return; /* nothing left to do */

/* Uh oh.. */

packetsize = 0;

break;

}

/* Special handling for the quite sensitive ELO controller */

if (mouse_drv == MOUSE_ELO) {

}

/* 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_MSC:

/* MSC 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) */

FB_vgamousecallback(button | (1<<3),

1, 0, 0);

break;

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

FB_vgamousecallback(button | (1<<4),

1, 0, 0);

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;

/* Uh oh.. */

dx = 0;

dy = 0;

break;

}

FB_vgamousecallback(button, relative, dx, dy);

}

if ( i < nread ) {

start = (nread-i);

} else {

start = 0;

}

return;

}

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

This isn't necessarily the best solution. For SDL 1.3 we need

a way of notifying the application when we lose access to the

video hardware and when we regain it.

*/

static void switch_vt(_THIS, unsigned short which)

{

/* 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;

}

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

SDL_mutexP(hw_lock);

if ( !SDL_ShadowSurface ) {

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

screen_contents = (Uint8 *)SDL_malloc(screen_arealen);

if ( screen_contents ) {

SDL_memcpy(screen_contents, (Uint8 *)screen->pixels + screen->offset, 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);

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 ) {

} else {

SDL_UpdateRect(screen, 0, 0, 0, 0);

}

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);

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_CTRL) &&

(SDL_GetModState() & KMOD_ALT) ) {

if ( pressed ) {

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 );