Changeset 89 for trunk/hal/x86_64/core/hal_apic.c

Timestamp:

Jun 29, 2017, 9:54:01 AM (7 years ago)

Author:

max@…

Message:

Parse the IOAPIC structure in ACPI, map the IOAPIC, and enable
the keyboard interrupt. Its queue is not flushed yet.

File:

• trunk/hal/x86_64/core/hal_apic.c (modified) (2 diffs)

trunk/hal/x86_64/core/hal_apic.c

@@ -50 +50 @@
         out8(PIC1_DATA, 0xff);
         out8(PIC2_DATA, 0xff);
+}
+
+/* -------------------------------------------------------------------------- */
+
+paddr_t ioapic_pa __in_kdata = 0;
+vaddr_t ioapic_va __in_kdata = 0;
+
+#define IRQ_TIMER       0x00
+#define IRQ_KEYBOARD    0x01
+#define IRQ_COM2        0x03
+#define IRQ_COM1        0x04
+#define IRQ_FLOPPY      0x06
+#define IRQ_ATA0        0x0e
+#define IRQ_ATA1        0x0f
+
+#define IOREGSEL        0x00
+#define IOWIN   0x10
+
+#define IOAPICID        0x00
+#define IOAPICVER       0x01
+#define IOAPICARB       0x02
+#define IOREDTBL        0x10
+
+#define IOENTRY_DISABLE 0x10000
+
+void hal_ioapic_write(uint8_t reg, uint32_t val)
+{
+        *((volatile uint32_t *)((uint8_t *)ioapic_va + IOREGSEL)) = reg;
+        *((volatile uint32_t *)((uint8_t *)ioapic_va + IOWIN)) = val;
+}
+
+uint32_t hal_ioapic_read(uint8_t reg)
+{
+        *((volatile uint32_t *)((uint8_t *)ioapic_va + IOREGSEL)) = reg;
+        return *((volatile uint32_t *)((uint8_t *)ioapic_va + IOWIN));
+}
+
+void hal_ioapic_set_entry(uint8_t index, uint64_t data)
+{
+        hal_ioapic_write(IOREDTBL + index * 2, (uint32_t)(data & 0xFFFFFFFF));
+        hal_ioapic_write(IOREDTBL + index * 2 + 1, (uint32_t)(data >> 32));
+}
+
+static void hal_ioapic_init()
+{
+        size_t i, pins;
+        uint32_t ver;
+
+        ioapic_va = hal_gpt_bootstrap_valloc(1); // XXX: should be shared
+
+        hal_gpt_enter(ioapic_va, ioapic_pa, PG_V|PG_KW|PG_NX|PG_N);
+
+        ver = hal_ioapic_read(IOAPICVER);
+        pins = ((ver >> 16) & 0xFF) + 1;
+
+        /* Explicitly disable (mask) each vector */
+        for (i = 0; i < pins; i++) {
+                hal_ioapic_set_entry(i, IOENTRY_DISABLE);
+        }
+
+        /* Now, enable the keyboard */
+        hal_ioapic_set_entry(IRQ_KEYBOARD, IOAPIC_KEYBOARD_VECTOR);
 }
 
@@ -122 +184 @@
         /* Enable the LAPIC */
         hal_lapic_init();
+
+        /* Enable the IOAPIC */
+        hal_ioapic_init();
 }