Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- #include "console.h"
- #include "int.h"
- #define IDT_ENTRIES 256
- static uint64_t idt[IDT_ENTRIES];
- extern void intr_stub_0(void);
- extern void intr_stub_1(void);
- extern void intr_stub_2(void);
- extern void intr_stub_3(void);
- extern void intr_stub_4(void);
- extern void intr_stub_5(void);
- extern void intr_stub_6(void);
- extern void intr_stub_7(void);
- extern void intr_stub_8(void);
- extern void intr_stub_9(void);
- extern void intr_stub_10(void);
- extern void intr_stub_11(void);
- extern void intr_stub_12(void);
- extern void intr_stub_13(void);
- extern void intr_stub_14(void);
- extern void intr_stub_15(void);
- extern void intr_stub_16(void);
- extern void intr_stub_17(void);
- extern void intr_stub_18(void);
- extern void intr_stub_19(void);
- extern void intr_stub_32(void);
- extern void intr_stub_33(void);
- extern void intr_stub_34(void);
- extern void intr_stub_35(void);
- extern void intr_stub_36(void);
- extern void intr_stub_37(void);
- extern void intr_stub_38(void);
- extern void intr_stub_39(void);
- extern void intr_stub_40(void);
- extern void intr_stub_41(void);
- extern void intr_stub_42(void);
- extern void intr_stub_43(void);
- extern void intr_stub_44(void);
- extern void intr_stub_45(void);
- extern void intr_stub_46(void);
- extern void intr_stub_47(void);
- extern void intr_stub_48(void);
- static void load_idt() {
- struct {
- uint16_t limit;
- void* pointer;
- } __attribute__((packed)) idtp = {
- .limit = IDT_ENTRIES * 8 - 1,
- .pointer = idt,
- };
- asm volatile("lidt %0" : : "m" (idtp));
- }
- void handle_interrupt(struct cpu_state* cpu) {
- if (cpu->intr <= 0x1f) {
- kprintf("\nKernel panic - Exception %i", cpu->intr);
- if (cpu->intr==13)
- kprintf("\nSegment %x",cpu->error);
- // Hier den CPU-Zustand ausgeben
- while(1) {
- // Prozessor anhalten
- asm volatile("cli; hlt");
- }
- } else {
- if (cpu->intr >= 0x20 && cpu->intr <= 0x2f) {
- if (cpu->intr >= 0x28) {
- outb(0xa0, 0x20);
- }
- outb(0x20, 0x20);
- }
- kprintf("\nInterrupt %x",cpu->intr);
- }
- }
- static void set_idtentry(int i, void* base, unsigned int selector, unsigned int typ, unsigned int dpl) {
- idt[i] = (unsigned int)base & 0xffff;
- idt[i] |= (uint64_t)((unsigned int)base & 0xffff0000) << 32;
- idt[i] |= (uint64_t)(selector << 16);
- idt[i] |= (uint64_t)typ << 40;
- idt[i] |= (uint64_t)dpl << 45;
- idt[i] |= (uint64_t)1 << 47;
- }
- void init_idt(void) {
- int i;
- for (i = 0; i < IDT_ENTRIES; i++)
- {
- idt[i]=0;
- }
- set_idtentry( 0, intr_stub_0,0x8,GATE_INTERRUPT,DPL0);
- set_idtentry( 1, intr_stub_1,0x8,GATE_INTERRUPT,DPL0);
- set_idtentry( 2, intr_stub_2,0x8,GATE_INTERRUPT,DPL0);
- set_idtentry( 3, intr_stub_3,0x8,GATE_INTERRUPT,DPL0);
- set_idtentry( 4, intr_stub_4,0x8,GATE_INTERRUPT,DPL0);
- set_idtentry( 5, intr_stub_5,0x8,GATE_INTERRUPT,DPL0);
- set_idtentry( 6, intr_stub_6,0x8,GATE_INTERRUPT,DPL0);
- set_idtentry( 7, intr_stub_7,0x8,GATE_INTERRUPT,DPL0);
- set_idtentry( 8, intr_stub_8,0x8,GATE_INTERRUPT,DPL0);
- set_idtentry( 9, intr_stub_9,0x8,GATE_INTERRUPT,DPL0);
- set_idtentry(10,intr_stub_10,0x8,GATE_INTERRUPT,DPL0);
- set_idtentry(11,intr_stub_11,0x8,GATE_INTERRUPT,DPL0);
- set_idtentry(12,intr_stub_12,0x8,GATE_INTERRUPT,DPL0);
- set_idtentry(13,intr_stub_13,0x8,GATE_INTERRUPT,DPL0);
- set_idtentry(14,intr_stub_14,0x8,GATE_INTERRUPT,DPL0);
- set_idtentry(15,intr_stub_15,0x8,GATE_INTERRUPT,DPL0);
- set_idtentry(16,intr_stub_16,0x8,GATE_INTERRUPT,DPL0);
- set_idtentry(17,intr_stub_17,0x8,GATE_INTERRUPT,DPL0);
- set_idtentry(18,intr_stub_18,0x8,GATE_INTERRUPT,DPL0);
- set_idtentry(19,intr_stub_18,0x8,GATE_INTERRUPT,DPL0);
- set_idtentry(32,intr_stub_32,0x8,GATE_INTERRUPT,DPL0);
- set_idtentry(33,intr_stub_33,0x8,GATE_INTERRUPT,DPL0);
- set_idtentry(34,intr_stub_34,0x8,GATE_INTERRUPT,DPL0);
- set_idtentry(35,intr_stub_35,0x8,GATE_INTERRUPT,DPL0);
- set_idtentry(36,intr_stub_36,0x8,GATE_INTERRUPT,DPL0);
- set_idtentry(37,intr_stub_37,0x8,GATE_INTERRUPT,DPL0);
- set_idtentry(38,intr_stub_38,0x8,GATE_INTERRUPT,DPL0);
- set_idtentry(39,intr_stub_39,0x8,GATE_INTERRUPT,DPL0);
- set_idtentry(40,intr_stub_40,0x8,GATE_INTERRUPT,DPL0);
- set_idtentry(41,intr_stub_41,0x8,GATE_INTERRUPT,DPL0);
- set_idtentry(42,intr_stub_42,0x8,GATE_INTERRUPT,DPL0);
- set_idtentry(43,intr_stub_43,0x8,GATE_INTERRUPT,DPL0);
- set_idtentry(44,intr_stub_44,0x8,GATE_INTERRUPT,DPL0);
- set_idtentry(45,intr_stub_45,0x8,GATE_INTERRUPT,DPL0);
- set_idtentry(46,intr_stub_46,0x8,GATE_INTERRUPT,DPL0);
- set_idtentry(47,intr_stub_47,0x8,GATE_INTERRUPT,DPL0);
- set_idtentry(48,intr_stub_48,0x8,GATE_INTERRUPT,DPL0);
- init_pic();
- load_idt();
- }
- void init_pic(void) {
- outb(0x20, 0x11); // Initialisierungsbefehl fuer den PIC
- outb(0x21, 0x20); // Interruptnummer fuer IRQ 0
- outb(0x21, 0x04); // An IRQ 2 haengt der Slave
- outb(0x21, 0x01); // ICW 4
- // Slave-PIC initialisieren
- outb(0xa0, 0x11); // Initialisierungsbefehl fuer den PIC
- outb(0xa1, 0x28); // Interruptnummer fuer IRQ 8
- outb(0xa1, 0x02); // An IRQ 2 haengt der Slave
- outb(0xa1, 0x01); // ICW 4
- // Alle IRQs aktivieren (demaskieren)
- outb(0x20, 0x0);
- outb(0xa0, 0x0);
- }
Advertisement
Add Comment
Please, Sign In to add comment