X-Git-Url: https://scm.lunaixsky.com/lunaix-os.git/blobdiff_plain/0e1309c02f0703c050df09b71346dab60fc6df87..c4510182f3c02e390184bee518940e325f064b20:/lunaix-os/kernel/peripheral/ps2kbd.c?ds=sidebyside diff --git a/lunaix-os/kernel/peripheral/ps2kbd.c b/lunaix-os/kernel/peripheral/ps2kbd.c index 6905b1e..04debc8 100644 --- a/lunaix-os/kernel/peripheral/ps2kbd.c +++ b/lunaix-os/kernel/peripheral/ps2kbd.c @@ -2,6 +2,7 @@ #include #include #include +#include #include #include #include @@ -17,7 +18,6 @@ LOG_MODULE("PS2KBD"); static struct ps2_cmd_queue cmd_q; -static struct ps2_key_buffer key_buf; static struct ps2_kbd_state kbd_state; #define KEY_NUM(x) (x + 0x30) @@ -69,18 +69,21 @@ static kbd_keycode_t scancode_set2_shift[] = { // clang-format on +static struct input_device* kbd_idev; + #define KBD_STATE_KWAIT 0x00 #define KBD_STATE_KSPECIAL 0x01 #define KBD_STATE_KRELEASED 0x02 +#define KBD_STATE_E012 0x03 +#define KBD_STATE_KRELEASED_E0 0x04 #define KBD_STATE_CMDPROCS 0x40 -#define KBD_ENABLE_SPIRQ_FIX +// #define KBD_ENABLE_SPIRQ_FIX +#define KBD_ENABLE_SPIRQ_FIX2 // #define KBD_DBGLOG void intr_ps2_kbd_handler(const isr_param* param); -static struct kdb_keyinfo_pkt* -ps2_keybuffer_next_write(); void ps2_device_post_cmd(char cmd, char arg) @@ -107,15 +110,15 @@ ps2_kbd_init() { memset(&cmd_q, 0, sizeof(cmd_q)); - memset(&key_buf, 0, sizeof(key_buf)); memset(&kbd_state, 0, sizeof(kbd_state)); mutex_init(&cmd_q.mutex); - mutex_init(&key_buf.mutex); kbd_state.translation_table = scancode_set2; kbd_state.state = KBD_STATE_KWAIT; + kbd_idev = input_add_device("i8042-kbd"); + acpi_context* acpi_ctx = acpi_get_context(); if (acpi_ctx->fadt.header.rev > 1) { /* @@ -132,13 +135,13 @@ ps2_kbd_init() * https://bochs.sourceforge.io/cgi-bin/lxr/source/bios/rombios32.c#L1314 */ if (!(acpi_ctx->fadt.boot_arch & IAPC_ARCH_8042)) { - kprintf(KERROR "No PS/2 controller detected.\n"); + kprintf(KERROR "i8042: not found\n"); // FUTURE: Some alternative fallback on this? Check PCI bus for USB // controller instead? return; } } else { - kprintf(KWARN "Outdated FADT used, assuming 8042 always exist.\n"); + kprintf(KWARN "i8042: outdated FADT used, assuming exists.\n"); } char result; @@ -271,14 +274,13 @@ kbd_buffer_key_event(kbd_keycode_t key, uint8_t scancode, kbd_kstate_t state) key = key & (0xffdf | -('a' > key || key > 'z' || !(state & KBD_KEY_FCAPSLKED))); - if (!mutex_on_hold(&key_buf.mutex)) { - struct kdb_keyinfo_pkt* keyevent_pkt = ps2_keybuffer_next_write(); - *keyevent_pkt = - (struct kdb_keyinfo_pkt){ .keycode = key, - .scancode = scancode, - .state = state, - .timestamp = clock_systime() }; - } + struct input_evt_pkt ipkt = { + .pkt_type = (state & KBD_KEY_FPRESSED) ? PKT_PRESS : PKT_RELEASE, + .scan_code = scancode, + .sys_code = key, + }; + + input_fire_event(kbd_idev, &ipkt); return; } @@ -337,6 +339,12 @@ intr_ps2_kbd_handler(const isr_param* param) } #endif +#ifdef KBD_ENABLE_SPIRQ_FIX2 + if (scancode == PS2_RESULT_ACK || scancode == PS2_RESULT_NAK) { + return; + } +#endif + #ifdef KBD_DBGLOG kprintf(KDEBUG "%x\n", scancode & 0xff); #endif @@ -354,8 +362,10 @@ intr_ps2_kbd_handler(const isr_param* param) } break; case KBD_STATE_KSPECIAL: - if (scancode == 0xf0) { // release code - kbd_state.state = KBD_STATE_KRELEASED; + if (scancode == 0x12) { + kbd_state.state = KBD_STATE_E012; + } else if (scancode == 0xf0) { // release code + kbd_state.state = KBD_STATE_KRELEASED_E0; } else { key = kbd_state.translation_table[scancode]; kbd_buffer_key_event(key, scancode, KBD_KEY_FPRESSED); @@ -364,10 +374,23 @@ intr_ps2_kbd_handler(const isr_param* param) kbd_state.translation_table = scancode_set2; } break; + // handle the '0xE0, 0x12, 0xE0, xx' sequence + case KBD_STATE_E012: + if (scancode == 0xe0) { + kbd_state.state = KBD_STATE_KSPECIAL; + kbd_state.translation_table = scancode_set2_ex; + } + break; + case KBD_STATE_KRELEASED_E0: + if (scancode == 0x12) { + goto escape_release; + } + // fall through case KBD_STATE_KRELEASED: key = kbd_state.translation_table[scancode]; kbd_buffer_key_event(key, scancode, KBD_KEY_FRELEASED); + escape_release: // reset the translation table to scancode_set2 kbd_state.state = KBD_STATE_KWAIT; kbd_state.translation_table = scancode_set2; @@ -419,37 +442,4 @@ ps2_issue_dev_cmd(char cmd, uint16_t arg) ; return io_inb(PS2_PORT_ENC_CMDREG); -} - -int -kbd_recv_key(struct kdb_keyinfo_pkt* key_event) -{ - if (!key_buf.buffered_len) { - return 0; - } - - mutex_lock(&key_buf.mutex); - *key_event = key_buf.buffer[key_buf.read_ptr]; - key_buf.buffered_len--; - key_buf.read_ptr = (key_buf.read_ptr + 1) % PS2_KBD_RECV_BUFFER_SIZE; - - mutex_unlock(&key_buf.mutex); - return 1; -} - -static struct kdb_keyinfo_pkt* -ps2_keybuffer_next_write() -{ - int index = - (key_buf.read_ptr + key_buf.buffered_len) % PS2_KBD_RECV_BUFFER_SIZE; - if (index == key_buf.read_ptr && key_buf.buffered_len) { - // the reader is lagged so much such that the buffer is full. - // It is suggested to read from beginning for nearly up-to-date - // readings. - key_buf.read_ptr = 0; - key_buf.buffered_len = index; - } else { - key_buf.buffered_len++; - } - return &key_buf.buffer[index]; } \ No newline at end of file