CeDOS - kernel/interrupts.c

kernel/interrupts.c (view raw)

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
#include "cedos/interrupts.h"
#include "cedos/drivers/console.h"

#define HARDWARE_INTERRUPT (0b10001110)
#define SYSCALL_INTERRUPT (0b11101110)

#define array_sizeof(array) (sizeof(array)/sizeof(array[0]))

#define MAKE_IDT_ENTRY(func, selector, type) { \
        (uint16_t)(func), \
        (uint16_t)(selector), \
        0, \
        (uint8_t)(type), \
        (uint16_t)(0xC000) \
    }

__attribute__((interrupt)) volatile void default_isr(INTERRUPT_FRAME *frame) {
    vga_con.write_s("interrupt was issued\n");
}

__attribute__((interrupt)) volatile void breakpoint_isr(INTERRUPT_FRAME *frame) {
    vga_con.write_s("BREAKPOINT WAS HIT\n");
    // dump registers to stdout
}

__attribute__((interrupt)) volatile void double_fault_isr(INTERRUPT_FRAME *frame) {
    vga_con.write_s("CRITICAL: DOUBLE FAULT\n");
    //while (1) {}
}

IDT_ENTRY IDT[31];

void install_interrupt(int index, void* func, uint16_t selector, uint8_t type) {
    IDT[index].offset_0 = (uint16_t)((uint32_t)func);
    IDT[index].selector = selector;
    IDT[index].__zero = 0;
    IDT[index].type_attr = type;
    IDT[index].offset_16 = (uint16_t)((uint32_t)(func) >> 16);
    //if (index == 7) { while(1) {} }
}

struct {
    uint16_t limit;
    void* offset;
}__attribute__((packed)) IDT_DESC = {
    sizeof(IDT),
    IDT
};

int interrupts_init(void) {
    for (uint32_t i = 0; i < array_sizeof(IDT); i++) {
        switch (i) {
            case 0x03:
            install_interrupt(i, breakpoint_isr, 0x08, HARDWARE_INTERRUPT);
            break;
            case 0x08:
            install_interrupt(i, double_fault_isr, 0x08, HARDWARE_INTERRUPT);
            break;
            default:
            install_interrupt(i, default_isr, 0x08, HARDWARE_INTERRUPT);
            break;
        }

        return 1;
    }

    __asm__ volatile (
            "lidt (%0)\n"
            "sti" : : 
            "m" (IDT_DESC)
        );
}