1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
|
// MIT License, Copyright (c) 2020 Marvin Borner
#include <def.h>
#include <drivers/cpu.h>
#include <drivers/interrupts.h>
#include <drivers/ps2.h>
#include <errno.h>
#include <io.h>
#include <mem.h>
#include <print.h>
#include <proc.h>
#include <stack.h>
#include <str.h>
#include <sys.h>
PROTECTED static struct stack *queue = NULL;
static struct event_keyboard *event = NULL;
static int state = 0;
static int merged = 0;
static void keyboard_handler(struct regs *r)
{
UNUSED(r);
u8 scancode = ps2_read_data();
// TODO: Support more than two-byte scancodes
if (scancode == 0xe0) {
merged = 0xe0;
state = 1;
return;
} else {
merged = scancode << 8 | merged;
}
// TODO: "Merge" scancode to linux keycode?
/* printf("%x %x = %x\n", scancode, state ? 0xe0 : 0, merged); */
event = malloc(sizeof(*event));
event->magic = KEYBOARD_MAGIC;
event->press = (scancode & 0x80) == 0;
event->scancode = event->press ? scancode : scancode & ~0x80;
stack_push_bot(queue, event);
state = 0;
merged = 0;
io_unblock(IO_KEYBOARD);
}
static res keyboard_read(void *buf, u32 offset, u32 count)
{
if (stack_empty(queue))
return -EINVAL;
struct event_keyboard *e = stack_pop(queue);
memcpy_user(buf, (u8 *)e + offset, MIN(count, sizeof(*e)));
free(e);
return MIN(count, sizeof(*e));
}
static res keyboard_ready(void)
{
return !stack_empty(queue) ? EOK : -EAGAIN;
}
CLEAR void ps2_keyboard_reset(void)
{
if (queue)
stack_clear(queue);
}
CLEAR void ps2_keyboard_install(u8 device)
{
UNUSED(device);
irq_install_handler(1, keyboard_handler);
queue = stack_new();
struct io_dev *dev = zalloc(sizeof(*dev));
dev->read = keyboard_read;
dev->ready = keyboard_ready;
io_add(IO_KEYBOARD, dev);
}
|
