| 1 | #include <stddef.h> |
| 2 | #include <stdint.h> |
| 3 | #include <sys/idt.h> |
| 4 | #include <lib/misc.h> |
| 5 | |
| 6 | #if defined (BIOS) |
| 7 | |
| 8 | static struct idt_entry idt_entries[32]; |
| 9 | |
| 10 | __attribute__((section(".realmode"))) |
| 11 | struct idtr idt = { |
| 12 | sizeof(idt_entries) - 1, |
| 13 | (uintptr_t)idt_entries |
| 14 | }; |
| 15 | |
| 16 | static void register_interrupt_handler(size_t vec, void *handler, uint8_t type) { |
| 17 | uint32_t p = (uint32_t)handler; |
| 18 | |
| 19 | idt_entries[vec].offset_lo = (uint16_t)p; |
| 20 | idt_entries[vec].selector = 0x18; |
| 21 | idt_entries[vec].unused = 0; |
| 22 | idt_entries[vec].type_attr = type; |
| 23 | idt_entries[vec].offset_hi = (uint16_t)(p >> 16); |
| 24 | } |
| 25 | |
| 26 | extern void *exceptions[]; |
| 27 | |
| 28 | void init_idt(void) { |
| 29 | for (size_t i = 0; i < SIZEOF_ARRAY(idt_entries); i++) |
| 30 | register_interrupt_handler(i, exceptions[i], 0x8e); |
| 31 | |
| 32 | asm volatile ("lidt %0" :: "m"(idt) : "memory"); |
| 33 | } |
| 34 | |
| 35 | #endif |
