696 lines
23 KiB
C
696 lines
23 KiB
C
/*
|
|
* VasEBoot -- GRand Unified Bootloader
|
|
* Copyright (C) 2007,2008,2009 Free Software Foundation, Inc.
|
|
*
|
|
* VasEBoot is free software: you can redistribute it and/or modify
|
|
* it under the terms of the GNU General Public License as published by
|
|
* the Free Software Foundation, either version 3 of the License, or
|
|
* (at your option) any later version.
|
|
*
|
|
* VasEBoot 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 General Public License for more details.
|
|
*
|
|
* You should have received a copy of the GNU General Public License
|
|
* along with VasEBoot. If not, see <http://www.gnu.org/licenses/>.
|
|
*/
|
|
|
|
#include <VasEBoot/dl.h>
|
|
#include <VasEBoot/at_keyboard.h>
|
|
#include <VasEBoot/cpu/at_keyboard.h>
|
|
#include <VasEBoot/cpu/io.h>
|
|
#include <VasEBoot/misc.h>
|
|
#include <VasEBoot/term.h>
|
|
#include <VasEBoot/keyboard_layouts.h>
|
|
#include <VasEBoot/time.h>
|
|
#include <VasEBoot/loader.h>
|
|
|
|
VasEBoot_MOD_LICENSE ("GPLv3+");
|
|
|
|
static short at_keyboard_status = 0;
|
|
static int e0_received = 0;
|
|
static int f0_received = 0;
|
|
|
|
static VasEBoot_uint8_t led_status;
|
|
|
|
#define KEYBOARD_LED_SCROLL (1 << 0)
|
|
#define KEYBOARD_LED_NUM (1 << 1)
|
|
#define KEYBOARD_LED_CAPS (1 << 2)
|
|
|
|
static VasEBoot_uint8_t VasEBoot_keyboard_controller_orig;
|
|
static VasEBoot_uint8_t VasEBoot_keyboard_orig_set;
|
|
static VasEBoot_uint8_t current_set;
|
|
|
|
static void
|
|
VasEBoot_keyboard_controller_init (void);
|
|
|
|
static const VasEBoot_uint8_t set1_mapping[128] =
|
|
{
|
|
/* 0x00 */ 0 /* Unused */, VasEBoot_KEYBOARD_KEY_ESCAPE,
|
|
/* 0x02 */ VasEBoot_KEYBOARD_KEY_1, VasEBoot_KEYBOARD_KEY_2,
|
|
/* 0x04 */ VasEBoot_KEYBOARD_KEY_3, VasEBoot_KEYBOARD_KEY_4,
|
|
/* 0x06 */ VasEBoot_KEYBOARD_KEY_5, VasEBoot_KEYBOARD_KEY_6,
|
|
/* 0x08 */ VasEBoot_KEYBOARD_KEY_7, VasEBoot_KEYBOARD_KEY_8,
|
|
/* 0x0a */ VasEBoot_KEYBOARD_KEY_9, VasEBoot_KEYBOARD_KEY_0,
|
|
/* 0x0c */ VasEBoot_KEYBOARD_KEY_DASH, VasEBoot_KEYBOARD_KEY_EQUAL,
|
|
/* 0x0e */ VasEBoot_KEYBOARD_KEY_BACKSPACE, VasEBoot_KEYBOARD_KEY_TAB,
|
|
/* 0x10 */ VasEBoot_KEYBOARD_KEY_Q, VasEBoot_KEYBOARD_KEY_W,
|
|
/* 0x12 */ VasEBoot_KEYBOARD_KEY_E, VasEBoot_KEYBOARD_KEY_R,
|
|
/* 0x14 */ VasEBoot_KEYBOARD_KEY_T, VasEBoot_KEYBOARD_KEY_Y,
|
|
/* 0x16 */ VasEBoot_KEYBOARD_KEY_U, VasEBoot_KEYBOARD_KEY_I,
|
|
/* 0x18 */ VasEBoot_KEYBOARD_KEY_O, VasEBoot_KEYBOARD_KEY_P,
|
|
/* 0x1a */ VasEBoot_KEYBOARD_KEY_LBRACKET, VasEBoot_KEYBOARD_KEY_RBRACKET,
|
|
/* 0x1c */ VasEBoot_KEYBOARD_KEY_ENTER, VasEBoot_KEYBOARD_KEY_LEFT_CTRL,
|
|
/* 0x1e */ VasEBoot_KEYBOARD_KEY_A, VasEBoot_KEYBOARD_KEY_S,
|
|
/* 0x20 */ VasEBoot_KEYBOARD_KEY_D, VasEBoot_KEYBOARD_KEY_F,
|
|
/* 0x22 */ VasEBoot_KEYBOARD_KEY_G, VasEBoot_KEYBOARD_KEY_H,
|
|
/* 0x24 */ VasEBoot_KEYBOARD_KEY_J, VasEBoot_KEYBOARD_KEY_K,
|
|
/* 0x26 */ VasEBoot_KEYBOARD_KEY_L, VasEBoot_KEYBOARD_KEY_SEMICOLON,
|
|
/* 0x28 */ VasEBoot_KEYBOARD_KEY_DQUOTE, VasEBoot_KEYBOARD_KEY_RQUOTE,
|
|
/* 0x2a */ VasEBoot_KEYBOARD_KEY_LEFT_SHIFT, VasEBoot_KEYBOARD_KEY_BACKSLASH,
|
|
/* 0x2c */ VasEBoot_KEYBOARD_KEY_Z, VasEBoot_KEYBOARD_KEY_X,
|
|
/* 0x2e */ VasEBoot_KEYBOARD_KEY_C, VasEBoot_KEYBOARD_KEY_V,
|
|
/* 0x30 */ VasEBoot_KEYBOARD_KEY_B, VasEBoot_KEYBOARD_KEY_N,
|
|
/* 0x32 */ VasEBoot_KEYBOARD_KEY_M, VasEBoot_KEYBOARD_KEY_COMMA,
|
|
/* 0x34 */ VasEBoot_KEYBOARD_KEY_DOT, VasEBoot_KEYBOARD_KEY_SLASH,
|
|
/* 0x36 */ VasEBoot_KEYBOARD_KEY_RIGHT_SHIFT, VasEBoot_KEYBOARD_KEY_NUMMUL,
|
|
/* 0x38 */ VasEBoot_KEYBOARD_KEY_LEFT_ALT, VasEBoot_KEYBOARD_KEY_SPACE,
|
|
/* 0x3a */ VasEBoot_KEYBOARD_KEY_CAPS_LOCK, VasEBoot_KEYBOARD_KEY_F1,
|
|
/* 0x3c */ VasEBoot_KEYBOARD_KEY_F2, VasEBoot_KEYBOARD_KEY_F3,
|
|
/* 0x3e */ VasEBoot_KEYBOARD_KEY_F4, VasEBoot_KEYBOARD_KEY_F5,
|
|
/* 0x40 */ VasEBoot_KEYBOARD_KEY_F6, VasEBoot_KEYBOARD_KEY_F7,
|
|
/* 0x42 */ VasEBoot_KEYBOARD_KEY_F8, VasEBoot_KEYBOARD_KEY_F9,
|
|
/* 0x44 */ VasEBoot_KEYBOARD_KEY_F10, VasEBoot_KEYBOARD_KEY_NUM_LOCK,
|
|
/* 0x46 */ VasEBoot_KEYBOARD_KEY_SCROLL_LOCK, VasEBoot_KEYBOARD_KEY_NUM7,
|
|
/* 0x48 */ VasEBoot_KEYBOARD_KEY_NUM8, VasEBoot_KEYBOARD_KEY_NUM9,
|
|
/* 0x4a */ VasEBoot_KEYBOARD_KEY_NUMMINUS, VasEBoot_KEYBOARD_KEY_NUM4,
|
|
/* 0x4c */ VasEBoot_KEYBOARD_KEY_NUM5, VasEBoot_KEYBOARD_KEY_NUM6,
|
|
/* 0x4e */ VasEBoot_KEYBOARD_KEY_NUMPLUS, VasEBoot_KEYBOARD_KEY_NUM1,
|
|
/* 0x50 */ VasEBoot_KEYBOARD_KEY_NUM2, VasEBoot_KEYBOARD_KEY_NUM3,
|
|
/* 0x52 */ VasEBoot_KEYBOARD_KEY_NUM0, VasEBoot_KEYBOARD_KEY_NUMDOT,
|
|
/* 0x54 */ 0, 0,
|
|
/* 0x56 */ VasEBoot_KEYBOARD_KEY_102ND, VasEBoot_KEYBOARD_KEY_F11,
|
|
/* 0x58 */ VasEBoot_KEYBOARD_KEY_F12, 0,
|
|
/* 0x5a */ 0, 0,
|
|
/* 0x5c */ 0, 0,
|
|
/* 0x5e */ 0, 0,
|
|
/* 0x60 */ 0, 0,
|
|
/* 0x62 */ 0, 0,
|
|
/* OLPC keys. Just mapped to normal keys. */
|
|
/* 0x64 */ 0, VasEBoot_KEYBOARD_KEY_UP,
|
|
/* 0x66 */ VasEBoot_KEYBOARD_KEY_DOWN, VasEBoot_KEYBOARD_KEY_LEFT,
|
|
/* 0x68 */ VasEBoot_KEYBOARD_KEY_RIGHT, 0,
|
|
/* 0x6a */ 0, 0,
|
|
/* 0x6c */ 0, 0,
|
|
/* 0x6e */ 0, 0,
|
|
/* 0x70 */ 0, 0,
|
|
/* 0x72 */ 0, VasEBoot_KEYBOARD_KEY_JP_RO,
|
|
/* 0x74 */ 0, 0,
|
|
/* 0x76 */ 0, 0,
|
|
/* 0x78 */ 0, 0,
|
|
/* 0x7a */ 0, 0,
|
|
/* 0x7c */ 0, VasEBoot_KEYBOARD_KEY_JP_YEN,
|
|
/* 0x7e */ VasEBoot_KEYBOARD_KEY_KPCOMMA
|
|
};
|
|
|
|
static const struct
|
|
{
|
|
VasEBoot_uint8_t from, to;
|
|
} set1_e0_mapping[] =
|
|
{
|
|
{0x1c, VasEBoot_KEYBOARD_KEY_NUMENTER},
|
|
{0x1d, VasEBoot_KEYBOARD_KEY_RIGHT_CTRL},
|
|
{0x35, VasEBoot_KEYBOARD_KEY_NUMSLASH },
|
|
{0x38, VasEBoot_KEYBOARD_KEY_RIGHT_ALT},
|
|
{0x47, VasEBoot_KEYBOARD_KEY_HOME},
|
|
{0x48, VasEBoot_KEYBOARD_KEY_UP},
|
|
{0x49, VasEBoot_KEYBOARD_KEY_PPAGE},
|
|
{0x4b, VasEBoot_KEYBOARD_KEY_LEFT},
|
|
{0x4d, VasEBoot_KEYBOARD_KEY_RIGHT},
|
|
{0x4f, VasEBoot_KEYBOARD_KEY_END},
|
|
{0x50, VasEBoot_KEYBOARD_KEY_DOWN},
|
|
{0x51, VasEBoot_KEYBOARD_KEY_NPAGE},
|
|
{0x52, VasEBoot_KEYBOARD_KEY_INSERT},
|
|
{0x53, VasEBoot_KEYBOARD_KEY_DELETE},
|
|
};
|
|
|
|
static const VasEBoot_uint8_t set2_mapping[256] =
|
|
{
|
|
/* 0x00 */ 0, VasEBoot_KEYBOARD_KEY_F9,
|
|
/* 0x02 */ 0, VasEBoot_KEYBOARD_KEY_F5,
|
|
/* 0x04 */ VasEBoot_KEYBOARD_KEY_F3, VasEBoot_KEYBOARD_KEY_F1,
|
|
/* 0x06 */ VasEBoot_KEYBOARD_KEY_F2, VasEBoot_KEYBOARD_KEY_F12,
|
|
/* 0x08 */ 0, VasEBoot_KEYBOARD_KEY_F10,
|
|
/* 0x0a */ VasEBoot_KEYBOARD_KEY_F8, VasEBoot_KEYBOARD_KEY_F6,
|
|
/* 0x0c */ VasEBoot_KEYBOARD_KEY_F4, VasEBoot_KEYBOARD_KEY_TAB,
|
|
/* 0x0e */ VasEBoot_KEYBOARD_KEY_RQUOTE, 0,
|
|
/* 0x10 */ 0, VasEBoot_KEYBOARD_KEY_LEFT_ALT,
|
|
/* 0x12 */ VasEBoot_KEYBOARD_KEY_LEFT_SHIFT, 0,
|
|
/* 0x14 */ VasEBoot_KEYBOARD_KEY_LEFT_CTRL, VasEBoot_KEYBOARD_KEY_Q,
|
|
/* 0x16 */ VasEBoot_KEYBOARD_KEY_1, 0,
|
|
/* 0x18 */ 0, 0,
|
|
/* 0x1a */ VasEBoot_KEYBOARD_KEY_Z, VasEBoot_KEYBOARD_KEY_S,
|
|
/* 0x1c */ VasEBoot_KEYBOARD_KEY_A, VasEBoot_KEYBOARD_KEY_W,
|
|
/* 0x1e */ VasEBoot_KEYBOARD_KEY_2, 0,
|
|
/* 0x20 */ 0, VasEBoot_KEYBOARD_KEY_C,
|
|
/* 0x22 */ VasEBoot_KEYBOARD_KEY_X, VasEBoot_KEYBOARD_KEY_D,
|
|
/* 0x24 */ VasEBoot_KEYBOARD_KEY_E, VasEBoot_KEYBOARD_KEY_4,
|
|
/* 0x26 */ VasEBoot_KEYBOARD_KEY_3, 0,
|
|
/* 0x28 */ 0, VasEBoot_KEYBOARD_KEY_SPACE,
|
|
/* 0x2a */ VasEBoot_KEYBOARD_KEY_V, VasEBoot_KEYBOARD_KEY_F,
|
|
/* 0x2c */ VasEBoot_KEYBOARD_KEY_T, VasEBoot_KEYBOARD_KEY_R,
|
|
/* 0x2e */ VasEBoot_KEYBOARD_KEY_5, 0,
|
|
/* 0x30 */ 0, VasEBoot_KEYBOARD_KEY_N,
|
|
/* 0x32 */ VasEBoot_KEYBOARD_KEY_B, VasEBoot_KEYBOARD_KEY_H,
|
|
/* 0x34 */ VasEBoot_KEYBOARD_KEY_G, VasEBoot_KEYBOARD_KEY_Y,
|
|
/* 0x36 */ VasEBoot_KEYBOARD_KEY_6, 0,
|
|
/* 0x38 */ 0, 0,
|
|
/* 0x3a */ VasEBoot_KEYBOARD_KEY_M, VasEBoot_KEYBOARD_KEY_J,
|
|
/* 0x3c */ VasEBoot_KEYBOARD_KEY_U, VasEBoot_KEYBOARD_KEY_7,
|
|
/* 0x3e */ VasEBoot_KEYBOARD_KEY_8, 0,
|
|
/* 0x40 */ 0, VasEBoot_KEYBOARD_KEY_COMMA,
|
|
/* 0x42 */ VasEBoot_KEYBOARD_KEY_K, VasEBoot_KEYBOARD_KEY_I,
|
|
/* 0x44 */ VasEBoot_KEYBOARD_KEY_O, VasEBoot_KEYBOARD_KEY_0,
|
|
/* 0x46 */ VasEBoot_KEYBOARD_KEY_9, 0,
|
|
/* 0x48 */ 0, VasEBoot_KEYBOARD_KEY_DOT,
|
|
/* 0x4a */ VasEBoot_KEYBOARD_KEY_SLASH, VasEBoot_KEYBOARD_KEY_L,
|
|
/* 0x4c */ VasEBoot_KEYBOARD_KEY_SEMICOLON, VasEBoot_KEYBOARD_KEY_P,
|
|
/* 0x4e */ VasEBoot_KEYBOARD_KEY_DASH, 0,
|
|
/* 0x50 */ 0, VasEBoot_KEYBOARD_KEY_JP_RO,
|
|
/* 0x52 */ VasEBoot_KEYBOARD_KEY_DQUOTE, 0,
|
|
/* 0x54 */ VasEBoot_KEYBOARD_KEY_LBRACKET, VasEBoot_KEYBOARD_KEY_EQUAL,
|
|
/* 0x56 */ 0, 0,
|
|
/* 0x58 */ VasEBoot_KEYBOARD_KEY_CAPS_LOCK, VasEBoot_KEYBOARD_KEY_RIGHT_SHIFT,
|
|
/* 0x5a */ VasEBoot_KEYBOARD_KEY_ENTER, VasEBoot_KEYBOARD_KEY_RBRACKET,
|
|
/* 0x5c */ 0, VasEBoot_KEYBOARD_KEY_BACKSLASH,
|
|
/* 0x5e */ 0, 0,
|
|
/* 0x60 */ 0, VasEBoot_KEYBOARD_KEY_102ND,
|
|
/* 0x62 */ 0, 0,
|
|
/* 0x64 */ 0, 0,
|
|
/* 0x66 */ VasEBoot_KEYBOARD_KEY_BACKSPACE, 0,
|
|
/* 0x68 */ 0, VasEBoot_KEYBOARD_KEY_NUM1,
|
|
/* 0x6a */ VasEBoot_KEYBOARD_KEY_JP_YEN, VasEBoot_KEYBOARD_KEY_NUM4,
|
|
/* 0x6c */ VasEBoot_KEYBOARD_KEY_NUM7, VasEBoot_KEYBOARD_KEY_KPCOMMA,
|
|
/* 0x6e */ 0, 0,
|
|
/* 0x70 */ VasEBoot_KEYBOARD_KEY_NUM0, VasEBoot_KEYBOARD_KEY_NUMDOT,
|
|
/* 0x72 */ VasEBoot_KEYBOARD_KEY_NUM2, VasEBoot_KEYBOARD_KEY_NUM5,
|
|
/* 0x74 */ VasEBoot_KEYBOARD_KEY_NUM6, VasEBoot_KEYBOARD_KEY_NUM8,
|
|
/* 0x76 */ VasEBoot_KEYBOARD_KEY_ESCAPE, VasEBoot_KEYBOARD_KEY_NUM_LOCK,
|
|
/* 0x78 */ VasEBoot_KEYBOARD_KEY_F11, VasEBoot_KEYBOARD_KEY_NUMPLUS,
|
|
/* 0x7a */ VasEBoot_KEYBOARD_KEY_NUM3, VasEBoot_KEYBOARD_KEY_NUMMINUS,
|
|
/* 0x7c */ VasEBoot_KEYBOARD_KEY_NUMMUL, VasEBoot_KEYBOARD_KEY_NUM9,
|
|
/* 0x7e */ VasEBoot_KEYBOARD_KEY_SCROLL_LOCK, 0,
|
|
/* 0x80 */ 0, 0,
|
|
/* 0x82 */ 0, VasEBoot_KEYBOARD_KEY_F7,
|
|
};
|
|
|
|
static const struct
|
|
{
|
|
VasEBoot_uint8_t from, to;
|
|
} set2_e0_mapping[] =
|
|
{
|
|
{0x11, VasEBoot_KEYBOARD_KEY_RIGHT_ALT},
|
|
{0x14, VasEBoot_KEYBOARD_KEY_RIGHT_CTRL},
|
|
{0x4a, VasEBoot_KEYBOARD_KEY_NUMSLASH},
|
|
{0x5a, VasEBoot_KEYBOARD_KEY_NUMENTER},
|
|
{0x69, VasEBoot_KEYBOARD_KEY_END},
|
|
{0x6b, VasEBoot_KEYBOARD_KEY_LEFT},
|
|
{0x6c, VasEBoot_KEYBOARD_KEY_HOME},
|
|
{0x70, VasEBoot_KEYBOARD_KEY_INSERT},
|
|
{0x71, VasEBoot_KEYBOARD_KEY_DELETE},
|
|
{0x72, VasEBoot_KEYBOARD_KEY_DOWN},
|
|
{0x74, VasEBoot_KEYBOARD_KEY_RIGHT},
|
|
{0x75, VasEBoot_KEYBOARD_KEY_UP},
|
|
{0x7a, VasEBoot_KEYBOARD_KEY_NPAGE},
|
|
{0x7d, VasEBoot_KEYBOARD_KEY_PPAGE},
|
|
};
|
|
|
|
static int ping_sent;
|
|
|
|
static void
|
|
keyboard_controller_wait_until_ready (void)
|
|
{
|
|
while (! KEYBOARD_COMMAND_ISREADY (VasEBoot_inb (KEYBOARD_REG_STATUS)));
|
|
}
|
|
|
|
static VasEBoot_uint8_t
|
|
wait_ack (void)
|
|
{
|
|
VasEBoot_uint64_t endtime;
|
|
VasEBoot_uint8_t ack;
|
|
|
|
endtime = VasEBoot_get_time_ms () + 20;
|
|
do
|
|
ack = VasEBoot_inb (KEYBOARD_REG_DATA);
|
|
while (ack != VasEBoot_AT_ACK && ack != VasEBoot_AT_NACK
|
|
&& VasEBoot_get_time_ms () < endtime);
|
|
return ack;
|
|
}
|
|
|
|
static int
|
|
at_command (VasEBoot_uint8_t data)
|
|
{
|
|
unsigned i;
|
|
for (i = 0; i < VasEBoot_AT_TRIES; i++)
|
|
{
|
|
VasEBoot_uint8_t ack;
|
|
keyboard_controller_wait_until_ready ();
|
|
VasEBoot_outb (data, KEYBOARD_REG_STATUS);
|
|
ack = wait_ack ();
|
|
if (ack == VasEBoot_AT_NACK)
|
|
continue;
|
|
if (ack == VasEBoot_AT_ACK)
|
|
break;
|
|
return 0;
|
|
}
|
|
return (i != VasEBoot_AT_TRIES);
|
|
}
|
|
|
|
static void
|
|
VasEBoot_keyboard_controller_write (VasEBoot_uint8_t c)
|
|
{
|
|
at_command (KEYBOARD_COMMAND_WRITE);
|
|
keyboard_controller_wait_until_ready ();
|
|
VasEBoot_outb (c, KEYBOARD_REG_DATA);
|
|
}
|
|
|
|
#if defined (VasEBoot_MACHINE_MIPS_LOONGSON) || defined (VasEBoot_MACHINE_QEMU) || defined (VasEBoot_MACHINE_COREBOOT) || defined (VasEBoot_MACHINE_MIPS_QEMU_MIPS)
|
|
#define USE_SCANCODE_SET 1
|
|
#else
|
|
#define USE_SCANCODE_SET 0
|
|
#endif
|
|
|
|
#if !USE_SCANCODE_SET
|
|
|
|
static VasEBoot_uint8_t
|
|
VasEBoot_keyboard_controller_read (void)
|
|
{
|
|
at_command (KEYBOARD_COMMAND_READ);
|
|
keyboard_controller_wait_until_ready ();
|
|
return VasEBoot_inb (KEYBOARD_REG_DATA);
|
|
}
|
|
|
|
#endif
|
|
|
|
static int
|
|
write_mode (int mode)
|
|
{
|
|
unsigned i;
|
|
for (i = 0; i < VasEBoot_AT_TRIES; i++)
|
|
{
|
|
VasEBoot_uint8_t ack;
|
|
keyboard_controller_wait_until_ready ();
|
|
VasEBoot_outb (0xf0, KEYBOARD_REG_DATA);
|
|
keyboard_controller_wait_until_ready ();
|
|
VasEBoot_outb (mode, KEYBOARD_REG_DATA);
|
|
keyboard_controller_wait_until_ready ();
|
|
ack = wait_ack ();
|
|
if (ack == VasEBoot_AT_NACK)
|
|
continue;
|
|
if (ack == VasEBoot_AT_ACK)
|
|
break;
|
|
return 0;
|
|
}
|
|
|
|
return (i != VasEBoot_AT_TRIES);
|
|
}
|
|
|
|
static int
|
|
query_mode (void)
|
|
{
|
|
VasEBoot_uint8_t ret;
|
|
int e;
|
|
|
|
e = write_mode (0);
|
|
if (!e)
|
|
return 0;
|
|
|
|
keyboard_controller_wait_until_ready ();
|
|
|
|
do
|
|
ret = VasEBoot_inb (KEYBOARD_REG_DATA);
|
|
while (ret == VasEBoot_AT_ACK);
|
|
|
|
/* QEMU translates the set even in no-translate mode. */
|
|
if (ret == 0x43 || ret == 1)
|
|
return 1;
|
|
if (ret == 0x41 || ret == 2)
|
|
return 2;
|
|
if (ret == 0x3f || ret == 3)
|
|
return 3;
|
|
return 0;
|
|
}
|
|
|
|
static void
|
|
set_scancodes (void)
|
|
{
|
|
/* You must have visited computer museum. Keyboard without scancode set
|
|
knowledge. Assume XT. */
|
|
if (!VasEBoot_keyboard_orig_set)
|
|
{
|
|
VasEBoot_dprintf ("atkeyb", "No sets support assumed\n");
|
|
current_set = 1;
|
|
return;
|
|
}
|
|
|
|
#if !USE_SCANCODE_SET
|
|
current_set = 1;
|
|
return;
|
|
#else
|
|
|
|
VasEBoot_keyboard_controller_write (VasEBoot_keyboard_controller_orig
|
|
& ~KEYBOARD_AT_TRANSLATE);
|
|
|
|
write_mode (2);
|
|
current_set = query_mode ();
|
|
VasEBoot_dprintf ("atkeyb", "returned set %d\n", current_set);
|
|
if (current_set == 2)
|
|
return;
|
|
|
|
write_mode (1);
|
|
current_set = query_mode ();
|
|
VasEBoot_dprintf ("atkeyb", "returned set %d\n", current_set);
|
|
if (current_set == 1)
|
|
return;
|
|
VasEBoot_dprintf ("atkeyb", "no supported scancode set found\n");
|
|
#endif
|
|
}
|
|
|
|
static void
|
|
keyboard_controller_led (VasEBoot_uint8_t leds)
|
|
{
|
|
keyboard_controller_wait_until_ready ();
|
|
VasEBoot_outb (0xed, KEYBOARD_REG_DATA);
|
|
keyboard_controller_wait_until_ready ();
|
|
VasEBoot_outb (leds & 0x7, KEYBOARD_REG_DATA);
|
|
}
|
|
|
|
static int
|
|
fetch_key (int *is_break)
|
|
{
|
|
int was_ext = 0;
|
|
VasEBoot_uint8_t at_key;
|
|
int ret = 0;
|
|
|
|
if (! KEYBOARD_ISREADY (VasEBoot_inb (KEYBOARD_REG_STATUS)))
|
|
return -1;
|
|
at_key = VasEBoot_inb (KEYBOARD_REG_DATA);
|
|
/* May happen if no keyboard is connected. Just ignore this. */
|
|
if (at_key == 0xff)
|
|
return -1;
|
|
if (at_key == 0xe0)
|
|
{
|
|
e0_received = 1;
|
|
return -1;
|
|
}
|
|
|
|
if ((current_set == 2 || current_set == 3) && at_key == 0xf0)
|
|
{
|
|
f0_received = 1;
|
|
return -1;
|
|
}
|
|
|
|
/* Setting LEDs may generate ACKs. */
|
|
if (at_key == VasEBoot_AT_ACK)
|
|
return -1;
|
|
|
|
was_ext = e0_received;
|
|
e0_received = 0;
|
|
|
|
switch (current_set)
|
|
{
|
|
case 1:
|
|
*is_break = !!(at_key & 0x80);
|
|
if (!was_ext)
|
|
ret = set1_mapping[at_key & 0x7f];
|
|
else
|
|
{
|
|
unsigned i;
|
|
for (i = 0; i < ARRAY_SIZE (set1_e0_mapping); i++)
|
|
if (set1_e0_mapping[i].from == (at_key & 0x7f))
|
|
{
|
|
ret = set1_e0_mapping[i].to;
|
|
break;
|
|
}
|
|
}
|
|
break;
|
|
case 2:
|
|
*is_break = f0_received;
|
|
f0_received = 0;
|
|
if (!was_ext)
|
|
ret = set2_mapping[at_key];
|
|
else
|
|
{
|
|
unsigned i;
|
|
for (i = 0; i < ARRAY_SIZE (set2_e0_mapping); i++)
|
|
if (set2_e0_mapping[i].from == at_key)
|
|
{
|
|
ret = set2_e0_mapping[i].to;
|
|
break;
|
|
}
|
|
}
|
|
break;
|
|
default:
|
|
return -1;
|
|
}
|
|
if (!ret)
|
|
{
|
|
if (was_ext)
|
|
VasEBoot_dprintf ("atkeyb", "Unknown key 0xe0+0x%02x from set %d\n",
|
|
at_key, current_set);
|
|
else
|
|
VasEBoot_dprintf ("atkeyb", "Unknown key 0x%02x from set %d\n",
|
|
at_key, current_set);
|
|
return -1;
|
|
}
|
|
return ret;
|
|
}
|
|
|
|
/* FIXME: This should become an interrupt service routine. For now
|
|
it's just used to catch events from control keys. */
|
|
static int
|
|
VasEBoot_keyboard_isr (VasEBoot_keyboard_key_t key, int is_break)
|
|
{
|
|
if (!is_break)
|
|
switch (key)
|
|
{
|
|
case VasEBoot_KEYBOARD_KEY_LEFT_SHIFT:
|
|
at_keyboard_status |= VasEBoot_TERM_STATUS_LSHIFT;
|
|
return 1;
|
|
case VasEBoot_KEYBOARD_KEY_RIGHT_SHIFT:
|
|
at_keyboard_status |= VasEBoot_TERM_STATUS_RSHIFT;
|
|
return 1;
|
|
case VasEBoot_KEYBOARD_KEY_LEFT_CTRL:
|
|
at_keyboard_status |= VasEBoot_TERM_STATUS_LCTRL;
|
|
return 1;
|
|
case VasEBoot_KEYBOARD_KEY_RIGHT_CTRL:
|
|
at_keyboard_status |= VasEBoot_TERM_STATUS_RCTRL;
|
|
return 1;
|
|
case VasEBoot_KEYBOARD_KEY_RIGHT_ALT:
|
|
at_keyboard_status |= VasEBoot_TERM_STATUS_RALT;
|
|
return 1;
|
|
case VasEBoot_KEYBOARD_KEY_LEFT_ALT:
|
|
at_keyboard_status |= VasEBoot_TERM_STATUS_LALT;
|
|
return 1;
|
|
default:
|
|
return 0;
|
|
}
|
|
else
|
|
switch (key)
|
|
{
|
|
case VasEBoot_KEYBOARD_KEY_LEFT_SHIFT:
|
|
at_keyboard_status &= ~VasEBoot_TERM_STATUS_LSHIFT;
|
|
return 1;
|
|
case VasEBoot_KEYBOARD_KEY_RIGHT_SHIFT:
|
|
at_keyboard_status &= ~VasEBoot_TERM_STATUS_RSHIFT;
|
|
return 1;
|
|
case VasEBoot_KEYBOARD_KEY_LEFT_CTRL:
|
|
at_keyboard_status &= ~VasEBoot_TERM_STATUS_LCTRL;
|
|
return 1;
|
|
case VasEBoot_KEYBOARD_KEY_RIGHT_CTRL:
|
|
at_keyboard_status &= ~VasEBoot_TERM_STATUS_RCTRL;
|
|
return 1;
|
|
case VasEBoot_KEYBOARD_KEY_RIGHT_ALT:
|
|
at_keyboard_status &= ~VasEBoot_TERM_STATUS_RALT;
|
|
return 1;
|
|
case VasEBoot_KEYBOARD_KEY_LEFT_ALT:
|
|
at_keyboard_status &= ~VasEBoot_TERM_STATUS_LALT;
|
|
return 1;
|
|
default:
|
|
return 0;
|
|
}
|
|
}
|
|
|
|
/* If there is a raw key pending, return it; otherwise return -1. */
|
|
static int
|
|
VasEBoot_keyboard_getkey (void)
|
|
{
|
|
int key;
|
|
int is_break = 0;
|
|
|
|
key = fetch_key (&is_break);
|
|
if (key == -1)
|
|
return -1;
|
|
|
|
if (VasEBoot_keyboard_isr (key, is_break))
|
|
return -1;
|
|
if (is_break)
|
|
return -1;
|
|
return key;
|
|
}
|
|
|
|
int
|
|
VasEBoot_at_keyboard_is_alive (void)
|
|
{
|
|
if (current_set != 0)
|
|
return 1;
|
|
if (ping_sent
|
|
&& KEYBOARD_COMMAND_ISREADY (VasEBoot_inb (KEYBOARD_REG_STATUS))
|
|
&& VasEBoot_inb (KEYBOARD_REG_DATA) == 0x55)
|
|
{
|
|
VasEBoot_keyboard_controller_init ();
|
|
return 1;
|
|
}
|
|
|
|
if (KEYBOARD_COMMAND_ISREADY (VasEBoot_inb (KEYBOARD_REG_STATUS)))
|
|
{
|
|
VasEBoot_outb (0xaa, KEYBOARD_REG_STATUS);
|
|
ping_sent = 1;
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
/* If there is a character pending, return it;
|
|
otherwise return VasEBoot_TERM_NO_KEY. */
|
|
static int
|
|
VasEBoot_at_keyboard_getkey (struct VasEBoot_term_input *term __attribute__ ((unused)))
|
|
{
|
|
int code;
|
|
|
|
if (!VasEBoot_at_keyboard_is_alive ())
|
|
return VasEBoot_TERM_NO_KEY;
|
|
|
|
code = VasEBoot_keyboard_getkey ();
|
|
if (code == -1)
|
|
return VasEBoot_TERM_NO_KEY;
|
|
#ifdef DEBUG_AT_KEYBOARD
|
|
VasEBoot_dprintf ("atkeyb", "Detected key 0x%x\n", code);
|
|
#endif
|
|
switch (code)
|
|
{
|
|
case VasEBoot_KEYBOARD_KEY_CAPS_LOCK:
|
|
at_keyboard_status ^= VasEBoot_TERM_STATUS_CAPS;
|
|
led_status ^= KEYBOARD_LED_CAPS;
|
|
keyboard_controller_led (led_status);
|
|
|
|
#ifdef DEBUG_AT_KEYBOARD
|
|
VasEBoot_dprintf ("atkeyb", "caps_lock = %d\n", !!(at_keyboard_status & VasEBoot_KEYBOARD_STATUS_CAPS_LOCK));
|
|
#endif
|
|
return VasEBoot_TERM_NO_KEY;
|
|
case VasEBoot_KEYBOARD_KEY_NUM_LOCK:
|
|
at_keyboard_status ^= VasEBoot_TERM_STATUS_NUM;
|
|
led_status ^= KEYBOARD_LED_NUM;
|
|
keyboard_controller_led (led_status);
|
|
|
|
#ifdef DEBUG_AT_KEYBOARD
|
|
VasEBoot_dprintf ("atkeyb", "num_lock = %d\n", !!(at_keyboard_status & VasEBoot_KEYBOARD_STATUS_NUM_LOCK));
|
|
#endif
|
|
return VasEBoot_TERM_NO_KEY;
|
|
case VasEBoot_KEYBOARD_KEY_SCROLL_LOCK:
|
|
at_keyboard_status ^= VasEBoot_TERM_STATUS_SCROLL;
|
|
led_status ^= KEYBOARD_LED_SCROLL;
|
|
keyboard_controller_led (led_status);
|
|
return VasEBoot_TERM_NO_KEY;
|
|
default:
|
|
return VasEBoot_term_map_key (code, at_keyboard_status);
|
|
}
|
|
}
|
|
|
|
static void
|
|
VasEBoot_keyboard_controller_init (void)
|
|
{
|
|
at_keyboard_status = 0;
|
|
/* Drain input buffer. */
|
|
while (1)
|
|
{
|
|
keyboard_controller_wait_until_ready ();
|
|
if (! KEYBOARD_ISREADY (VasEBoot_inb (KEYBOARD_REG_STATUS)))
|
|
break;
|
|
keyboard_controller_wait_until_ready ();
|
|
VasEBoot_inb (KEYBOARD_REG_DATA);
|
|
}
|
|
#if defined (VasEBoot_MACHINE_MIPS_LOONGSON) || defined (VasEBoot_MACHINE_MIPS_QEMU_MIPS)
|
|
VasEBoot_keyboard_controller_orig = 0;
|
|
VasEBoot_keyboard_orig_set = 2;
|
|
#elif defined (VasEBoot_MACHINE_QEMU) || defined (VasEBoot_MACHINE_COREBOOT)
|
|
/* *BSD relies on those settings. */
|
|
VasEBoot_keyboard_controller_orig = KEYBOARD_AT_TRANSLATE;
|
|
VasEBoot_keyboard_orig_set = 2;
|
|
#else
|
|
VasEBoot_keyboard_controller_orig = VasEBoot_keyboard_controller_read ();
|
|
VasEBoot_keyboard_orig_set = query_mode ();
|
|
#endif
|
|
set_scancodes ();
|
|
keyboard_controller_led (led_status);
|
|
}
|
|
|
|
static VasEBoot_err_t
|
|
VasEBoot_keyboard_controller_fini (struct VasEBoot_term_input *term __attribute__ ((unused)))
|
|
{
|
|
if (current_set == 0)
|
|
return VasEBoot_ERR_NONE;
|
|
if (VasEBoot_keyboard_orig_set)
|
|
write_mode (VasEBoot_keyboard_orig_set);
|
|
VasEBoot_keyboard_controller_write (VasEBoot_keyboard_controller_orig);
|
|
return VasEBoot_ERR_NONE;
|
|
}
|
|
|
|
static VasEBoot_err_t
|
|
VasEBoot_at_fini_hw (int noreturn __attribute__ ((unused)))
|
|
{
|
|
return VasEBoot_keyboard_controller_fini (NULL);
|
|
}
|
|
|
|
static VasEBoot_err_t
|
|
VasEBoot_at_restore_hw (void)
|
|
{
|
|
if (current_set == 0)
|
|
return VasEBoot_ERR_NONE;
|
|
|
|
/* Drain input buffer. */
|
|
while (1)
|
|
{
|
|
keyboard_controller_wait_until_ready ();
|
|
if (! KEYBOARD_ISREADY (VasEBoot_inb (KEYBOARD_REG_STATUS)))
|
|
break;
|
|
keyboard_controller_wait_until_ready ();
|
|
VasEBoot_inb (KEYBOARD_REG_DATA);
|
|
}
|
|
set_scancodes ();
|
|
keyboard_controller_led (led_status);
|
|
|
|
return VasEBoot_ERR_NONE;
|
|
}
|
|
|
|
|
|
static struct VasEBoot_term_input VasEBoot_at_keyboard_term =
|
|
{
|
|
.name = "at_keyboard",
|
|
.fini = VasEBoot_keyboard_controller_fini,
|
|
.getkey = VasEBoot_at_keyboard_getkey
|
|
};
|
|
|
|
VasEBoot_MOD_INIT(at_keyboard)
|
|
{
|
|
VasEBoot_term_register_input ("at_keyboard", &VasEBoot_at_keyboard_term);
|
|
VasEBoot_loader_register_preboot_hook (VasEBoot_at_fini_hw, VasEBoot_at_restore_hw,
|
|
VasEBoot_LOADER_PREBOOT_HOOK_PRIO_CONSOLE);
|
|
}
|
|
|
|
VasEBoot_MOD_FINI(at_keyboard)
|
|
{
|
|
VasEBoot_keyboard_controller_fini (NULL);
|
|
VasEBoot_term_unregister_input (&VasEBoot_at_keyboard_term);
|
|
}
|