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
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
|
// MIT License, Copyright (c) 2021 Marvin Borner
#include <int.h>
#include <log.h>
#include <pic.h>
#include <pnc.h>
/**
* IDT
*/
extern u32 int_table[];
static struct idt_entry idt_entries[256] = { 0 };
REAL struct idt_ptr idt = { .size = sizeof(idt_entries) - 1, .base = &idt_entries };
void idt_install(void)
{
for (u8 i = 0; i < 3; i++)
idt_entries[i] = IDT_ENTRY(int_table[i], 0x08, INT_GATE);
idt_entries[3] = IDT_ENTRY(int_table[3], 0x08, INT_TRAP);
idt_entries[4] = IDT_ENTRY(int_table[4], 0x08, INT_TRAP);
for (u8 i = 5; i < 48; i++)
idt_entries[i] = IDT_ENTRY(int_table[i], 0x08, INT_GATE);
// Load table
__asm__ volatile("lidt %0" : : "m"(idt));
}
/**
* Exception (trap) handling
*/
const char *int_trap_names[32] = {
"Division By Zero",
"Debug",
"Non Maskable Interrupt",
"Breakpoint",
"Into Detected Overflow",
"Out of Bounds",
"Invalid Opcode",
"No Coprocessor",
"Double Fault",
"Coprocessor Segment Overrun",
"Bad TSS",
"Segment Not Present",
"Stack Fault",
"General Protection Fault",
"Page Fault",
"Unknown Interrupt",
"Coprocessor Fault",
"Alignment Check",
"Machine Check",
"Reserved",
"Reserved",
"Reserved",
"Reserved",
"Reserved",
"Reserved",
"Reserved",
"Reserved",
"Reserved",
"Reserved",
"Reserved",
"Reserved",
"Reserved",
};
static void int_trap_handler(struct int_frame *frame)
{
static u8 faulting = 0;
faulting++;
if (faulting == 2) {
// Fall back to serial driver
serial_print("Double fault, halting immediatly\n");
while (1)
__asm__ volatile("cli\nhlt");
}
log("%s Exception (code %x) at 0x%x!\n", int_trap_names[frame->int_no], frame->err_code,
frame->eip);
while (1)
__asm__ volatile("cli\nhlt");
}
/**
* Event handling
*/
static void (*int_event_handlers[16])(void) = { 0 };
void int_event_handler_add(u32 int_no, void (*handler)(void))
{
assert(int_no < COUNT(int_event_handlers));
int_event_handlers[int_no] = handler;
}
static u32 int_event_handler(struct int_frame *frame)
{
u32 int_no = frame->int_no - 32;
assert(int_no < COUNT(int_event_handlers));
void (*handler)(void) = int_event_handlers[int_no];
if (handler)
handler();
return (u32)frame;
}
/**
* Universal handler
*/
u32 int_handler(u32 esp);
u32 int_handler(u32 esp)
{
struct int_frame *frame = (struct int_frame *)esp;
if (frame->int_no < 32)
int_trap_handler(frame);
else if (frame->int_no < 48)
esp = int_event_handler(frame);
else
panic("Unknown interrupt\n");
pic_ack(frame->int_no);
return esp;
}
|
