/*
* $Id$
*/
#include <pc.h>
#include <go32.h>
#include <bsp.h>
/*
* Ports for PC keyboard
*/
#define KBD_CTL 0x61
#define KBD_DATA 0x60
#define KBD_STATUS 0x64
static char key_map[] = {
0,033,'1','2','3','4','5','6','7','8','9','0','-','=','\b','\t',
'q','w','e','r','t','y','u','i','o','p','[',']',015,0x80,
'a','s','d','f','g','h','j','k','l',';',047,0140,0x80,
0134,'z','x','c','v','b','n','m',',','.','/',0x80,
'*',0x80,' ',0x80,0x80,0x80,0x80,0x80,0x80,0x80,0x80,0x80,
0x80,0x80,0x80,0x80,0x80,0x80,0x80,0x80,0x80,0x80,0x80,0x80,
0x80,0x80,0x80,'0',0177
};
static char shift_map[] = {
0,033,'!','@','#','$','%','^','&','*','(',')','_','+','\b','\t',
'Q','W','E','R','T','Y','U','I','O','P','{','}',015,0x80,
'A','S','D','F','G','H','J','K','L',':',042,'~',0x80,
'|','Z','X','C','V','B','N','M','<','>','?',0x80,
'*',0x80,' ',0x80,0x80,0x80,0x80,0x80,0x80,0x80,0x80,0x80,
0x80,0x80,0x80,0x80,'7','8','9',0x80,'4','5','6',0x80,
'1','2','3','0',177
};
extern int _IBMPC_Use_Go32_IO;
#define KBD_BUF_SIZE 256
static char kbd_buffer[ KBD_BUF_SIZE ];
static unsigned int kbd_first = 0;
static unsigned int kbd_last = 0;
/* This function can be called during a poll for input, or by an ISR. */
/* Basically any time you want to process a keypress. */
int _IBMPC_scankey( char * ch )
{
unsigned char c;
unsigned char outch;
static int shift_pressed = 0;
static int ctrl_pressed = 0;
static int caps_pressed = 0;
/* Read keyboard controller, toggle enable */
inport_byte( KBD_CTL, c );
outport_byte( KBD_CTL, c & ~0x80 );
outport_byte( KBD_CTL, c | 0x80 );
outport_byte( KBD_CTL, c & ~0x80 );
/* See if it has data */
inport_byte( KBD_STATUS, c );
if ( ( c & 0x01 ) == 0 )
return 0;
/* Read the data. Handle nonsense with shift, control, etc. */
inport_byte( KBD_DATA, c );
switch ( c ) {
case 0x36:
case 0x2a:
shift_pressed = 1;
return 0;
case 0x3a:
caps_pressed = 1;
return 0;
case 0x1d:
ctrl_pressed = 1;
return 0;
case 0xb6:
case 0xaa:
shift_pressed = 0;
return 0;
case 0xba:
caps_pressed = 0;
return 0;
case 0x9d:
ctrl_pressed = 0;
return 0;
/*
* Ignore unrecognized keys--usually arrow and such
*/
default:
if ( c & 0x80 )
/* High-bit on means key is being released, not pressed */
return 0;
if ( c == 88 )
/* F12 - abort */
exit( 1 );
if ( c > 0x39 ) {
return 0;
}
}
/* Strip high bit, look up in our map */
c &= 127;
if ( ctrl_pressed ) {
outch = key_map[c];
outch &= 037;
} else {
outch = shift_pressed ? shift_map[c] : key_map[c];
if ( caps_pressed ) {
if ( outch >= 'A' && outch <= 'Z' ) outch += 'a' - 'A';
else if ( outch >= 'a' && outch <= 'z' ) outch -= 'a' - 'A';
}
}
*ch = outch;
return 1;
}
void _IBMPC_keyboard_isr( rtems_unsigned32 interrupt )
{
if ( _IBMPC_scankey( & kbd_buffer[ kbd_last ] ) ) {
/* Got one; save it if there is enough room in buffer. */
unsigned int next = (kbd_last + 1) % KBD_BUF_SIZE;
if ( next != kbd_first )
kbd_last = next;
}
/* Mark interrupt as handled */
outport_byte( 0x20, 0x20 );
}
int _IBMPC_chrdy( char * ch )
{
if ( _IBMPC_Use_Go32_IO ) {
/* Read keyboard via BIOS: raw mode. */
if ( kbhit() ) {
*ch = getkey();
return 1;
} else {
return 0;
}
} else {
/* Check buffer our ISR builds */
if ( kbd_first != kbd_last ) {
*ch = kbd_buffer[ kbd_first ];
kbd_first = (kbd_first + 1) % KBD_BUF_SIZE;
return 1;
} else {
return 0;
}
}
}
int _IBMPC_inch( void )
{
char Ch;
while ( ! _IBMPC_chrdy( & Ch ) )
continue;
return Ch;
}
