gered/FoenixMCP
1
0
Fork 0
Code Issues Pull requests Actions Packages Projects Releases Wiki Activity
FoenixMCP/src/dev/ps2.c

816 lines
29 KiB
C
Raw Normal View History

PS/2 and BLOCK device added Added BLOCK device interface and PS/2 keyboard driver.
2021-09-14 15:45:30 -04:00
/**
* Definitions for the PS/2 interface devices... mouse and keyboard
*/
More syscalls and CLI beginning Added more syscalls. Started the command line utility.
2021-09-19 19:16:41 -04:00
#include "log.h"
PS/2 and BLOCK device added Added BLOCK device interface and PS/2 keyboard driver.
2021-09-14 15:45:30 -04:00
#include "types.h"
#include "ring_buffer.h"
#include "dev/ps2.h"
#include "dev/text_screen_iii.h"
More syscalls and CLI beginning Added more syscalls. Started the command line utility.
2021-09-19 19:16:41 -04:00
#include "interrupt.h"
PS/2 and BLOCK device added Added BLOCK device interface and PS/2 keyboard driver.
2021-09-14 15:45:30 -04:00
#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;
PGX Loader and Interrupt Update PGX loader is working, updated interrupt code to support keyboard interrupts (currently using Mo keyboard)
2021-09-27 17:37:36 -04:00
/* Clear the pending flag */
int_clear(INT_KBD_PS2);
PS/2 and BLOCK device added Added BLOCK device interface and PS/2 keyboard driver.
2021-09-14 15:45:30 -04:00
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...
More syscalls and CLI beginning Added more syscalls. Started the command line utility.
2021-09-19 19:16:41 -04:00
int_disable(INT_MOUSE); /* Disable mouse interrupts */
int_disable(INT_KBD_PS2); /* Disable keyboar interrupts */
PS/2 and BLOCK device added Added BLOCK device interface and PS/2 keyboard driver.
2021-09-14 15:45:30 -04:00
// 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();
More syscalls and CLI beginning Added more syscalls. Started the command line utility.
2021-09-19 19:16:41 -04:00
// // Controller selftest...
PGX Loader and Interrupt Update PGX loader is working, updated interrupt code to support keyboard interrupts (currently using Mo keyboard)
2021-09-27 17:37:36 -04:00
if (ps2_controller_cmd(PS2_CTRL_SELFTEST) != PS2_RESP_OK) {
; // return PS2_FAIL_SELFTEST;
}
More syscalls and CLI beginning Added more syscalls. Started the command line utility.
2021-09-19 19:16:41 -04:00
//
// // Keyboard test
PGX Loader and Interrupt Update PGX loader is working, updated interrupt code to support keyboard interrupts (currently using Mo keyboard)
2021-09-27 17:37:36 -04:00
if (ps2_controller_cmd(PS2_CTRL_KBDTEST) != 0) {
; // return PS2_FAIL_KBDTEST;
}
PS/2 and BLOCK device added Added BLOCK device interface and PS/2 keyboard driver.
2021-09-14 15:45:30 -04:00
// 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();
More syscalls and CLI beginning Added more syscalls. Started the command line utility.
2021-09-19 19:16:41 -04:00
// 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);
PS/2 and BLOCK device added Added BLOCK device interface and PS/2 keyboard driver.
2021-09-14 15:45:30 -04:00
return(0);
}
char kbd_getc_poll() {
if (ps2_wait_out() == 0) {
kbd_handle_irq();
return kbd_getc();
} else {
return 0;
}
}
Reference in a new issue Copy permalink