36 lines
829 B
C
36 lines
829 B
C
#include <stddef.h>
|
|
#include <stdint.h>
|
|
#include <sys/idt.h>
|
|
#include <lib/blib.h>
|
|
|
|
#if defined (bios)
|
|
|
|
static struct idt_entry idt_entries[32];
|
|
|
|
__attribute__((section(".realmode")))
|
|
struct idtr idt = {
|
|
sizeof(idt_entries) - 1,
|
|
(uintptr_t)idt_entries
|
|
};
|
|
|
|
static void register_interrupt_handler(size_t vec, void *handler, uint8_t type) {
|
|
uint32_t p = (uint32_t)handler;
|
|
|
|
idt_entries[vec].offset_lo = (uint16_t)p;
|
|
idt_entries[vec].selector = 0x18;
|
|
idt_entries[vec].unused = 0;
|
|
idt_entries[vec].type_attr = type;
|
|
idt_entries[vec].offset_hi = (uint16_t)(p >> 16);
|
|
}
|
|
|
|
extern void *exceptions[];
|
|
|
|
void init_idt(void) {
|
|
for (size_t i = 0; i < SIZEOF_ARRAY(idt_entries); i++)
|
|
register_interrupt_handler(i, exceptions[i], 0x8e);
|
|
|
|
asm volatile ("lidt %0" :: "m"(idt) : "memory");
|
|
}
|
|
|
|
#endif
|