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
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
|
#include "driver.h"
#include <assert.h>
#include <camellia/compat.h>
#include <camellia/syscalls.h>
#include <errno.h>
#include <shared/ring.h>
#include <stdbool.h>
#include <stdlib.h>
#include <thread.h>
static const char keymap_lower[] = {
'\0', '\0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '-', '=', '\b', '\t',
'q', 'w', 'e', 'r', 't', 'y', 'u', 'i', 'o', 'p', '[', ']', '\r', '\0', 'a', 's',
'd', 'f', 'g', 'h', 'j', 'k', 'l', '\0', '\'', '`', '\0', '\\', 'z', 'x', 'c', 'v',
'b', 'n', 'm', ',', '.', '/', '\0', '*', '\0', ' ', '\0', '\0', '\0', '\0', '\0', '\0',
'\0', '\0', '\0', '\0', '\0', '\0', '\0', '7', '8', '9', '-', '4', '5', '6', '+', '1',
'2', '3', '0', '.', '\0', '\0', '\0', '\0', '\0', '\0', '\0', '\0', '\0', '\0', '\0', '\0',
'\0', '\0', '\0', '\0', '\0', '\0', '\0', '\0', '\0', '\0', '\0', '\0', '\0', '\0', '\0', '\0',
'\0', '\0', '\0', '\0', '\0', '\0', '\0', '\0', '\0', '\0', '\0', '\0', '\0', '\0', '\0', '\0',
};
static const char keymap_upper[] = {
'\0', '\0', '!', '@', '#', '$', '%', '^', '&', '*', '(', ')', '_', '+', '\b', '\t',
'Q', 'W', 'E', 'R', 'T', 'Y', 'U', 'I', 'O', 'P', '{', '}', '\r', '\0', 'A', 'S',
'D', 'F', 'G', 'H', 'J', 'K', 'L', ':', '"', '~', '\0', '|', 'Z', 'X', 'C', 'V',
'B', 'N', 'M', '<', '>', '?', '\0', '*', '\0', ' ', '\0', '\0', '\0', '\0', '\0', '\0',
'\0', '\0', '\0', '\0', '\0', '\0', '\0', '7', '8', '9', '-', '4', '5', '6', '+', '1',
'2', '3', '0', '.', '\0', '\0', '\0', '\0', '\0', '\0', '\0', '\0', '\0', '\0', '\0', '\0',
'\0', '\0', '\0', '\0', '\0', '\0', '\0', '\0', '\0', '\0', '\0', '\0', '\0', '\0', '\0', '\0',
'\0', '\0', '\0', '\0', '\0', '\0', '\0', '\0', '\0', '\0', '\0', '\0', '\0', '\0', '\0', '\0',
};
static volatile uint8_t backlog_buf[16];
static volatile ring_t backlog = {(void*)backlog_buf, sizeof backlog_buf, 0, 0};
static hid_t fd;
static bool keys[0x80] = {0};
static void parse_scancode(uint8_t s) {
bool ctrl = keys[0x1D];
bool shift = keys[0x2A] || keys[0x36];
bool down = !(s & 0x80);
char c;
s &= 0x7f;
keys[s] = down;
c = shift ? keymap_upper[s] : keymap_lower[s];
if (ctrl && keymap_upper[s] >= 'A' && keymap_upper[s] <= 'Z')
c = keymap_upper[s] - 'A' + 1;
if (down && c) ring_put1b((void*)&backlog, c);
}
/** Is a thread waiting for /kdev/ps2/kb? */
static volatile bool blocked = false;
/* for use in read_thread */
static hid_t rt_reqh;
static size_t rt_cap;
static void read_thread(void *unused) {
char buf[512];
(void)unused;
assert(blocked);
while (ring_used((void*)&backlog) == 0) {
/* read raw input until we have something to output */
int len = _sys_read(fd, buf, sizeof buf, 0);
if (len == 0) break;
for (int i = 0; i < len; i++)
parse_scancode(buf[i]);
}
if (ring_used((void*)&backlog) > 0) {
int ret = ring_get((void*)&backlog, buf, rt_cap);
_sys_fs_respond(rt_reqh, buf, ret, 0);
} else {
_sys_fs_respond(rt_reqh, 0, -EGENERIC, 0);
}
blocked = false;
}
static void fs_loop(void) {
static char buf[512];
int ret;
for (;;) {
struct ufs_request res;
hid_t reqh = _sys_fs_wait(buf, sizeof buf, &res);
if (reqh < 0) return;
switch (res.op) {
case VFSOP_OPEN:
if (res.len == 0) {
_sys_fs_respond(reqh, NULL, 1, 0);
} else {
_sys_fs_respond(reqh, NULL, -ENOENT, 0);
}
break;
case VFSOP_READ:
if (blocked) {
_sys_fs_respond(reqh, NULL, -EAGAIN, 0);
break;
} else if (ring_used((void*)&backlog) > 0) {
ret = ring_get((void*)&backlog, buf, res.capacity);
_sys_fs_respond(reqh, buf, ret, 0);
} else {
blocked = true;
rt_reqh = reqh;
rt_cap = res.capacity;
thread_create(0, read_thread, 0);
}
break;
default:
_sys_fs_respond(reqh, NULL, -1, 0);
break;
}
}
}
void ps2_drv(void) {
fd = _sys_open("/kdev/ps2/kb", 12, 0);
if (fd < 0) exit(1);
fs_loop();
exit(0);
}
|
