/** * Definitions for the PS/2 interface devices... mouse and keyboard */ #include "log.h" #include "types.h" #include "ring_buffer.h" #include "dev/ps2.h" #include "dev/text_screen_iii.h" #include "interrupt.h" #define PS2_RETRY_MAX 1000 /* * Controller responses */ #define PS2_RESP_OK 0x55 /* Keyboard response: Command was OK */ #define PS2_RESP_ACK 0xFA /* Keyboard response: command acknowledged */ /* * Modifier bit flags */ #define KBD_LOCK_SCROLL 0x01 #define KBD_LOCK_NUM 0x02 #define KBD_LOCK_CAPS 0x04 #define KBD_MOD_SHIFT 0x08 #define KBD_MOD_CTRL 0x10 #define KBD_MOD_ALT 0x20 #define KBD_MOD_OS 0x40 #define KBD_MOD_MENU 0x80 /* * Special scan codes */ #define KBD_SC_PIVOT 0x38 /* * Structures */ /* * States the keyboard driver can be in */ typedef enum kbd_state { KBD_ST_IDLE = 0, KBD_ST_E0, KBD_ST_E02A, KBD_ST_E02AE0, KBD_ST_E1, KBD_ST_E11D, KBD_ST_E11D45, KBD_ST_E11D45E1, KBD_ST_E11D45E19D, KBD_ST_E0B7, KBD_ST_E0B7E0 } t_kbd_state; /* * Structure to track the keyboard input */ struct s_ps2_kbd { t_kbd_state state; /* State of the scan code processing state machine */ unsigned char control; /* Bits to control how the keyboard processes things */ unsigned char status; /* Status of the keyboard */ t_word_ring sc_buf; /* Buffer containing scancodes that have been processed */ t_word_ring char_buf; /* Buffer containing characters to be read */ unsigned char modifiers; /* State of the modifier keys (CTRL, ALT, SHIFT) and caps lock */ /* Scan code to character lookup tables */ char * keys_unmodified; char * keys_shift; char * keys_control; char * keys_control_shift; char * keys_caps; char * keys_caps_shift; }; /* * Driver global variables */ struct s_ps2_kbd g_kbd_control; // Translation table from base set1 make scan codes to Foenix scan codes unsigned char g_kbd_set1_base[128] = { 0x00, 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07, /* 0x00 - 0x07 */ 0x08, 0x09, 0x0A, 0x0B, 0x0C, 0x0D, 0x0E, 0x0F, /* 0x08 - 0x0F */ 0x10, 0x11, 0x12, 0x13, 0x14, 0x15, 0x16, 0x17, /* 0x10 - 0x17 */ 0x18, 0x19, 0x1A, 0x1B, 0x1C, 0x1D, 0x1E, 0x1F, /* 0x18 - 0x1F */ 0x20, 0x21, 0x22, 0x23, 0x24, 0x25, 0x26, 0x27, /* 0x20 - 0x27 */ 0x28, 0x29, 0x2A, 0x2B, 0x2C, 0x2D, 0x2E, 0x2F, /* 0x28 - 0x2F */ 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, /* 0x30 - 0x37 */ 0x38, 0x39, 0x3A, 0x3B, 0x3C, 0x3D, 0x3E, 0x3F, /* 0x38 - 0x3F */ 0x40, 0x41, 0x42, 0x43, 0x44, 0x45, 0x46, 0x47, /* 0x40 - 0x47 */ 0x48, 0x49, 0x4A, 0x4B, 0x4C, 0x4D, 0x4E, 0x4F, /* 0x48 - 0x4F */ 0x50, 0x51, 0x52, 0x53, 0x54, 0x55, 0x56, 0x57, /* 0x50 - 0x57 */ 0x58, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, /* 0x58 - 0x5F */ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, /* 0x60 - 0x67 */ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, /* 0x68 - 0x6F */ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, /* 0x70 - 0x77 */ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 /* 0x78 - 0x7F */ }; // Translation table from E0 prefixed set1 make scan codes to Foenix scan codes unsigned char g_kbd_set1_e0[128] = { 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, /* 0x00 - 0x07 */ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, /* 0x08 - 0x0F */ 0x70, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, /* 0x10 - 0x17 */ 0x00, 0x71, 0x00, 0x00, 0x6D, 0x5E, 0x00, 0x00, /* 0x18 - 0x1F */ 0x72, 0x00, 0x6E, 0x00, 0x6F, 0x00, 0x00, 0x00, /* 0x20 - 0x27 */ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x73, 0x00, /* 0x28 - 0x2F */ 0x74, 0x00, 0x00, 0x00, 0x00, 0x6C, 0x00, 0x00, /* 0x30 - 0x37 */ 0x5C, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, /* 0x38 - 0x3F */ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x61, 0x63, /* 0x40 - 0x47 */ 0x68, 0x64, 0x00, 0x69, 0x00, 0x6B, 0x00, 0x66, /* 0x48 - 0x4F */ 0x6A, 0x67, 0x62, 0x65, 0x00, 0x00, 0x00, 0x00, /* 0x50 - 0x57 */ 0x00, 0x00, 0x00, 0x00, 0x00, 0x5D, 0x00, 0x00, /* 0x58 - 0x5F */ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, /* 0x60 - 0x67 */ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, /* 0x68 - 0x6F */ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, /* 0x70 - 0x77 */ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 /* 0x78 - 0x7F */ }; /* * US keyboard layout scancode translation tables */ char g_us_sc_unmodified[] = { 0x00, 0x1B, '1', '2', '3', '4', '5', '6', /* 0x00 - 0x07 */ '7', '8', '9', '0', '-', '=', 0x08, 0x09, /* 0x08 - 0x0F */ 'q', 'w', 'e', 'r', 't', 'y', 'u', 'i', /* 0x10 - 0x17 */ 'o', 'p', '[', ']', 0x0D, 0x00, 'a', 's', /* 0x18 - 0x1F */ 'd', 'f', 'g', 'h', 'j', 'k', 'l', ';', /* 0x20 - 0x27 */ 0x27, '`', 0x00, '\\', 'z', 'x', 'c', 'v', /* 0x28 - 0x2F */ 'b', 'n', 'm', ',', '.', '/', 0x00, '*', /* 0x30 - 0x37 */ 0x00, ' ', 0x00, 0x8A, 0x8B, 0x8C, 0x8D, 0x8E, /* 0x38 - 0x3F */ 0x8F, 0x90, 0x91, 0x92, 0x93, 0x00, 0x00, 0x80, /* 0x40 - 0x47 */ 0x86, 0x84, '-', 0x89, '5', 0x88, '+', 0x83, /* 0x48 - 0x4F */ 0x87, 0x85, 0x81, 0x82, 0x00, 0x00, 0x00, 0x94, /* 0x50 - 0x57 */ 0x95, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, /* 0x58 - 0x5F */ 0x00, 0x00, 0x81, 0x80, 0x84, 0x82, 0x83, 0x85, /* 0x60 - 0x67 */ 0x86, 0x89, 0x87, 0x88, '/', 0x0D, 0x00, 0x00, /* 0x68 - 0x6F */ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, /* 0x70 - 0x77 */ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 /* 0x78 - 0x7F */ }; char g_us_sc_shift[] = { 0x00, 0x1B, '!', '@', '#', '$', '%', '^', /* 0x00 - 0x07 */ '&', '*', '(', ')', '_', '+', 0x08, 0x09, /* 0x08 - 0x0F */ 'Q', 'W', 'E', 'R', 'T', 'Y', 'U', 'I', /* 0x10 - 0x17 */ 'O', 'P', '{', '}', 0x0A, 0x00, 'A', 'S', /* 0x18 - 0x1F */ 'D', 'F', 'G', 'H', 'J', 'K', 'L', ':', /* 0x20 - 0x27 */ 0x22, '~', 0x00, '|', 'Z', 'X', 'C', 'V', /* 0x28 - 0x2F */ 'B', 'N', 'M', '<', '>', '?', 0x00, 0x00, /* 0x30 - 0x37 */ 0x00, ' ', 0x00, 0x8A, 0x8B, 0x8C, 0x8D, 0x8E, /* 0x38 - 0x3F */ 0x8F, 0x90, 0x91, 0x92, 0x93, 0x00, 0x00, 0x80, /* 0x40 - 0x47 */ 0x86, 0x84, '-', 0x89, '5', 0x88, '+', 0x83, /* 0x48 - 0x4F */ 0x87, 0x85, 0x81, 0x82, 0x00, 0x00, 0x00, 0x94, /* 0x50 - 0x57 */ 0x95, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, /* 0x58 - 0x5F */ 0x00, 0x00, 0x81, 0x80, 0x84, 0x82, 0x83, 0x85, /* 0x60 - 0x67 */ 0x86, 0x89, 0x87, 0x88, '/', 0x0D, 0x00, 0x00, /* 0x68 - 0x6F */ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, /* 0x70 - 0x77 */ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 /* 0x78 - 0x7F */ }; char g_us_sc_ctrl[] = { 0x00, 0x1B, '1', '2', '3', '4', '5', 0x1E, /* 0x00 - 0x07 */ '7', '8', '9', '0', 0x1F, '=', 0x08, 0x09, /* 0x08 - 0x0F */ 0x11, 0x17, 0x05, 0x12, 0x14, 0x19, 0x15, 0x09, /* 0x10 - 0x17 */ 0x0F, 0x10, 0x1B, 0x1D, 0x0A, 0x00, 0x01, 0x13, /* 0x18 - 0x1F */ 0x04, 0x06, 0x07, 0x08, 0x0A, 0x0B, 0x0C, ';', /* 0x20 - 0x27 */ 0x22, '`', 0x00, '\\', 0x1A, 0x18, 0x03, 0x16, /* 0x28 - 0x2F */ 0x02, 0x0E, 0x0D, ',', '.', 0x1C, 0x00, 0x00, /* 0x30 - 0x37 */ 0x00, ' ', 0x00, 0x8A, 0x8B, 0x8C, 0x8D, 0x8E, /* 0x38 - 0x3F */ 0x8F, 0x90, 0x91, 0x92, 0x93, 0x00, 0x00, 0x80, /* 0x40 - 0x47 */ 0x86, 0x84, '-', 0x89, '5', 0x88, '+', 0x83, /* 0x48 - 0x4F */ 0x87, 0x85, 0x81, 0x82, 0x00, 0x00, 0x00, 0x94, /* 0x50 - 0x57 */ 0x95, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, /* 0x58 - 0x5F */ 0x00, 0x00, 0x81, 0x80, 0x84, 0x82, 0x83, 0x85, /* 0x60 - 0x67 */ 0x86, 0x89, 0x87, 0x88, '/', 0x0D, 0x00, 0x00, /* 0x68 - 0x6F */ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, /* 0x70 - 0x77 */ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 /* 0x78 - 0x7F */ }; char g_us_sc_lock[] = { 0x00, 0x1B, '1', '2', '3', '4', '5', '6', /* 0x00 - 0x07 */ '7', '8', '9', '0', '-', '=', 0x08, 0x09, /* 0x08 - 0x0F */ 'Q', 'W', 'E', 'R', 'T', 'Y', 'U', 'I', /* 0x10 - 0x17 */ 'O', 'P', '[', ']', 0x0D, 0x00, 'A', 'S', /* 0x18 - 0x1F */ 'D', 'F', 'G', 'H', 'J', 'K', 'L', ';', /* 0x20 - 0x27 */ 0x27, '`', 0x00, '\\', 'Z', 'X', 'C', 'V', /* 0x28 - 0x2F */ 'B', 'N', 'M', ',', '.', '/', 0x00, 0x00, /* 0x30 - 0x37 */ 0x00, ' ', 0x00, 0x8A, 0x8B, 0x8C, 0x8D, 0x8E, /* 0x38 - 0x3F */ 0x8F, 0x90, 0x91, 0x92, 0x93, 0x00, 0x00, '7', /* 0x40 - 0x47 */ '8', '9', '-', '4', '5', '6', '+', '1', /* 0x48 - 0x4F */ '2', '3', '0', '.', 0x00, 0x00, 0x00, 0x94, /* 0x50 - 0x57 */ 0x95, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, /* 0x58 - 0x5F */ 0x00, 0x00, 0x81, 0x80, 0x84, 0x82, 0x83, 0x85, /* 0x60 - 0x67 */ 0x86, 0x89, 0x87, 0x88, '/', 0x0D, 0x00, 0x00, /* 0x68 - 0x6F */ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, /* 0x70 - 0x77 */ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 /* 0x78 - 0x7F */ }; char g_us_sc_lock_shift[] = { 0x00, 0x1B, '!', '@', '#', '$', '%', '^', /* 0x00 - 0x07 */ '&', '*', '(', ')', '_', '+', 0x08, 0x09, /* 0x08 - 0x0F */ 'q', 'w', 'e', 'r', 't', 'y', 'u', 'i', /* 0x10 - 0x17 */ 'o', 'p', '{', '}', 0x0A, 0x00, 'a', 's', /* 0x18 - 0x1F */ 'd', 'f', 'g', 'h', 'j', 'k', 'l', ':', /* 0x20 - 0x27 */ 0x22, '~', 0x00, '|', 'z', 'x', 'c', 'v', /* 0x28 - 0x2F */ 'b', 'n', 'm', '<', '>', '?', 0x00, 0x00, /* 0x30 - 0x37 */ 0x00, ' ', 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, /* 0x38 - 0x3F */ 0x8F, 0x90, 0x91, 0x92, 0x93, 0x00, 0x00, '7', /* 0x40 - 0x47 */ '8', '9', '-', '4', '5', '6', '+', '1', /* 0x48 - 0x4F */ '2', '3', '0', '.', 0x00, 0x00, 0x00, 0x94, /* 0x50 - 0x57 */ 0x95, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, /* 0x58 - 0x5F */ 0x00, 0x00, 0x81, 0x80, 0x84, 0x82, 0x83, 0x85, /* 0x60 - 0x67 */ 0x86, 0x89, 0x87, 0x88, '/', 0x0D, 0x00, 0x00, /* 0x68 - 0x6F */ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, /* 0x70 - 0x77 */ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 /* 0x78 - 0x7F */ }; char g_us_sc_ctrl_shift[] = { 0x00, 0x1B, '!', '@', '#', '$', '%', '^', /* 0x00 - 0x07 */ '&', '*', '(', ')', '_', '+', 0x08, 0x09, /* 0x08 - 0x0F */ 0x11, 0x17, 0x05, 0x12, 0x14, 0x19, 0x15, 0x09, /* 0x10 - 0x17 */ 0x0F, 0x10, 0x1B, 0x1D, 0x0A, 0x00, 0x01, 0x13, /* 0x18 - 0x1F */ 0x04, 0x06, 0x07, 0x08, 0x0A, 0x0B, 0x0C, ';', /* 0x20 - 0x27 */ 0x22, '`', 0x00, '\\', 0x1A, 0x18, 0x03, 0x16, /* 0x28 - 0x2F */ 0x02, 0x0E, 0x0D, ',', '.', 0x1C, 0x00, 0x00, /* 0x30 - 0x37 */ 0x00, ' ', 0x00, 0x8A, 0x8B, 0x8C, 0x8D, 0x8E, /* 0x38 - 0x3F */ 0x8F, 0x90, 0x91, 0x92, 0x93, 0x00, 0x00, 0x80, /* 0x40 - 0x47 */ 0x86, 0x84, '-', 0x89, '5', 0x88, '+', 0x83, /* 0x48 - 0x4F */ 0x87, 0x85, 0x81, 0x82, 0x00, 0x00, 0x00, 0x94, /* 0x50 - 0x57 */ 0x95, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, /* 0x58 - 0x5F */ 0x00, 0x00, 0x81, 0x80, 0x84, 0x82, 0x83, 0x85, /* 0x60 - 0x67 */ 0x86, 0x89, 0x87, 0x88, '/', 0x0D, 0x00, 0x00, /* 0x68 - 0x6F */ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, /* 0x70 - 0x77 */ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 /* 0x78 - 0x7F */ }; /* * Code... */ /* * Wait for the output buffer of the PS/2 controller to hace data. * * Returns: * 0 if successful, -1 if there was no response after PS2_RETRY_MAX tries */ short ps2_wait_out() { volatile unsigned char *status = (unsigned char *)PS2_STATUS; short count = 0; while ((*status & PS2_STAT_OBF) == 0) { if (count++ > PS2_RETRY_MAX) { return -1; } } return 0; } /* * Wait for the input buffer of the PS/2 controller to be clear. * * Returns: * 0 if successful, -1 if there was no response after PS2_RETRY_MAX tries */ short ps2_wait_in() { volatile unsigned char *status = (unsigned char *)PS2_STATUS; short count = 0; while ((*status & PS2_STAT_IBF) != 0) { if (count++ > PS2_RETRY_MAX) { return -1; } } return 0; } /* * Send a command to the controller and wait for a response. * * Returns: * The response from the PS/2 controller, -1 if there was a timeout */ short ps2_controller_cmd(unsigned char cmd) { volatile unsigned char *command = (unsigned char *)PS2_CMD_BUF; volatile unsigned char *data = (unsigned char *)PS2_DATA_BUF; if (ps2_wait_in()) return -1; *command = cmd; if (ps2_wait_out()) return -1; return (short)*data; } /* * Send a command with parameter to the controller and wait for a response. * * Returns: * The response from the PS/2 controller, -1 if there was a timeout */ short ps2_controller_cmd_param(unsigned char cmd, unsigned char parameter) { volatile unsigned char *command = (unsigned char *)PS2_CMD_BUF; volatile unsigned char *data = (unsigned char *)PS2_DATA_BUF; if (ps2_wait_in()) return -1; *command = cmd; if (ps2_wait_in()) return -1; *data = parameter; return 0; } /* * Send a command with parameter to the keyboard and wait for a response. * * Returns: * The response from the PS/2 controller, -1 if there was a timeout */ short ps2_kbd_cmd_p(unsigned char cmd, unsigned char parameter) { volatile unsigned char *command = (unsigned char *)PS2_CMD_BUF; volatile unsigned char *data = (unsigned char *)PS2_DATA_BUF; if (ps2_wait_in()) return -1; *data = cmd; // May need a delay here if (ps2_wait_in()) return -1; *data = parameter; // Return 0 by default... maybe read DATA? return 0; } /* * Send a command to the keyboard and wait for a response. * * Inputs: * cmd = the command byte to send to the keyboard * delay = an indication of how much to wait before checking for output * * Returns: * The response from the PS/2 controller, -1 if there was a timeout */ short ps2_kbd_cmd(unsigned char cmd, short delay) { volatile unsigned char *data = (unsigned char *)PS2_DATA_BUF; if (ps2_wait_in()) return -1; *data = cmd; // A delay may be needed here while (delay-- > 0) { ; } if (ps2_wait_out()) return -1; return (short)*data; } /* * Read from the PS/2 data port until there are no more bytes ready. */ void ps2_flush_out() { volatile unsigned char *status = (unsigned char *)PS2_STATUS; volatile unsigned char *data = (unsigned char *)PS2_DATA_BUF; while (*status & PS2_STAT_OBF) { unsigned char x = *data; } } /* * Toggle the lock bit based on the flag. */ void kbd_toggle_modifier(short flag) { g_kbd_control.modifiers ^= flag; } /* * Set or clear the modifier flag depending on if the scan code is a make or break code. */ void kbd_makebreak_modifier(short flag, short is_break) { if (is_break) { g_kbd_control.modifiers &= ~flag; } else { g_kbd_control.modifiers |= flag; } } /* * Add the scan code to the queue of scan codes */ void kbd_enqueue_scan(unsigned char scan_code) { // Make sure the scan code isn't 0 or 128, which are invalid make/break codes if ((scan_code != 0) && (scan_code != 0x80)) { unsigned char is_break = scan_code & 0x80; // Check the scan code to see if it's a modifier key or a lock key // update the modifier and lock variables accordingly... switch (scan_code & 0x7f) { case 0x2A: case 0x36: kbd_makebreak_modifier(KBD_MOD_SHIFT, is_break); break; case 0x1D: case 0x5E: kbd_makebreak_modifier(KBD_MOD_CTRL, is_break); break; case 0x38: case 0x5C: kbd_makebreak_modifier(KBD_MOD_ALT, is_break); break; case 0x5D: kbd_makebreak_modifier(KBD_MOD_MENU, is_break); break; case 0x5B: kbd_makebreak_modifier(KBD_MOD_OS, is_break); break; case 0x3A: if (!is_break) kbd_toggle_modifier(KBD_LOCK_CAPS); break; case 0x45: if (!is_break) kbd_toggle_modifier(KBD_LOCK_NUM); break; case 0x46: if (!is_break) kbd_toggle_modifier(KBD_LOCK_SCROLL); break; default: break; } rb_word_put(&g_kbd_control.sc_buf, g_kbd_control.modifiers << 8 | scan_code); } } /* * Try to retrieve the next scancode from the keyboard. * * Returns: * The next scancode to be processed, 0 if nothing. */ unsigned short kbd_get_scancode() { return rb_word_get(&g_kbd_control.sc_buf); } /* * IRQ handler for the keyboard... read a scan code and queue it */ void kbd_handle_irq() { volatile unsigned char *data = (unsigned char *)PS2_DATA_BUF; unsigned char scan_code = *data; unsigned char translated_code; /* Clear the pending flag */ int_clear(INT_KBD_PS2); if (scan_code) { // Make sure the scan code isn't 0 or 128, which are invalid make/break codes if ((scan_code != 0) && (scan_code != 0x80)) { unsigned char is_break = scan_code & 0x80; // Process the byte according to the state machine... switch (g_kbd_control.state) { case KBD_ST_IDLE: switch (scan_code) { case 0xE0: g_kbd_control.state = KBD_ST_E0; break; case 0xE1: g_kbd_control.state = KBD_ST_E1; break; default: // Lookup the translation of the code... translated_code = g_kbd_set1_base[scan_code & 0x7f]; if (translated_code != 0) { // If we got a translation, enqueue it kbd_enqueue_scan(translated_code | is_break); } break; } break; case KBD_ST_E0: switch (scan_code) { case 0x2A: g_kbd_control.state = KBD_ST_E02A; break; case 0xB7: g_kbd_control.state = KBD_ST_E0B7; break; default: // Lookup the translation of the E0 prefixed code... translated_code = g_kbd_set1_e0[scan_code & 0x7f]; if (translated_code != 0) { // If we got a translation, enqueue it kbd_enqueue_scan(translated_code | is_break); } g_kbd_control.state = KBD_ST_IDLE; break; } break; case KBD_ST_E02A: switch (scan_code) { case 0xE0: g_kbd_control.state = KBD_ST_E02AE0; break; default: // Bad scan-code... reset the machine and just eat the code g_kbd_control.state = KBD_ST_IDLE; break; } break; case KBD_ST_E02AE0: switch (scan_code) { case 0x37: g_kbd_control.state = KBD_ST_IDLE; kbd_enqueue_scan(0x60); // Return our PrintScreen key break; default: // Bad scan-code... reset the machine and just eat the code g_kbd_control.state = KBD_ST_IDLE; break; } break; case KBD_ST_E0B7: switch (scan_code) { case 0xE0: g_kbd_control.state = KBD_ST_E0B7E0; break; default: // Bad scan-code... reset the machine and just eat the code g_kbd_control.state = KBD_ST_IDLE; break; } break; case KBD_ST_E0B7E0: switch (scan_code) { case 0xAA: g_kbd_control.state = KBD_ST_IDLE; kbd_enqueue_scan(0xD0); // Return our PrintScreen key break break; default: // Bad scan-code... reset the machine and just eat the code g_kbd_control.state = KBD_ST_IDLE; break; } break; case KBD_ST_E1: switch (scan_code) { case 0x1D: g_kbd_control.state = KBD_ST_E11D; break; default: // Bad scan-code... reset the machine and just eat the code g_kbd_control.state = KBD_ST_IDLE; break; } break; case KBD_ST_E11D: switch (scan_code) { case 0x45: g_kbd_control.state = KBD_ST_E11D45; break; default: // Bad scan-code... reset the machine and just eat the code g_kbd_control.state = KBD_ST_IDLE; break; } break; case KBD_ST_E11D45: switch (scan_code) { case 0xE1: g_kbd_control.state = KBD_ST_E11D45E1; break; default: // Bad scan-code... reset the machine and just eat the code g_kbd_control.state = KBD_ST_IDLE; break; } break; case KBD_ST_E11D45E1: switch (scan_code) { case 0x9D: g_kbd_control.state = KBD_ST_E11D45E19D; break; default: // Bad scan-code... reset the machine and just eat the code g_kbd_control.state = KBD_ST_IDLE; break; } break; case KBD_ST_E11D45E19D: switch (scan_code) { case 0xC5: g_kbd_control.state = KBD_ST_IDLE; kbd_enqueue_scan(0x61); // return our Break key break break; default: // Bad scan-code... reset the machine and just eat the code g_kbd_control.state = KBD_ST_IDLE; break; } break; default: // TODO: kernel panic? ; } } } } /* * Try to get a character from the keyboard... * * Returns: * the next character to be read from the keyboard (0 if none available) */ char kbd_getc() { if (!rb_word_empty(&g_kbd_control.char_buf)) { // If there is a character waiting in the character buffer, return it... return (char)rb_word_get(&g_kbd_control.char_buf); } else { // Otherwise, we need to check the scan code queue... unsigned short raw_code = kbd_get_scancode(); while (raw_code != 0) { if ((raw_code & 0x80) == 0) { // If it's a make code, let's try to look it up... unsigned char modifiers = (raw_code >> 8) & 0xff; // Get the modifiers unsigned char scan_code = raw_code & 0x7f; // Get the base code for the key if (scan_code < KBD_SC_PIVOT) { // It's on the left side of the keyboard, use modifiers to determine lookup table // including SHIFT, CONTROL, CAPS // Check the modifiers to see what we should lookup... if ((modifiers & (KBD_MOD_SHIFT | KBD_MOD_CTRL | KBD_LOCK_CAPS)) == 0) { // No modifiers... just return the base character return g_kbd_control.keys_unmodified[scan_code]; } else if (modifiers & KBD_MOD_CTRL) { // If CTRL is pressed... if (modifiers & KBD_MOD_SHIFT) { // If SHIFT is also pressed, return CTRL-SHIFT form return g_kbd_control.keys_control_shift[scan_code]; } else { // Otherwise, return just CTRL form return g_kbd_control.keys_control[scan_code]; } } else if (modifiers & KBD_LOCK_CAPS) { // If CAPS is locked... if (modifiers & KBD_MOD_SHIFT) { // If SHIFT is also pressed, return CAPS-SHIFT form return g_kbd_control.keys_caps_shift[scan_code]; } else { // Otherwise, return just CAPS form return g_kbd_control.keys_caps[scan_code]; } } else { // SHIFT is pressed, return SHIFT form return g_kbd_control.keys_shift[scan_code]; } } else { // It's on the right side of the keyboard, NUMLOCK determines lock value // TODO: flesh this out... return g_kbd_control.keys_unmodified[scan_code]; } } // If we reach this point, it wasn't a useful scan-code... // So try to fetch another raw_code = kbd_get_scancode(); } // If we reach this point, there are no useful scan codes return 0; } } /* * Initialize the PS2 controller and any attached devices * Enable keyboard and mouse interrupts as appropriate. * * Returns: * Status code indicating if either the mouse or the keyboard is missing. */ short ps2_init() { volatile unsigned char *command = (unsigned char *)PS2_CMD_BUF; volatile unsigned char *data = (unsigned char *)PS2_DATA_BUF; unsigned char x; short res; // Initialize the keyboard controller variables g_kbd_control.state = KBD_ST_IDLE; // Initial state for the scan code state machine rb_word_init(&g_kbd_control.sc_buf); // Scan-code ring buffer is empty rb_word_init(&g_kbd_control.char_buf); // Character ring buffer is empty // Set the default keyboard layout to US g_kbd_control.keys_unmodified = g_us_sc_unmodified; g_kbd_control.keys_shift = g_us_sc_shift; g_kbd_control.keys_control = g_us_sc_ctrl; g_kbd_control.keys_control_shift = g_us_sc_ctrl_shift; g_kbd_control.keys_caps = g_us_sc_lock; g_kbd_control.keys_caps_shift = g_us_sc_lock_shift; // Disable the PS/2 interrupts... int_disable(INT_MOUSE); /* Disable mouse interrupts */ int_disable(INT_KBD_PS2); /* Disable keyboar interrupts */ // Prevent the keyboard and mouse from sending events ps2_controller_cmd(PS2_CTRL_DISABLE_1); ps2_controller_cmd(PS2_CTRL_DISABLE_2); // Read and clear out the controller's output buffer ps2_flush_out(); // // Controller selftest... if (ps2_controller_cmd(PS2_CTRL_SELFTEST) != PS2_RESP_OK) { ; // return PS2_FAIL_SELFTEST; } // // // Keyboard test if (ps2_controller_cmd(PS2_CTRL_KBDTEST) != 0) { ; // return PS2_FAIL_KBDTEST; } // Set scancode translation to set1, enable interrupts on mouse and keyboard ps2_controller_cmd_param(PS2_CTRL_WRITECMD, 0x43); // Enable the keyboard, don't check response ps2_wait_in(); *command = PS2_CTRL_ENABLE_1; // Reset the keyboard... waiting a bit before we check for a result ps2_kbd_cmd(KBD_CMD_RESET, 1000); // Ideally, we would attempt a re-enable several times, but this doesn't work on the U/U+ for some keyboards ps2_kbd_cmd(KBD_CMD_ENABLE, 0); // TODO: set the keyboard LEDs // Make sure everything is read ps2_flush_out(); // Register the interrupt handler for the keyboard int_register(INT_KBD_PS2, kbd_handle_irq); // Clear any pending keyboard interrupts int_clear(INT_KBD_PS2); // Enable the keyboard interrupt int_enable(INT_KBD_PS2); return(0); } char kbd_getc_poll() { if (ps2_wait_out() == 0) { kbd_handle_irq(); return kbd_getc(); } else { return 0; } }