Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- #include "stdint.h"
- #include "intr.h"
- #include "console.h"
- extern void intr_stub_0();
- extern void intr_stub_1();
- extern void intr_stub_2();
- extern void intr_stub_3();
- extern void intr_stub_4();
- extern void intr_stub_5();
- extern void intr_stub_6();
- extern void intr_stub_7();
- extern void intr_stub_8();
- extern void intr_stub_9();
- extern void intr_stub_10();
- extern void intr_stub_11();
- extern void intr_stub_12();
- extern void intr_stub_13();
- extern void intr_stub_14();
- extern void intr_stub_15();
- extern void intr_stub_16();
- extern void intr_stub_17();
- extern void intr_stub_18();
- extern void intr_stub_32();
- extern void intr_stub_33();
- /*extern void intr_stub_34();
- extern void intr_stub_35();
- extern void intr_stub_36();
- extern void intr_stub_37();
- extern void intr_stub_38();
- extern void intr_stub_39();
- extern void intr_stub_40();
- extern void intr_stub_41();
- extern void intr_stub_42();
- extern void intr_stub_43();
- extern void intr_stub_44();
- extern void intr_stub_45();
- extern void intr_stub_46();
- extern void intr_stub_47();*/
- extern void intr_stub_48();
- #define GDT_FLAG_DATASEG 0x02
- #define GDT_FLAG_CODESEG 0x0a
- #define GDT_FLAG_TSS 0x09
- #define GDT_FLAG_SEGMENT 0x10
- #define GDT_FLAG_RING0 0x00
- #define GDT_FLAG_RING3 0x60
- #define GDT_FLAG_PRESENT 0x80
- #define GDT_FLAG_4K 0x800
- #define GDT_FLAG_32_BIT 0x400
- #define GDT_ENTRIES 5
- static uint64_t gdt[GDT_ENTRIES];
- #define IDT_ENTRIES 256
- static long long unsigned int idt[IDT_ENTRIES];
- static void gdt_set_entry(int i, unsigned int base, unsigned int limit, int flags) {
- gdt[i] = limit & 0xffffLL;
- gdt[i] |= (base & 0xffffffLL) << 16;
- gdt[i] |= (flags & 0xffLL) << 40;
- gdt[i] |= ((limit >> 16) & 0xfLL) << 48;
- gdt[i] |= ((flags >> 8) & 0xffLL) << 52;
- gdt[i] |= ((base >> 24) & 0xffLL) << 56;
- }
- void init_gdt() {
- struct {
- uint16_t limit;
- void* pointer;
- } __attribute__((packed)) gdtp = {
- .limit = GDT_ENTRIES * 8 - 1,
- .pointer = gdt,
- };
- gdt_set_entry(0, 0, 0, 0);
- gdt_set_entry(1, 0, 0xfffff, GDT_FLAG_SEGMENT | GDT_FLAG_32_BIT | GDT_FLAG_CODESEG | GDT_FLAG_4K | GDT_FLAG_PRESENT);
- gdt_set_entry(2, 0, 0xfffff, GDT_FLAG_SEGMENT | GDT_FLAG_32_BIT | GDT_FLAG_DATASEG | GDT_FLAG_4K | GDT_FLAG_PRESENT);
- gdt_set_entry(3, 0, 0xfffff, GDT_FLAG_SEGMENT | GDT_FLAG_32_BIT | GDT_FLAG_CODESEG | GDT_FLAG_4K | GDT_FLAG_PRESENT | GDT_FLAG_RING3);
- gdt_set_entry(4, 0, 0xfffff, GDT_FLAG_SEGMENT | GDT_FLAG_32_BIT | GDT_FLAG_DATASEG | GDT_FLAG_4K | GDT_FLAG_PRESENT | GDT_FLAG_RING3);
- asm volatile("lgdt %0" : : "m" (gdtp));
- asm volatile(
- "mov $0x10, %ax;"
- "mov %ax, %ds;"
- "mov %ax, %es;"
- "mov %ax, %ss;"
- "ljmp $0x8, $.1;"
- ".1:"
- );
- }
- #define IDT_FLAG_INTERRUPT_GATE 0xe
- #define IDT_FLAG_PRESENT 0x80
- #define IDT_FLAG_RING0 0x00
- #define IDT_FLAG_RING3 0x60
- static void idt_set_entry(int i, void (*fn)(), unsigned int selector, int flags) {
- unsigned long int handler = (unsigned long int) fn;
- idt[i] = handler & 0xffffLL;
- idt[i] |= (selector & 0xffffLL) << 16;
- idt[i] |= (flags & 0xffLL) << 40;
- idt[i] |= ((handler >> 16) & 0xffffLL) << 48;
- }
- static inline void outb(uint16_t port, uint8_t data) {
- asm volatile("outb %0, %1" : : "a" (data), "Nd" (port));
- }
- void init_pic() {
- outb(0x20, 0x11);
- outb(0x21, 0x20);
- outb(0x21, 0x04);
- outb(0x21, 0x01);
- outb(0xa0, 0x11);
- outb(0xa1, 0x28);
- outb(0xa1, 0x02);
- outb(0xa1, 0x01);
- outb(0x20, 0x0);
- outb(0xa0, 0x0);
- }
- void init_intr() {
- struct {
- unsigned short int limit;
- void* pointer;
- } __attribute__((packed)) idtp = {
- .limit = IDT_ENTRIES * 8 - 1,
- .pointer = idt,
- };
- init_pic();
- idt_set_entry(0, intr_stub_0, 0x8, IDT_FLAG_INTERRUPT_GATE | IDT_FLAG_RING0 | IDT_FLAG_PRESENT);
- idt_set_entry(1, intr_stub_1, 0x8, IDT_FLAG_INTERRUPT_GATE | IDT_FLAG_RING0 | IDT_FLAG_PRESENT);
- idt_set_entry(2, intr_stub_2, 0x8, IDT_FLAG_INTERRUPT_GATE | IDT_FLAG_RING0 | IDT_FLAG_PRESENT);
- idt_set_entry(3, intr_stub_3, 0x8, IDT_FLAG_INTERRUPT_GATE | IDT_FLAG_RING0 | IDT_FLAG_PRESENT);
- idt_set_entry(4, intr_stub_4, 0x8, IDT_FLAG_INTERRUPT_GATE | IDT_FLAG_RING0 | IDT_FLAG_PRESENT);
- idt_set_entry(5, intr_stub_5, 0x8, IDT_FLAG_INTERRUPT_GATE | IDT_FLAG_RING0 | IDT_FLAG_PRESENT);
- idt_set_entry(6, intr_stub_6, 0x8, IDT_FLAG_INTERRUPT_GATE | IDT_FLAG_RING0 | IDT_FLAG_PRESENT);
- idt_set_entry(7, intr_stub_7, 0x8, IDT_FLAG_INTERRUPT_GATE | IDT_FLAG_RING0 | IDT_FLAG_PRESENT);
- idt_set_entry(8, intr_stub_8, 0x8, IDT_FLAG_INTERRUPT_GATE | IDT_FLAG_RING0 | IDT_FLAG_PRESENT);
- idt_set_entry(9, intr_stub_9, 0x8, IDT_FLAG_INTERRUPT_GATE | IDT_FLAG_RING0 | IDT_FLAG_PRESENT);
- idt_set_entry(10, intr_stub_10, 0x8, IDT_FLAG_INTERRUPT_GATE | IDT_FLAG_RING0 | IDT_FLAG_PRESENT);
- idt_set_entry(11, intr_stub_11, 0x8, IDT_FLAG_INTERRUPT_GATE | IDT_FLAG_RING0 | IDT_FLAG_PRESENT);
- idt_set_entry(12, intr_stub_12, 0x8, IDT_FLAG_INTERRUPT_GATE | IDT_FLAG_RING0 | IDT_FLAG_PRESENT);
- idt_set_entry(13, intr_stub_13, 0x8, IDT_FLAG_INTERRUPT_GATE | IDT_FLAG_RING0 | IDT_FLAG_PRESENT);
- idt_set_entry(14, intr_stub_14, 0x8, IDT_FLAG_INTERRUPT_GATE | IDT_FLAG_RING0 | IDT_FLAG_PRESENT);
- idt_set_entry(15, intr_stub_15, 0x8, IDT_FLAG_INTERRUPT_GATE | IDT_FLAG_RING0 | IDT_FLAG_PRESENT);
- idt_set_entry(16, intr_stub_16, 0x8, IDT_FLAG_INTERRUPT_GATE | IDT_FLAG_RING0 | IDT_FLAG_PRESENT);
- idt_set_entry(17, intr_stub_17, 0x8, IDT_FLAG_INTERRUPT_GATE | IDT_FLAG_RING0 | IDT_FLAG_PRESENT);
- idt_set_entry(18, intr_stub_18, 0x8, IDT_FLAG_INTERRUPT_GATE | IDT_FLAG_RING0 | IDT_FLAG_PRESENT);
- idt_set_entry(32, intr_stub_32, 0x8, IDT_FLAG_INTERRUPT_GATE | IDT_FLAG_RING0 | IDT_FLAG_PRESENT);
- idt_set_entry(33, intr_stub_33, 0x8, IDT_FLAG_INTERRUPT_GATE | IDT_FLAG_RING0 | IDT_FLAG_PRESENT);
- /*idt_set_entry(34, intr_stub_34, 0x8, IDT_FLAG_INTERRUPT_GATE | IDT_FLAG_RING0 | IDT_FLAG_PRESENT);
- idt_set_entry(35, intr_stub_35, 0x8, IDT_FLAG_INTERRUPT_GATE | IDT_FLAG_RING0 | IDT_FLAG_PRESENT);
- idt_set_entry(36, intr_stub_36, 0x8, IDT_FLAG_INTERRUPT_GATE | IDT_FLAG_RING0 | IDT_FLAG_PRESENT);
- idt_set_entry(37, intr_stub_37, 0x8, IDT_FLAG_INTERRUPT_GATE | IDT_FLAG_RING0 | IDT_FLAG_PRESENT);
- idt_set_entry(38, intr_stub_38, 0x8, IDT_FLAG_INTERRUPT_GATE | IDT_FLAG_RING0 | IDT_FLAG_PRESENT);
- idt_set_entry(39, intr_stub_39, 0x8, IDT_FLAG_INTERRUPT_GATE | IDT_FLAG_RING0 | IDT_FLAG_PRESENT);
- idt_set_entry(40, intr_stub_40, 0x8, IDT_FLAG_INTERRUPT_GATE | IDT_FLAG_RING0 | IDT_FLAG_PRESENT);
- idt_set_entry(41, intr_stub_41, 0x8, IDT_FLAG_INTERRUPT_GATE | IDT_FLAG_RING0 | IDT_FLAG_PRESENT);
- idt_set_entry(42, intr_stub_42, 0x8, IDT_FLAG_INTERRUPT_GATE | IDT_FLAG_RING0 | IDT_FLAG_PRESENT);
- idt_set_entry(43, intr_stub_43, 0x8, IDT_FLAG_INTERRUPT_GATE | IDT_FLAG_RING0 | IDT_FLAG_PRESENT);
- idt_set_entry(44, intr_stub_44, 0x8, IDT_FLAG_INTERRUPT_GATE | IDT_FLAG_RING0 | IDT_FLAG_PRESENT);
- idt_set_entry(45, intr_stub_45, 0x8, IDT_FLAG_INTERRUPT_GATE | IDT_FLAG_RING0 | IDT_FLAG_PRESENT);
- idt_set_entry(46, intr_stub_46, 0x8, IDT_FLAG_INTERRUPT_GATE | IDT_FLAG_RING0 | IDT_FLAG_PRESENT);
- idt_set_entry(47, intr_stub_47, 0x8, IDT_FLAG_INTERRUPT_GATE | IDT_FLAG_RING0 | IDT_FLAG_PRESENT);*/
- idt_set_entry(48, intr_stub_48, 0x8, IDT_FLAG_INTERRUPT_GATE | IDT_FLAG_RING3 | IDT_FLAG_PRESENT);
- asm volatile("lidt %0" : : "m" (idtp));
- asm volatile("sti");
- }
- void handle_interrupt(struct cpu_state* cpu) {
- kprintf("ff");
- if(cpu->intr <= 0x1f) {
- kprintf("Exception %d, kernel halted!\n", cpu->intr);
- while(1) {
- asm volatile("cli; hlt;");
- }
- } else if(cpu->intr >= 0x20 && cpu->intr <= 0x2f) {
- if(cpu->intr >= 0x28) {
- outb(0xa0, 0x20);
- }
- outb(0x20, 0x20);
- } else {
- kprintf("Unknown interrupt");
- while(1) {
- asm volatile("cli; hlt;");
- }
- }
- }
Advertisement
Add Comment
Please, Sign In to add comment