812 lines
29 KiB
C
812 lines
29 KiB
C
|
/**
|
||
|
|
* Definitions for the PS/2 interface devices... mouse and keyboard
|
||
|
|
*/
|
||
|
|
|
||
|
|
#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;
|
||
|
|
|
||
|
|
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...
|
||
|
|
|
||
|
|
// irq_disable(IRQ07_MOUSE); // Disable mouse interrupts
|
||
|
|
// irq_disable(IRQ08_KBD); // 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
|
||
|
|
// irq_register(IRQ08_KBD, kbd_handle_irq);
|
||
|
|
//
|
||
|
|
// // Clear any pending keyboard interrupts
|
||
|
|
// irq_clear(IRQ08_KBD);
|
||
|
|
//
|
||
|
|
// // Enable the keyboard interrupt
|
||
|
|
// irq_enable(IRQ08_KBD);
|
||
|
|
|
||
|
|
return(0);
|
||
|
|
}
|
||
|
|
|
||
|
|
char kbd_getc_poll() {
|
||
|
|
if (ps2_wait_out() == 0) {
|
||
|
|
kbd_handle_irq();
|
||
|
|
return kbd_getc();
|
||
|
|
} else {
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
}
|