1 files changed, 39 insertions, 2 deletions

diff --git a/kernel/drivers/keyboard.c b/kernel/drivers/keyboard.c
index ac97d36..0dd7219 100644
--- a/kernel/drivers/keyboard.c
+++ b/kernel/drivers/keyboard.c
@@ -2,13 +2,18 @@
 
 #include <cpu.h>
 #include <def.h>
-#include <event.h>
+#include <fs.h>
 #include <interrupts.h>
 #include <mem.h>
 #include <print.h>
+#include <proc.h>
+#include <stack.h>
+#include <str.h>
 #include <sys.h>
 
 static struct event_keyboard *event = NULL;
+static struct stack *queue = NULL;
+static u32 dev_id = 0;
 
 static int state = 0;
 static int merged = 0;
@@ -34,10 +39,12 @@ void keyboard_handler()
 	event->magic = KEYBOARD_MAGIC;
 	event->press = (scancode & 0x80) == 0;
 	event->scancode = event->press ? scancode : scancode & ~0x80;
-	event_trigger(EVENT_KEYBOARD, event);
+	stack_push_bot(queue, event);
 
 	state = 0;
 	merged = 0;
+
+	proc_enable_waiting(dev_id);
 }
 
 void keyboard_acknowledge(void)
@@ -53,8 +60,38 @@ void keyboard_rate(void)
 	outb(0x60, 0x0); // Rate{00000} Delay{00} 0
 }
 
+s32 keyboard_read(void *buf, u32 offset, u32 count, struct device *dev)
+{
+	(void)dev;
+	if (stack_empty(queue))
+		return -1;
+
+	struct event *e = stack_pop(queue);
+	memcpy(buf, (u8 *)e + offset, count);
+	return count;
+}
+
+u8 keyboard_ready(void)
+{
+	return !stack_empty(queue);
+}
+
+void keyboard_reset(void)
+{
+	stack_clear(queue);
+}
+
 void keyboard_install(void)
 {
 	//keyboard_rate(); TODO: Fix keyboard rate?
 	irq_install_handler(1, keyboard_handler);
+
+	queue = stack_new();
+	struct device *dev = malloc(sizeof(*dev));
+	dev->name = strdup("kbd");
+	dev->type = DEV_CHAR;
+	dev->read = keyboard_read;
+	dev->ready = keyboard_ready;
+	device_add(dev);
+	dev_id = dev->id;
 }