-
Notifications
You must be signed in to change notification settings - Fork 1
/
kbd.c
85 lines (71 loc) · 1.54 KB
/
kbd.c
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
#include "types.h"
#include "x86.h"
#include "defs.h"
#include "kbd.h"
#include "traps.h"
#include "spinlock.h"
#include "message.h"
#include "windows.h"
static struct spinlock kbd_lock;
void
kbdintr(void)
{
//cprintf("\n kbd irq \n");
acquire(&kbd_lock);
uint st = inb(KBSTATP);
//0x01 means 0x64 first bit, 0 = empty, 1 = full
if((st & KBS_DIB) == 0 || (st & 0x20) != 0)
{
;
//cprintf("\nWrong kbd\n");
}
else
{
uint data = inb(KBDATAP);
//cprintf("\n kbd irq \n");
fifoPut(&device_buf, data + Keyboard_Offset);
//consoleintr(kbdgetc);
deviceMessageProc();
}
release(&kbd_lock);
}
void kbdHandle(uint data)
{
static uint shift;
static uchar *charcode[4] = {
normalmap, shiftmap, ctlmap, ctlmap
};
struct message msg;
if(data == 0xE0){
shift |= E0ESC;
//return 0;
} else if(data & 0x80){
// Key released
data = (shift & E0ESC ? data : data & 0x7F);
shift &= ~(shiftcode[data] | E0ESC);
return;
} else if(shift & E0ESC){
// Last character was an E0 escape; or with 0x80
data |= 0x80;
shift &= ~E0ESC;
}
shift |= shiftcode[data];
shift ^= togglecode[data];
msg.type = WM_KEYDOWN;
msg.params[0] = shift;
msg.params[1] = normalmap[data];
uint c = charcode[shift & (CTL | SHIFT)][data];
if(shift & CAPSLOCK){
if('a' <= c && c <= 'z')
c += 'A' - 'a';
else if('A' <= c && c <= 'Z')
c += 'a' - 'A';
}
messageHandle(msg);
}
void kbdInit()
{
initlock(&kbd_lock, "kbd");
picenable(IRQ_KBD);
ioapicenable(IRQ_KBD, 0);
}