55 lines
1.1 KiB
C
55 lines
1.1 KiB
C
|
#include "idt.h"
|
||
|
#include "io.h"
|
||
|
#include <stdint.h>
|
||
|
|
||
|
#define IDT_ENTRIES 256
|
||
|
|
||
|
struct idt_entry {
|
||
|
uint16_t base_lo;
|
||
|
uint16_t sel;
|
||
|
uint8_t always0;
|
||
|
uint8_t flags;
|
||
|
uint16_t base_hi;
|
||
|
} __attribute__((packed));
|
||
|
|
||
|
struct idt_ptr {
|
||
|
uint16_t limit;
|
||
|
uint32_t base;
|
||
|
} __attribute__((packed));
|
||
|
|
||
|
struct idt_entry idt[IDT_ENTRIES];
|
||
|
struct idt_ptr idtp;
|
||
|
|
||
|
void idt_set_gate(uint8_t num, uint32_t base, uint16_t sel, uint8_t flags) {
|
||
|
idt[num].base_lo = base & 0xFFFF;
|
||
|
idt[num].base_hi = (base >> 16) & 0xFFFF;
|
||
|
idt[num].sel = sel;
|
||
|
idt[num].always0 = 0;
|
||
|
idt[num].flags = flags | 0x60;
|
||
|
}
|
||
|
|
||
|
void idt_install() {
|
||
|
idtp.limit = (sizeof(struct idt_entry) * IDT_ENTRIES) - 1;
|
||
|
idtp.base = (uint32_t)&idt;
|
||
|
idt_load();
|
||
|
}
|
||
|
|
||
|
void pic_remap(int offset1, int offset2) {
|
||
|
unsigned char a1, a2;
|
||
|
|
||
|
a1 = inb(0x21);
|
||
|
a2 = inb(0xA1);
|
||
|
|
||
|
outb(0x20, 0x11);
|
||
|
outb(0xA0, 0x11);
|
||
|
outb(0x21, offset1);
|
||
|
outb(0xA1, offset2);
|
||
|
outb(0x21, 0x04);
|
||
|
outb(0xA1, 0x02);
|
||
|
|
||
|
outb(0x21, 0x01);
|
||
|
outb(0xA1, 0x01);
|
||
|
|
||
|
outb(0x21, a1);
|
||
|
outb(0xA1, a2);
|
||
|
}
|