Guest User

Untitled

a guest
May 14th, 2015
216
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
C 7.63 KB | None | 0 0
  1. #include "stdint.h"
  2. #include "intr.h"
  3. #include "console.h"
  4.  
  5. extern void intr_stub_0();
  6. extern void intr_stub_1();
  7. extern void intr_stub_2();
  8. extern void intr_stub_3();
  9. extern void intr_stub_4();
  10. extern void intr_stub_5();
  11. extern void intr_stub_6();
  12. extern void intr_stub_7();
  13. extern void intr_stub_8();
  14. extern void intr_stub_9();
  15. extern void intr_stub_10();
  16. extern void intr_stub_11();
  17. extern void intr_stub_12();
  18. extern void intr_stub_13();
  19. extern void intr_stub_14();
  20. extern void intr_stub_15();
  21. extern void intr_stub_16();
  22. extern void intr_stub_17();
  23. extern void intr_stub_18();
  24.  
  25. extern void intr_stub_32();
  26. extern void intr_stub_33();
  27. /*extern void intr_stub_34();
  28. extern void intr_stub_35();
  29. extern void intr_stub_36();
  30. extern void intr_stub_37();
  31. extern void intr_stub_38();
  32. extern void intr_stub_39();
  33. extern void intr_stub_40();
  34. extern void intr_stub_41();
  35. extern void intr_stub_42();
  36. extern void intr_stub_43();
  37. extern void intr_stub_44();
  38. extern void intr_stub_45();
  39. extern void intr_stub_46();
  40. extern void intr_stub_47();*/
  41.  
  42. extern void intr_stub_48();
  43.  
  44. #define GDT_FLAG_DATASEG 0x02
  45. #define GDT_FLAG_CODESEG 0x0a
  46. #define GDT_FLAG_TSS 0x09
  47.  
  48. #define GDT_FLAG_SEGMENT 0x10
  49. #define GDT_FLAG_RING0 0x00
  50. #define GDT_FLAG_RING3 0x60
  51. #define GDT_FLAG_PRESENT 0x80
  52.  
  53. #define GDT_FLAG_4K 0x800
  54. #define GDT_FLAG_32_BIT 0x400
  55.  
  56. #define GDT_ENTRIES 5
  57. static uint64_t gdt[GDT_ENTRIES];
  58.  
  59. #define IDT_ENTRIES 256
  60. static long long unsigned int idt[IDT_ENTRIES];
  61.  
  62. static void gdt_set_entry(int i, unsigned int base, unsigned int limit, int flags) {
  63.     gdt[i] = limit & 0xffffLL;
  64.     gdt[i] |= (base & 0xffffffLL) << 16;
  65.     gdt[i] |= (flags & 0xffLL) << 40;
  66.     gdt[i] |= ((limit >> 16) & 0xfLL) << 48;
  67.     gdt[i] |= ((flags >> 8) & 0xffLL) << 52;
  68.     gdt[i] |= ((base >> 24) & 0xffLL) << 56;
  69. }
  70.  
  71. void init_gdt() {
  72.     struct {
  73.         uint16_t limit;
  74.         void* pointer;
  75.     } __attribute__((packed)) gdtp = {
  76.         .limit = GDT_ENTRIES * 8 - 1,
  77.         .pointer = gdt,
  78.     };
  79.  
  80.     gdt_set_entry(0, 0, 0, 0);
  81.     gdt_set_entry(1, 0, 0xfffff, GDT_FLAG_SEGMENT | GDT_FLAG_32_BIT | GDT_FLAG_CODESEG | GDT_FLAG_4K | GDT_FLAG_PRESENT);
  82.     gdt_set_entry(2, 0, 0xfffff, GDT_FLAG_SEGMENT | GDT_FLAG_32_BIT | GDT_FLAG_DATASEG | GDT_FLAG_4K | GDT_FLAG_PRESENT);
  83.     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);
  84.     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);
  85.  
  86.     asm volatile("lgdt %0" : : "m" (gdtp));
  87.  
  88.     asm volatile(
  89.         "mov $0x10, %ax;"
  90.         "mov %ax, %ds;"
  91.         "mov %ax, %es;"
  92.         "mov %ax, %ss;"
  93.         "ljmp $0x8, $.1;"
  94.         ".1:"
  95.     );
  96. }
  97.  
  98. #define IDT_FLAG_INTERRUPT_GATE 0xe
  99. #define IDT_FLAG_PRESENT 0x80
  100. #define IDT_FLAG_RING0 0x00
  101. #define IDT_FLAG_RING3 0x60
  102.  
  103. static void idt_set_entry(int i, void (*fn)(), unsigned int selector, int flags) {
  104.     unsigned long int handler = (unsigned long int) fn;
  105.     idt[i] = handler & 0xffffLL;
  106.     idt[i] |= (selector & 0xffffLL) << 16;
  107.     idt[i] |= (flags & 0xffLL) << 40;
  108.     idt[i] |= ((handler >> 16) & 0xffffLL) << 48;
  109. }
  110.  
  111. static inline void outb(uint16_t port, uint8_t data) {
  112.     asm volatile("outb %0, %1" : : "a" (data), "Nd" (port));
  113. }
  114.  
  115. void init_pic() {
  116.     outb(0x20, 0x11);
  117.     outb(0x21, 0x20);
  118.     outb(0x21, 0x04);
  119.     outb(0x21, 0x01);
  120.  
  121.     outb(0xa0, 0x11);
  122.     outb(0xa1, 0x28);
  123.     outb(0xa1, 0x02);
  124.     outb(0xa1, 0x01);
  125.  
  126.     outb(0x20, 0x0);
  127.     outb(0xa0, 0x0);
  128. }
  129.  
  130. void init_intr() {
  131.     struct {
  132.         unsigned short int limit;
  133.         void* pointer;
  134.     } __attribute__((packed)) idtp = {
  135.         .limit = IDT_ENTRIES * 8 - 1,
  136.         .pointer = idt,
  137.     };
  138.  
  139.     init_pic();
  140.  
  141.     idt_set_entry(0, intr_stub_0, 0x8, IDT_FLAG_INTERRUPT_GATE | IDT_FLAG_RING0 | IDT_FLAG_PRESENT);
  142.     idt_set_entry(1, intr_stub_1, 0x8, IDT_FLAG_INTERRUPT_GATE | IDT_FLAG_RING0 | IDT_FLAG_PRESENT);
  143.     idt_set_entry(2, intr_stub_2, 0x8, IDT_FLAG_INTERRUPT_GATE | IDT_FLAG_RING0 | IDT_FLAG_PRESENT);
  144.     idt_set_entry(3, intr_stub_3, 0x8, IDT_FLAG_INTERRUPT_GATE | IDT_FLAG_RING0 | IDT_FLAG_PRESENT);
  145.     idt_set_entry(4, intr_stub_4, 0x8, IDT_FLAG_INTERRUPT_GATE | IDT_FLAG_RING0 | IDT_FLAG_PRESENT);
  146.     idt_set_entry(5, intr_stub_5, 0x8, IDT_FLAG_INTERRUPT_GATE | IDT_FLAG_RING0 | IDT_FLAG_PRESENT);
  147.     idt_set_entry(6, intr_stub_6, 0x8, IDT_FLAG_INTERRUPT_GATE | IDT_FLAG_RING0 | IDT_FLAG_PRESENT);
  148.     idt_set_entry(7, intr_stub_7, 0x8, IDT_FLAG_INTERRUPT_GATE | IDT_FLAG_RING0 | IDT_FLAG_PRESENT);
  149.     idt_set_entry(8, intr_stub_8, 0x8, IDT_FLAG_INTERRUPT_GATE | IDT_FLAG_RING0 | IDT_FLAG_PRESENT);
  150.     idt_set_entry(9, intr_stub_9, 0x8, IDT_FLAG_INTERRUPT_GATE | IDT_FLAG_RING0 | IDT_FLAG_PRESENT);
  151.     idt_set_entry(10, intr_stub_10, 0x8, IDT_FLAG_INTERRUPT_GATE | IDT_FLAG_RING0 | IDT_FLAG_PRESENT);
  152.     idt_set_entry(11, intr_stub_11, 0x8, IDT_FLAG_INTERRUPT_GATE | IDT_FLAG_RING0 | IDT_FLAG_PRESENT);
  153.     idt_set_entry(12, intr_stub_12, 0x8, IDT_FLAG_INTERRUPT_GATE | IDT_FLAG_RING0 | IDT_FLAG_PRESENT);
  154.     idt_set_entry(13, intr_stub_13, 0x8, IDT_FLAG_INTERRUPT_GATE | IDT_FLAG_RING0 | IDT_FLAG_PRESENT);
  155.     idt_set_entry(14, intr_stub_14, 0x8, IDT_FLAG_INTERRUPT_GATE | IDT_FLAG_RING0 | IDT_FLAG_PRESENT);
  156.     idt_set_entry(15, intr_stub_15, 0x8, IDT_FLAG_INTERRUPT_GATE | IDT_FLAG_RING0 | IDT_FLAG_PRESENT);
  157.     idt_set_entry(16, intr_stub_16, 0x8, IDT_FLAG_INTERRUPT_GATE | IDT_FLAG_RING0 | IDT_FLAG_PRESENT);
  158.     idt_set_entry(17, intr_stub_17, 0x8, IDT_FLAG_INTERRUPT_GATE | IDT_FLAG_RING0 | IDT_FLAG_PRESENT);
  159.     idt_set_entry(18, intr_stub_18, 0x8, IDT_FLAG_INTERRUPT_GATE | IDT_FLAG_RING0 | IDT_FLAG_PRESENT);
  160.  
  161.     idt_set_entry(32, intr_stub_32, 0x8, IDT_FLAG_INTERRUPT_GATE | IDT_FLAG_RING0 | IDT_FLAG_PRESENT);
  162.     idt_set_entry(33, intr_stub_33, 0x8, IDT_FLAG_INTERRUPT_GATE | IDT_FLAG_RING0 | IDT_FLAG_PRESENT);
  163.     /*idt_set_entry(34, intr_stub_34, 0x8, IDT_FLAG_INTERRUPT_GATE | IDT_FLAG_RING0 | IDT_FLAG_PRESENT);
  164.     idt_set_entry(35, intr_stub_35, 0x8, IDT_FLAG_INTERRUPT_GATE | IDT_FLAG_RING0 | IDT_FLAG_PRESENT);
  165.     idt_set_entry(36, intr_stub_36, 0x8, IDT_FLAG_INTERRUPT_GATE | IDT_FLAG_RING0 | IDT_FLAG_PRESENT);
  166.     idt_set_entry(37, intr_stub_37, 0x8, IDT_FLAG_INTERRUPT_GATE | IDT_FLAG_RING0 | IDT_FLAG_PRESENT);
  167.     idt_set_entry(38, intr_stub_38, 0x8, IDT_FLAG_INTERRUPT_GATE | IDT_FLAG_RING0 | IDT_FLAG_PRESENT);
  168.     idt_set_entry(39, intr_stub_39, 0x8, IDT_FLAG_INTERRUPT_GATE | IDT_FLAG_RING0 | IDT_FLAG_PRESENT);
  169.     idt_set_entry(40, intr_stub_40, 0x8, IDT_FLAG_INTERRUPT_GATE | IDT_FLAG_RING0 | IDT_FLAG_PRESENT);
  170.     idt_set_entry(41, intr_stub_41, 0x8, IDT_FLAG_INTERRUPT_GATE | IDT_FLAG_RING0 | IDT_FLAG_PRESENT);
  171.     idt_set_entry(42, intr_stub_42, 0x8, IDT_FLAG_INTERRUPT_GATE | IDT_FLAG_RING0 | IDT_FLAG_PRESENT);
  172.     idt_set_entry(43, intr_stub_43, 0x8, IDT_FLAG_INTERRUPT_GATE | IDT_FLAG_RING0 | IDT_FLAG_PRESENT);
  173.     idt_set_entry(44, intr_stub_44, 0x8, IDT_FLAG_INTERRUPT_GATE | IDT_FLAG_RING0 | IDT_FLAG_PRESENT);
  174.     idt_set_entry(45, intr_stub_45, 0x8, IDT_FLAG_INTERRUPT_GATE | IDT_FLAG_RING0 | IDT_FLAG_PRESENT);
  175.     idt_set_entry(46, intr_stub_46, 0x8, IDT_FLAG_INTERRUPT_GATE | IDT_FLAG_RING0 | IDT_FLAG_PRESENT);
  176.     idt_set_entry(47, intr_stub_47, 0x8, IDT_FLAG_INTERRUPT_GATE | IDT_FLAG_RING0 | IDT_FLAG_PRESENT);*/
  177.  
  178.     idt_set_entry(48, intr_stub_48, 0x8, IDT_FLAG_INTERRUPT_GATE | IDT_FLAG_RING3 | IDT_FLAG_PRESENT);
  179.  
  180.     asm volatile("lidt %0" : : "m" (idtp));
  181.  
  182.     asm volatile("sti");
  183. }
  184.  
  185. void handle_interrupt(struct cpu_state* cpu) {
  186.     kprintf("ff");
  187.     if(cpu->intr <= 0x1f) {
  188.         kprintf("Exception %d, kernel halted!\n", cpu->intr);
  189.  
  190.         while(1) {
  191.             asm volatile("cli; hlt;");
  192.         }
  193.     } else if(cpu->intr >= 0x20 && cpu->intr <= 0x2f) {
  194.         if(cpu->intr >= 0x28) {
  195.             outb(0xa0, 0x20);
  196.         }
  197.         outb(0x20, 0x20);
  198.     } else {
  199.         kprintf("Unknown interrupt");
  200.         while(1) {
  201.             asm volatile("cli; hlt;");
  202.         }
  203.     }
  204. }
Advertisement
Add Comment
Please, Sign In to add comment