Guest User

arbu

a guest
Mar 1st, 2013
35
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
C 5.04 KB | None | 0 0
  1. #include "console.h"
  2. #include "int.h"
  3.  
  4. #define IDT_ENTRIES 256
  5.  
  6. static uint64_t idt[IDT_ENTRIES];
  7.  
  8. extern void intr_stub_0(void);
  9. extern void intr_stub_1(void);
  10. extern void intr_stub_2(void);
  11. extern void intr_stub_3(void);
  12. extern void intr_stub_4(void);
  13. extern void intr_stub_5(void);
  14. extern void intr_stub_6(void);
  15. extern void intr_stub_7(void);
  16. extern void intr_stub_8(void);
  17. extern void intr_stub_9(void);
  18. extern void intr_stub_10(void);
  19. extern void intr_stub_11(void);
  20. extern void intr_stub_12(void);
  21. extern void intr_stub_13(void);
  22. extern void intr_stub_14(void);
  23. extern void intr_stub_15(void);
  24. extern void intr_stub_16(void);
  25. extern void intr_stub_17(void);
  26. extern void intr_stub_18(void);
  27. extern void intr_stub_19(void);
  28.  
  29. extern void intr_stub_32(void);
  30. extern void intr_stub_33(void);
  31. extern void intr_stub_34(void);
  32. extern void intr_stub_35(void);
  33. extern void intr_stub_36(void);
  34. extern void intr_stub_37(void);
  35. extern void intr_stub_38(void);
  36. extern void intr_stub_39(void);
  37. extern void intr_stub_40(void);
  38. extern void intr_stub_41(void);
  39. extern void intr_stub_42(void);
  40. extern void intr_stub_43(void);
  41. extern void intr_stub_44(void);
  42. extern void intr_stub_45(void);
  43. extern void intr_stub_46(void);
  44. extern void intr_stub_47(void);
  45. extern void intr_stub_48(void);
  46.  
  47. static void load_idt() {
  48.     struct {
  49.         uint16_t limit;
  50.         void* pointer;
  51.     } __attribute__((packed)) idtp = {
  52.         .limit = IDT_ENTRIES * 8 - 1,
  53.         .pointer = idt,
  54.     };
  55.     asm volatile("lidt %0" : : "m" (idtp));
  56. }
  57.  
  58. void handle_interrupt(struct cpu_state* cpu) {
  59.     if (cpu->intr <= 0x1f) {
  60.         kprintf("\nKernel panic - Exception %i", cpu->intr);
  61.         if (cpu->intr==13)
  62.             kprintf("\nSegment %x",cpu->error);
  63.             // Hier den CPU-Zustand ausgeben
  64.             while(1) {
  65.                 // Prozessor anhalten
  66.                 asm volatile("cli; hlt");
  67.             }
  68.            
  69.     } else {
  70.         if (cpu->intr >= 0x20 && cpu->intr <= 0x2f) {
  71.             if (cpu->intr >= 0x28) {
  72.                 outb(0xa0, 0x20);
  73.             }
  74.             outb(0x20, 0x20);
  75.         }
  76.         kprintf("\nInterrupt %x",cpu->intr);
  77.     }
  78. }
  79.  
  80. static void set_idtentry(int i, void* base, unsigned int selector, unsigned int typ, unsigned int dpl) {
  81.     idt[i]  = (unsigned int)base & 0xffff;
  82.     idt[i] |= (uint64_t)((unsigned int)base & 0xffff0000) << 32;
  83.     idt[i] |= (uint64_t)(selector << 16);
  84.     idt[i] |= (uint64_t)typ << 40;
  85.     idt[i] |= (uint64_t)dpl << 45;
  86.     idt[i] |= (uint64_t)1 << 47;
  87. }
  88.  
  89.  
  90.  
  91. void init_idt(void) {
  92.     int i;
  93.     for (i = 0; i < IDT_ENTRIES; i++)
  94.       {
  95.         idt[i]=0;
  96.       }
  97.     set_idtentry( 0, intr_stub_0,0x8,GATE_INTERRUPT,DPL0);
  98.     set_idtentry( 1, intr_stub_1,0x8,GATE_INTERRUPT,DPL0);
  99.     set_idtentry( 2, intr_stub_2,0x8,GATE_INTERRUPT,DPL0);
  100.     set_idtentry( 3, intr_stub_3,0x8,GATE_INTERRUPT,DPL0);
  101.     set_idtentry( 4, intr_stub_4,0x8,GATE_INTERRUPT,DPL0);
  102.     set_idtentry( 5, intr_stub_5,0x8,GATE_INTERRUPT,DPL0);
  103.     set_idtentry( 6, intr_stub_6,0x8,GATE_INTERRUPT,DPL0);
  104.     set_idtentry( 7, intr_stub_7,0x8,GATE_INTERRUPT,DPL0);
  105.     set_idtentry( 8, intr_stub_8,0x8,GATE_INTERRUPT,DPL0);
  106.     set_idtentry( 9, intr_stub_9,0x8,GATE_INTERRUPT,DPL0);
  107.     set_idtentry(10,intr_stub_10,0x8,GATE_INTERRUPT,DPL0);
  108.     set_idtentry(11,intr_stub_11,0x8,GATE_INTERRUPT,DPL0);
  109.     set_idtentry(12,intr_stub_12,0x8,GATE_INTERRUPT,DPL0);
  110.     set_idtentry(13,intr_stub_13,0x8,GATE_INTERRUPT,DPL0);
  111.     set_idtentry(14,intr_stub_14,0x8,GATE_INTERRUPT,DPL0);
  112.     set_idtentry(15,intr_stub_15,0x8,GATE_INTERRUPT,DPL0);
  113.     set_idtentry(16,intr_stub_16,0x8,GATE_INTERRUPT,DPL0);
  114.     set_idtentry(17,intr_stub_17,0x8,GATE_INTERRUPT,DPL0);
  115.     set_idtentry(18,intr_stub_18,0x8,GATE_INTERRUPT,DPL0);
  116.     set_idtentry(19,intr_stub_18,0x8,GATE_INTERRUPT,DPL0);
  117.    
  118.     set_idtentry(32,intr_stub_32,0x8,GATE_INTERRUPT,DPL0);
  119.     set_idtentry(33,intr_stub_33,0x8,GATE_INTERRUPT,DPL0);
  120.     set_idtentry(34,intr_stub_34,0x8,GATE_INTERRUPT,DPL0);
  121.     set_idtentry(35,intr_stub_35,0x8,GATE_INTERRUPT,DPL0);
  122.     set_idtentry(36,intr_stub_36,0x8,GATE_INTERRUPT,DPL0);
  123.     set_idtentry(37,intr_stub_37,0x8,GATE_INTERRUPT,DPL0);
  124.     set_idtentry(38,intr_stub_38,0x8,GATE_INTERRUPT,DPL0);
  125.     set_idtentry(39,intr_stub_39,0x8,GATE_INTERRUPT,DPL0);
  126.     set_idtentry(40,intr_stub_40,0x8,GATE_INTERRUPT,DPL0);
  127.     set_idtentry(41,intr_stub_41,0x8,GATE_INTERRUPT,DPL0);
  128.     set_idtentry(42,intr_stub_42,0x8,GATE_INTERRUPT,DPL0);
  129.     set_idtentry(43,intr_stub_43,0x8,GATE_INTERRUPT,DPL0);
  130.     set_idtentry(44,intr_stub_44,0x8,GATE_INTERRUPT,DPL0);
  131.     set_idtentry(45,intr_stub_45,0x8,GATE_INTERRUPT,DPL0);
  132.     set_idtentry(46,intr_stub_46,0x8,GATE_INTERRUPT,DPL0);
  133.     set_idtentry(47,intr_stub_47,0x8,GATE_INTERRUPT,DPL0);
  134.     set_idtentry(48,intr_stub_48,0x8,GATE_INTERRUPT,DPL0);
  135.     init_pic();
  136.     load_idt();
  137. }
  138.  
  139. void init_pic(void) {
  140.     outb(0x20, 0x11); // Initialisierungsbefehl fuer den PIC
  141.     outb(0x21, 0x20); // Interruptnummer fuer IRQ 0
  142.     outb(0x21, 0x04); // An IRQ 2 haengt der Slave
  143.     outb(0x21, 0x01); // ICW 4
  144.  
  145.     // Slave-PIC initialisieren
  146.     outb(0xa0, 0x11); // Initialisierungsbefehl fuer den PIC
  147.     outb(0xa1, 0x28); // Interruptnummer fuer IRQ 8
  148.     outb(0xa1, 0x02); // An IRQ 2 haengt der Slave
  149.     outb(0xa1, 0x01); // ICW 4
  150.  
  151.     // Alle IRQs aktivieren (demaskieren)
  152.     outb(0x20, 0x0);
  153.     outb(0xa0, 0x0);
  154. }
Advertisement
Add Comment
Please, Sign In to add comment