PIT (timer)

1 files changed, 23 insertions, 0 deletions

diff --git a/kernel/drivers/pit.c b/kernel/drivers/pit.c
new file mode 100644
index 0000000..cb3c091
--- /dev/null
+++ b/kernel/drivers/pit.c
@@ -0,0 +1,23 @@
+#include <comus/asm.h>
+#include <comus/drivers/pit.h>
+
+#define CHAN_0 0x40
+#define CHAN_1 0x41
+#define CHAN_2 0x42
+#define CMD 0x43
+
+uint64_t ticks = 0;
+
+uint16_t pit_read_divider(void) {
+	uint16_t count = 0;
+	cli();
+	outb(CMD, 0); // clear bits
+	count = inb(CHAN_0); // low byte
+	count |= inb(CHAN_0)<<8; // highbyte
+	return count;
+}
+
+void pit_set_divider(uint16_t count) {
+	outb(CHAN_0, count & 0xFF); // low byte
+	outb(CHAN_0, (count & 0xFF00) >> 8); // high byte
+}