1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
|
#include <idt.h>
#include <irq.h>
#include <pic.h>
__attribute__((aligned(0x10))) static idt_entry idt_table[256];
idtp idt_pointer;
void load_idt(idtp* pointer)
{
__asm__ volatile ("lidt (%0); sti;" : : "r"(pointer) : );
}
void add_to_idt(uint16_t num, uint64_t offset, uint16_t selector, uint8_t type)
{
idt_table[num].offset_1 = offset & 0xFFFF;
idt_table[num].offset_2 = (offset >> 16) & 0xFFFF;
idt_table[num].offset_3 = offset >> 32;
idt_table[num].selector = selector;
idt_table[num].type_attributes = type;
idt_table[num].ist = 0;
idt_table[num].zero = 0;
}
void init_idt_table(void)
{
// exceptions
add_to_idt(0, (uint64_t)isr0, GDT_CODE_SEG, TRAP_GATE);
add_to_idt(1, (uint64_t)isr1, GDT_CODE_SEG, TRAP_GATE);
add_to_idt(2, (uint64_t)isr2, GDT_CODE_SEG, TRAP_GATE);
add_to_idt(3, (uint64_t)isr3, GDT_CODE_SEG, TRAP_GATE);
add_to_idt(4, (uint64_t)isr4, GDT_CODE_SEG, TRAP_GATE);
add_to_idt(5, (uint64_t)isr5, GDT_CODE_SEG, TRAP_GATE);
add_to_idt(6, (uint64_t)isr6, GDT_CODE_SEG, TRAP_GATE);
add_to_idt(7, (uint64_t)isr7, GDT_CODE_SEG, TRAP_GATE);
add_to_idt(8, (uint64_t)isr8, GDT_CODE_SEG, TRAP_GATE);
add_to_idt(9, (uint64_t)isr9, GDT_CODE_SEG, TRAP_GATE);
add_to_idt(10, (uint64_t)isr10, GDT_CODE_SEG, TRAP_GATE);
add_to_idt(11, (uint64_t)isr11, GDT_CODE_SEG, TRAP_GATE);
add_to_idt(12, (uint64_t)isr12, GDT_CODE_SEG, TRAP_GATE);
add_to_idt(13, (uint64_t)isr13, GDT_CODE_SEG, TRAP_GATE);
add_to_idt(14, (uint64_t)isr14, GDT_CODE_SEG, TRAP_GATE);
add_to_idt(15, (uint64_t)isr15, GDT_CODE_SEG, TRAP_GATE);
add_to_idt(16, (uint64_t)isr16, GDT_CODE_SEG, TRAP_GATE);
add_to_idt(17, (uint64_t)isr17, GDT_CODE_SEG, TRAP_GATE);
add_to_idt(18, (uint64_t)isr18, GDT_CODE_SEG, TRAP_GATE);
add_to_idt(19, (uint64_t)isr19, GDT_CODE_SEG, TRAP_GATE);
add_to_idt(20, (uint64_t)isr20, GDT_CODE_SEG, TRAP_GATE);
add_to_idt(21, (uint64_t)isr21, GDT_CODE_SEG, TRAP_GATE);
add_to_idt(22, (uint64_t)isr22, GDT_CODE_SEG, TRAP_GATE);
add_to_idt(23, (uint64_t)isr23, GDT_CODE_SEG, TRAP_GATE);
add_to_idt(24, (uint64_t)isr24, GDT_CODE_SEG, TRAP_GATE);
add_to_idt(25, (uint64_t)isr25, GDT_CODE_SEG, TRAP_GATE);
add_to_idt(26, (uint64_t)isr26, GDT_CODE_SEG, TRAP_GATE);
add_to_idt(27, (uint64_t)isr27, GDT_CODE_SEG, TRAP_GATE);
add_to_idt(28, (uint64_t)isr28, GDT_CODE_SEG, TRAP_GATE);
add_to_idt(29, (uint64_t)isr29, GDT_CODE_SEG, TRAP_GATE);
add_to_idt(30, (uint64_t)isr30, GDT_CODE_SEG, TRAP_GATE);
add_to_idt(31, (uint64_t)isr31, GDT_CODE_SEG, TRAP_GATE);
// interrupts
add_to_idt(32, (uint64_t)irq0, GDT_CODE_SEG, INTERRUPT_GATE);
add_to_idt(33, (uint64_t)irq1, GDT_CODE_SEG, INTERRUPT_GATE);
add_to_idt(34, (uint64_t)irq2, GDT_CODE_SEG, INTERRUPT_GATE);
add_to_idt(35, (uint64_t)irq3, GDT_CODE_SEG, INTERRUPT_GATE);
add_to_idt(36, (uint64_t)irq4, GDT_CODE_SEG, INTERRUPT_GATE);
add_to_idt(37, (uint64_t)irq5, GDT_CODE_SEG, INTERRUPT_GATE);
add_to_idt(38, (uint64_t)irq6, GDT_CODE_SEG, INTERRUPT_GATE);
add_to_idt(39, (uint64_t)irq7, GDT_CODE_SEG, INTERRUPT_GATE);
add_to_idt(40, (uint64_t)irq8, GDT_CODE_SEG, INTERRUPT_GATE);
add_to_idt(41, (uint64_t)irq9, GDT_CODE_SEG, INTERRUPT_GATE);
add_to_idt(42, (uint64_t)irq10, GDT_CODE_SEG, INTERRUPT_GATE);
add_to_idt(43, (uint64_t)irq11, GDT_CODE_SEG, INTERRUPT_GATE);
add_to_idt(44, (uint64_t)irq12, GDT_CODE_SEG, INTERRUPT_GATE);
add_to_idt(45, (uint64_t)irq13, GDT_CODE_SEG, INTERRUPT_GATE);
add_to_idt(46, (uint64_t)irq14, GDT_CODE_SEG, INTERRUPT_GATE);
add_to_idt(47, (uint64_t)irq15, GDT_CODE_SEG, INTERRUPT_GATE);
}
void init_idt()
{
init_idt_table();
idt_pointer.size = sizeof(idt_entry) * 256 - 1;
idt_pointer.offset = (uint64_t)&idt_table;
remap_pic();
load_idt(&idt_pointer);
}
|
