wash/mango
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

ps2kbd: create input devices for kbd/mouse. report keypress events.

Browse Source
This commit is contained in:
max 🍓
2023-05-10 20:34:14 +01:00
parent 05395542a8
commit 8dd7616594
1 changed files with 210 additions and 1 deletions
Download Patch File Download Diff File Expand all files Collapse all files

211
kexts/ps2kbd/main.c
View File

@@ -1,4 +1,5 @@
#include <socks/printk.h>
#include <socks/input.h>
#include <socks/device.h>
#include <socks/kext.h>
#include <socks/libc/stdio.h>
@@ -31,6 +32,18 @@
#define PS2_IO_STATUS 0x64
#define PS2_IO_CMD 0x64
static enum input_keycode keymap_l1[0xe1];
static enum input_keycode keymap_l2[0x7e];
static enum input_keycode keymap_l3[0xe1];
static enum input_keycode keymap_l4[0x7d];
static const enum input_keycode *keymaps[] = {
keymap_l1,
keymap_l2,
keymap_l3,
keymap_l4,
};
static struct input_device *keyboard = NULL, *mouse = NULL;
static void send_cmd(uint8_t cmd)
@@ -120,8 +133,21 @@ static int int_handler(void)
continue;
}
printk("ps2: got scancode 0x%02x (%s)", scancode, released ? "up" : "down");
enum input_keycode c = keymaps[scancode_level][scancode];
if (c == NEXT_MAP) {
scancode_level++;
continue;
}
scancode_level = 0;
struct input_event ev;
ev.ev_type = INPUT_TYPE_KEY;
ev.ev_key.key = c;
ev.ev_key.state = released ? INPUT_KEYSTATE_UP : INPUT_KEYSTATE_DOWN;
input_device_report_event(keyboard, &ev, true);
released = false;
}
return 0;
@@ -226,3 +252,186 @@ static kern_status_t online(struct kext *self)
DEFINE_KEXT("net.doorstuck.socks.ps2kbd",
online, NULL,
KEXT_NO_DEPENDENCIES);
static enum input_keycode keymap_l1[0xe1] = {
[0x00] = KEY_UNKNOWN,
[0x01] = KEY_F9,
[0x02] = KEY_UNKNOWN,
[0x03] = KEY_F5,
[0x04] = KEY_F3,
[0x05] = KEY_F1,
[0x06] = KEY_F2,
[0x07] = KEY_F12,
[0x08] = KEY_UNKNOWN,
[0x09] = KEY_F10,
[0x0a] = KEY_F8,
[0x0b] = KEY_F6,
[0x0c] = KEY_F4,
[0x0d] = KEY_TAB,
[0x0e] = KEY_GRAVE_ACCENT,
[0x0f] = KEY_UNKNOWN,
[0x10] = KEY_UNKNOWN,
[0x11] = KEY_LEFT_ALT,
[0x12] = KEY_LEFT_SHIFT,
[0x13] = KEY_UNKNOWN,
[0x14] = KEY_LEFT_CTRL,
[0x15] = KEY_Q,
[0x16] = KEY_KEY_1,
[0x17] = KEY_UNKNOWN,
[0x18] = KEY_UNKNOWN,
[0x19] = KEY_UNKNOWN,
[0x1a] = KEY_Z,
[0x1b] = KEY_S,
[0x1c] = KEY_A,
[0x1d] = KEY_W,
[0x1e] = KEY_KEY_2,
[0x1f] = KEY_UNKNOWN,
[0x20] = KEY_UNKNOWN,
[0x21] = KEY_C,
[0x22] = KEY_X,
[0x23] = KEY_D,
[0x24] = KEY_E,
[0x25] = KEY_KEY_4,
[0x26] = KEY_KEY_3,
[0x27] = KEY_UNKNOWN,
[0x28] = KEY_UNKNOWN,
[0x29] = KEY_SPACE,
[0x2a] = KEY_V,
[0x2b] = KEY_F,
[0x2c] = KEY_T,
[0x2d] = KEY_R,
[0x2e] = KEY_KEY_5,
[0x2f] = KEY_UNKNOWN,
[0x30] = KEY_UNKNOWN,
[0x31] = KEY_N,
[0x32] = KEY_B,
[0x33] = KEY_H,
[0x34] = KEY_G,
[0x35] = KEY_Y,
[0x36] = KEY_KEY_6,
[0x37] = KEY_UNKNOWN,
[0x38] = KEY_UNKNOWN,
[0x39] = KEY_SPACE,
[0x3a] = KEY_M,
[0x3b] = KEY_J,
[0x3c] = KEY_U,
[0x3d] = KEY_KEY_7,
[0x3e] = KEY_KEY_8,
[0x3f] = KEY_UNKNOWN,
[0x40] = KEY_UNKNOWN,
[0x41] = KEY_COMMA,
[0x42] = KEY_K,
[0x43] = KEY_I,
[0x44] = KEY_O,
[0x45] = KEY_KEY_0,
[0x46] = KEY_KEY_9,
[0x47] = KEY_UNKNOWN,
[0x48] = KEY_UNKNOWN,
[0x49] = KEY_DOT,
[0x4a] = KEY_SLASH,
[0x4b] = KEY_L,
[0x4c] = KEY_SEMICOLON,
[0x4d] = KEY_P,
[0x4e] = KEY_MINUS,
[0x4f] = KEY_UNKNOWN,
[0x50] = KEY_UNKNOWN,
[0x51] = KEY_UNKNOWN,
[0x52] = KEY_APOSTROPHE,
[0x53] = KEY_UNKNOWN,
[0x54] = KEY_LEFT_BRACE,
[0x55] = KEY_EQUALS,
[0x56] = KEY_UNKNOWN,
[0x57] = KEY_UNKNOWN,
[0x58] = KEY_CAPS_LOCK,
[0x59] = KEY_RIGHT_SHIFT,
[0x5a] = KEY_ENTER,
[0x5b] = KEY_RIGHT_BRACE,
[0x5c] = KEY_UNKNOWN,
[0x5d] = KEY_BACKSLASH,
[0x5e] = KEY_UNKNOWN,
[0x5f] = KEY_UNKNOWN,
[0x60] = KEY_UNKNOWN,
[0x61] = KEY_UNKNOWN,
[0x62] = KEY_UNKNOWN,
[0x63] = KEY_UNKNOWN,
[0x64] = KEY_UNKNOWN,
[0x65] = KEY_UNKNOWN,
[0x66] = KEY_BACKSPACE,
[0x67] = KEY_UNKNOWN,
[0x68] = KEY_UNKNOWN,
[0x69] = KEY_KEYPAD_1,
[0x6a] = KEY_UNKNOWN,
[0x6b] = KEY_KEYPAD_4,
[0x6c] = KEY_KEYPAD_7,
[0x6d] = KEY_UNKNOWN,
[0x6e] = KEY_UNKNOWN,
[0x6f] = KEY_UNKNOWN,
[0x70] = KEY_KEYPAD_0,
[0x71] = KEY_KEYPAD_DOT,
[0x72] = KEY_KEYPAD_2,
[0x73] = KEY_KEYPAD_5,
[0x74] = KEY_KEYPAD_6,
[0x75] = KEY_KEYPAD_8,
[0x76] = KEY_ESCAPE,
[0x77] = KEY_NUM_LOCK,
[0x78] = KEY_F11,
[0x79] = KEY_KEYPAD_PLUS,
[0x7a] = KEY_KEYPAD_3,
[0x7b] = KEY_KEYPAD_MINUS,
[0x7c] = KEY_KEYPAD_ASTERISK,
[0x7d] = KEY_KEYPAD_9,
[0x7e] = KEY_SCROLL_LOCK,
[0x7f] = KEY_UNKNOWN,
[0xe0] = NEXT_MAP,
};
static enum input_keycode keymap_l2[0x7e] = {
[0x10] = KEY_UNKNOWN, /* WWW_SEARCH */
[0x11] = KEY_RIGHT_ALT,
[0x12] = NEXT_MAP,
[0x14] = KEY_RIGHT_CTRL,
[0x15] = KEY_UNKNOWN, /* MEDIA_PREV */
[0x18] = KEY_UNKNOWN, /* WWW_BOOKMARKS */
[0x1f] = KEY_LEFT_META,
[0x20] = KEY_UNKNOWN, /* WWW_REFRESH */
[0x21] = KEY_MEDIA_VOLUME_DECREMENT,
[0x23] = KEY_MEDIA_MUTE,
[0x27] = KEY_RIGHT_META,
[0x28] = KEY_UNKNOWN, /* WWW_STOP */
[0x2f] = KEY_UNKNOWN, /* RIGHT_MENU */
[0x2B] = KEY_UNKNOWN, /* CALCULATOR */
[0x30] = KEY_UNKNOWN, /* WWW_FORWARD */
[0x32] = KEY_MEDIA_VOLUME_INCREMENT,
[0x34] = KEY_UNKNOWN, /* MEDIA_PLAY_PAUSE */
[0x37] = KEY_UNKNOWN, /* POWER */
[0x38] = KEY_UNKNOWN, /* WWW_BACK */
[0x3a] = KEY_UNKNOWN, /* WWW_HOME */
[0x3b] = KEY_UNKNOWN, /* MEDIA_STOP */
[0x3f] = KEY_UNKNOWN, /* SLEEP */
[0x40] = KEY_UNKNOWN, /* CALCULATOR */
[0x48] = KEY_UNKNOWN, /* WWW_EMAIL */
[0x4a] = KEY_KEYPAD_SLASH,
[0x4d] = KEY_UNKNOWN, /* MEDIA_NEXT */
[0x50] = KEY_UNKNOWN, /* MEDIA_SELECT */
[0x5a] = KEY_KEYPAD_ENTER,
[0x5e] = KEY_UNKNOWN, /* WAKE */
[0x69] = KEY_END,
[0x6b] = KEY_LEFT,
[0x6c] = KEY_HOME,
[0x70] = KEY_INSERT,
[0x71] = KEY_DELETE,
[0x72] = KEY_DOWN,
[0x74] = KEY_RIGHT,
[0x75] = KEY_UP,
[0x7a] = KEY_PAGE_DOWN,
[0x7c] = KEY_PRINT_SCREEN,
[0x7d] = KEY_PAGE_UP,
};
static enum input_keycode keymap_l3[0xe1] = {
[0xe0] = NEXT_MAP,
};
static enum input_keycode keymap_l4[0x7d] = {
[0x7c] = KEY_PRINT_SCREEN,
};