aboutsummaryrefslogtreecommitdiff
diff options
context:
space:
mode:
Diffstat
-rw-r--r--sys/arch/amd64/isa/i8042.c272
-rw-r--r--sys/include/arch/amd64/isa/i8042regs.h69
-rw-r--r--sys/include/arch/amd64/sysvec.h1
3 files changed, 342 insertions, 0 deletions
diff --git a/sys/arch/amd64/isa/i8042.c b/sys/arch/amd64/isa/i8042.c
new file mode 100644
index 0000000..9b9e254
--- /dev/null
+++ b/sys/arch/amd64/isa/i8042.c
@@ -0,0 +1,272 @@
+/*
+ * Copyright (c) 2023-2024 Ian Marco Moffett and the Osmora Team.
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions are met:
+ *
+ * 1. Redistributions of source code must retain the above copyright notice,
+ * this list of conditions and the following disclaimer.
+ * 2. Redistributions in binary form must reproduce the above copyright
+ * notice, this list of conditions and the following disclaimer in the
+ * documentation and/or other materials provided with the distribution.
+ * 3. Neither the name of Hyra nor the names of its
+ * contributors may be used to endorse or promote products derived from
+ * this software without specific prior written permission.
+ *
+ * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
+ * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+ * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
+ * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
+ * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
+ * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
+ * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
+ * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
+ * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
+ * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
+ * POSSIBILITY OF SUCH DAMAGE.
+ */
+
+#include <sys/cdefs.h>
+#include <sys/types.h>
+#include <sys/driver.h>
+#include <sys/errno.h>
+#include <sys/spinlock.h>
+#include <sys/tty.h>
+#include <machine/ioapic.h>
+#include <machine/idt.h>
+#include <machine/io.h>
+#include <machine/lapic.h>
+#include <machine/hpet.h>
+#include <machine/sysvec.h>
+#include <machine/isa/i8042regs.h>
+
+__MODULE_NAME("i8042");
+__KERNEL_META("$Hyra$: i8042.c, Ian Marco Moffett, "
+ "i8042 PS/2 driver");
+
+static struct spinlock data_lock;
+static bool shift_key = false;
+static bool capslock = false;
+
+static int dev_send(bool aux, uint8_t data);
+
+static char keytab[] = {
+ '\0', '\0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0',
+ '-', '=', '\b', '\t', 'q', 'w', 'e', 'r', 't', 'y', 'u', 'i',
+ 'o', 'p', '[', ']', '\n', '\0', 'a', 's', 'd', 'f', 'g', 'h',
+ 'j', 'k', 'l', ';', '\'', '`', '\0', '\\', 'z', 'x', 'c', 'v',
+ 'b', 'n', 'm', ',', '.', '/', '\0', '\0', '\0', ' '
+};
+
+static char keytab_shift[] = {
+ '\0', '\0', '!', '@', '#', '$', '%', '^', '&', '*', '(', ')',
+ '_', '+', '\b', '\t', 'Q', 'W', 'E', 'R', 'T', 'Y', 'U', 'I',
+ 'O', 'P', '{', '}', '\n', '\0', 'A', 'S', 'D', 'F', 'G', 'H',
+ 'J', 'K', 'L', ':', '\"', '~', '\0', '|', 'Z', 'X', 'C', 'V',
+ 'B', 'N', 'M', '<', '>', '?', '\0', '\0', '\0', ' '
+};
+
+static char keytab_caps[] = {
+ '\0', '\0', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0',
+ '-','=', '\b', '\t', 'Q', 'W', 'E', 'R', 'T', 'Y', 'U', 'I',
+ 'O', 'P', '[', ']', '\n', '\0', 'A', 'S', 'D', 'F', 'G', 'H',
+ 'J', 'K', 'L', ';', '\'', '`', '\0', '\\', 'Z', 'X', 'C', 'V',
+ 'B', 'N', 'M', ',', '.', '/', '\0', '\0', '\0', ' '
+};
+
+static void
+kbd_set_leds(uint8_t mask)
+{
+ dev_send(false, 0xED);
+ dev_send(false, mask);
+}
+
+/*
+ * Convert scancode to character
+ *
+ * @sc: Scancode
+ * @chr: Character output
+ *
+ * Returns 0 when a char is given back.
+ */
+static int
+scancode_to_chr(uint8_t sc, char *chr)
+{
+ bool release = __TEST(sc, __BIT(7));
+
+ switch (sc) {
+ /* Capslock */
+ case 0x3A:
+ capslock = !capslock;
+
+ if (!capslock) {
+ kbd_set_leds(0);
+ } else {
+ kbd_set_leds(I8042_LED_CAPS);
+ }
+ return -EAGAIN;
+ /* Shift */
+ case 0x36:
+ case 0xAA:
+ case 0x2A:
+ case 0xB6:
+ if (!release) {
+ shift_key = true;
+ } else {
+ shift_key = false;
+ }
+ return -EAGAIN;
+ }
+
+ if (release) {
+ return -EAGAIN;
+ }
+
+ if (capslock) {
+ *chr = keytab_caps[sc];
+ return 0;
+ }
+
+ if (shift_key) {
+ *chr = keytab_shift[sc];
+ return 0;
+ }
+
+ *chr = keytab[sc];
+ return 0;
+}
+
+/*
+ * Write to an i8042 register.
+ *
+ * @port: I/O port
+ * @val: Value to write
+ */
+static void
+i8042_write(uint16_t port, uint8_t val)
+{
+ while (__TEST(I8042_STATUS, I8042_IBUF_FULL));
+ outb(port, val);
+}
+
+/*
+ * Read the i8042 config register
+ */
+static uint8_t
+i8042_read_conf(void)
+{
+ i8042_write(I8042_COMMAND, I8042_GET_CONFB);
+ return inb(I8042_DATA);
+}
+
+/*
+ * Write the i8042 config register
+ */
+static void
+i8042_write_conf(uint8_t value)
+{
+ i8042_write(I8042_COMMAND, I8042_SET_CONFB);
+ i8042_write(I8042_DATA, value);
+}
+
+/*
+ * Flush the data register until it is empty.
+ */
+static void
+i8042_drain(void)
+{
+ spinlock_acquire(&data_lock);
+ while (__TEST(inb(I8042_STATUS), I8042_OBUF_FULL)) {
+ inb(I8042_DATA);
+ }
+
+ spinlock_release(&data_lock);
+}
+
+/*
+ * Send a data to a device
+ *
+ * @aux: If true, send to aux device (mouse)
+ * @data: Data to send.
+ */
+static int
+dev_send(bool aux, uint8_t data)
+{
+ if (aux) {
+ i8042_write(I8042_COMMAND, I8042_PORT1_SEND);
+ }
+
+ for (;;) {
+ if (!__TEST(inb(I8042_STATUS), I8042_IBUF_FULL)) {
+ break;
+ }
+ }
+
+ i8042_write(I8042_DATA, data);
+ inb(0x80); /* Waste a cycle */
+ return inb(I8042_DATA);
+}
+
+__attr(interrupt)
+static void
+kb_isr(void *sf)
+{
+ uint8_t data;
+ char c;
+
+ spinlock_acquire(&data_lock);
+ while (__TEST(inb(I8042_STATUS), I8042_OBUF_FULL)) {
+ data = inb(I8042_DATA);
+ if (scancode_to_chr(data, &c) == 0) {
+ tty_putc(&g_root_tty, c);
+ }
+ }
+ tty_flush(&g_root_tty);
+ spinlock_release(&data_lock);
+ lapic_send_eoi();
+}
+
+static int
+i8042_init(void)
+{
+ uint8_t conf;
+
+ /*
+ * Disable the ports and drain the output buffer
+ * to avoid interferance with the initialization
+ * process.
+ */
+ i8042_write(I8042_COMMAND, I8042_DISABLE_PORT0);
+ i8042_write(I8042_COMMAND, I8042_DISABLE_PORT1);
+ i8042_drain();
+
+ /* Disable aux data streaming */
+ dev_send(true, I8042_AUX_DISABLE);
+ i8042_drain();
+
+ /* Setup kbd interrupts */
+ idt_set_desc(SYSVEC_PCKBD, IDT_INT_GATE_FLAGS, (uintptr_t)kb_isr, 0);
+ ioapic_set_vec(1, SYSVEC_PCKBD);
+ ioapic_irq_unmask(1);
+
+ /* Setup config bits */
+ conf = i8042_read_conf();
+ conf |= I8042_PORT0_INTR;
+ conf &= ~I8042_PORT1_INTR;
+ i8042_write_conf(conf);
+
+ /* Enable the keyboard */
+ i8042_write(I8042_COMMAND, I8042_ENABLE_PORT0);
+
+ /*
+ * It seems one I/O bus cycle isn't enough to wait for data
+ * to accumulate on some machines... Give it around 50ms then
+ * drain the output buffer.
+ */
+ hpet_msleep(50);
+ i8042_drain();
+ return 0;
+}
+
+DRIVER_EXPORT(i8042_init);
diff --git a/sys/include/arch/amd64/isa/i8042regs.h b/sys/include/arch/amd64/isa/i8042regs.h
new file mode 100644
index 0000000..edef2ee
--- /dev/null
+++ b/sys/include/arch/amd64/isa/i8042regs.h
@@ -0,0 +1,69 @@
+/*
+ * Copyright (c) 2023-2024 Ian Marco Moffett and the Osmora Team.
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions are met:
+ *
+ * 1. Redistributions of source code must retain the above copyright notice,
+ * this list of conditions and the following disclaimer.
+ * 2. Redistributions in binary form must reproduce the above copyright
+ * notice, this list of conditions and the following disclaimer in the
+ * documentation and/or other materials provided with the distribution.
+ * 3. Neither the name of Hyra nor the names of its
+ * contributors may be used to endorse or promote products derived from
+ * this software without specific prior written permission.
+ *
+ * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
+ * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+ * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
+ * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
+ * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
+ * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
+ * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
+ * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
+ * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
+ * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
+ * POSSIBILITY OF SUCH DAMAGE.
+ */
+
+#ifndef _AMD64_I8042REG_H_
+#define _AMD64_I8042REG_H_
+
+#include <sys/cdefs.h>
+
+#define I8042_DATA 0x60
+#define I8042_STATUS 0x64
+#define I8042_COMMAND 0x64
+
+/* Status register bits */
+#define I8042_OBUF_FULL __BIT(0) /* Output buffer full */
+#define I8042_IBUF_FULL __BIT(1) /* Input buffer full */
+
+/* Commands */
+#define I8042_DISABLE_PORT0 0xAD
+#define I8042_DISABLE_PORT1 0xA7
+#define I8042_ENABLE_PORT0 0xAE
+#define I8042_ENABLE_PORT1 0xA8
+#define I8042_GET_CONFB 0x20
+#define I8042_SET_CONFB 0x60
+#define I8042_PORT1_SEND 0xD4
+
+/* Controller config bits */
+#define I8042_PORT0_INTR __BIT(0)
+#define I8042_PORT1_INTR __BIT(1)
+#define I8042_PORT0_CLK __BIT(4)
+#define I8042_PORT1_CLK __BIT(5)
+
+/* Aux commands */
+#define I8042_AUX_DEFAULTS 0xF5
+#define I8042_AUX_ENABLE 0xF4
+#define I8042_AUX_DISABLE 0xF5
+#define I8042_AUX_RESET 0xFF
+
+/* LED bits */
+#define I8042_LED_SCROLL __BIT(0)
+#define I8042_LED_NUM __BIT(1)
+#define I8042_LED_CAPS __BIT(2)
+
+#endif /* !_AMD64_I8042REG_H_ */
diff --git a/sys/include/arch/amd64/sysvec.h b/sys/include/arch/amd64/sysvec.h
index 8feecb7..a6ff1bd 100644
--- a/sys/include/arch/amd64/sysvec.h
+++ b/sys/include/arch/amd64/sysvec.h
@@ -42,6 +42,7 @@ typedef enum {
SYSVEC_LAPIC_TIMER = 0x21, /* Local APIC timer */
SYSVEC_IPI, /* IPI vector */
SYSVEC_HLT, /* Halt vector */
+ SYSVEC_PCKBD, /* Keyboard vector */
/* -- XXX: New vectors go above -- */
NSYSVEC_BASE, /* Non-system vector base */
generated by cgit v1.2.3 (git 2.39.1) at 2024-12-22 21:19:03 +0000