Advertisement
Guest User

Untitled

a guest
Jun 24th, 2017
156
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
text 3.27 KB | None | 0 0
  1. #include <stdint.h>
  2. #include <stddef.h>
  3. #include "system.h"
  4.  
  5. typedef struct {
  6. uint16_t base_low;
  7. uint16_t selector;
  8. uint8_t always0;
  9. uint8_t access_bits;
  10. uint16_t base_high;
  11. } __attribute__((packed)) IDT_Entry;
  12.  
  13. typedef struct {
  14. uint16_t limit;
  15. uint32_t base;
  16. } __attribute__((packed)) IDT_Pointer;
  17.  
  18. typedef struct {
  19. uint32_t gs, fs, es, ds;
  20. uint32_t edi, esi, ebp, esp, ebx, edx, ecx, eax;
  21. uint32_t int_no, err_code;
  22. uint32_t eip, cs, eflags, useresp, ss;
  23. } Registers;
  24.  
  25. IDT_Entry idt[256] = { 0 };
  26. IDT_Pointer idtp;
  27.  
  28. extern void flush_idt();
  29. extern void isr0();
  30. extern void isr1();
  31. extern void isr2();
  32. extern void isr3();
  33. extern void isr4();
  34. extern void isr5();
  35. extern void isr6();
  36. extern void isr7();
  37. extern void isr8();
  38. extern void isr9();
  39. extern void isr10();
  40. extern void isr11();
  41. extern void isr12();
  42. extern void isr13();
  43. extern void isr14();
  44. extern void isr15();
  45. extern void isr16();
  46. extern void isr17();
  47. extern void isr18();
  48. extern void isr19();
  49. extern void isr20();
  50. extern void isr21();
  51. extern void isr22();
  52. extern void isr23();
  53. extern void isr24();
  54. extern void isr25();
  55. extern void isr26();
  56. extern void isr27();
  57. extern void isr28();
  58. extern void isr29();
  59. extern void isr30();
  60. extern void isr31();
  61.  
  62. void isrs_handler(Registers *reg) {
  63. puts("EXCEPTION ");
  64. putc(reg->int_no + '0');
  65. for (;;);
  66. }
  67.  
  68. void set_idt_gate(size_t num, uint32_t base, uint16_t selector, uint8_t access_bits) {
  69. idt[num].base_low = base & 0xFFFF;
  70. idt[num].base_high = base >> 16 & 0xFFFF;
  71. idt[num].selector = selector;
  72. idt[num].access_bits = access_bits;
  73. idt[num].always0 = 0;
  74. }
  75.  
  76. void install_idt() {
  77. idtp.base = (uint32_t) &idt;
  78. idtp.limit = sizeof(idt) - 1;
  79.  
  80. set_idt_gate(0, (uint32_t) isr0, 0x08, 0x8E);
  81. set_idt_gate(1, (uint32_t) isr1, 0x08, 0x8E); // comment
  82. set_idt_gate(2, (uint32_t) isr2, 0x08, 0x8E);
  83. set_idt_gate(3, (uint32_t) isr3, 0x08, 0x8E);
  84. set_idt_gate(4, (uint32_t) isr4, 0x08, 0x8E);
  85. set_idt_gate(5, (uint32_t) isr5, 0x08, 0x8E);
  86. set_idt_gate(6, (uint32_t) isr6, 0x08, 0x8E);
  87. set_idt_gate(7, (uint32_t) isr7, 0x08, 0x8E);
  88. set_idt_gate(8, (uint32_t) isr8, 0x08, 0x8E);
  89. set_idt_gate(9, (uint32_t) isr9, 0x08, 0x8E);
  90. set_idt_gate(10, (uint32_t) isr10, 0x08, 0x8E);
  91. set_idt_gate(11, (uint32_t) isr11, 0x08, 0x8E);
  92. set_idt_gate(12, (uint32_t) isr12, 0x08, 0x8E);
  93. set_idt_gate(13, (uint32_t) isr13, 0x08, 0x8E);
  94. set_idt_gate(14, (uint32_t) isr14, 0x08, 0x8E);
  95. set_idt_gate(15, (uint32_t) isr15, 0x08, 0x8E);
  96. set_idt_gate(16, (uint32_t) isr16, 0x08, 0x8E);
  97. set_idt_gate(17, (uint32_t) isr17, 0x08, 0x8E);
  98. set_idt_gate(18, (uint32_t) isr18, 0x08, 0x8E);
  99. set_idt_gate(19, (uint32_t) isr19, 0x08, 0x8E);
  100. set_idt_gate(20, (uint32_t) isr20, 0x08, 0x8E);
  101. set_idt_gate(21, (uint32_t) isr21, 0x08, 0x8E);
  102. set_idt_gate(22, (uint32_t) isr22, 0x08, 0x8E);
  103. set_idt_gate(23, (uint32_t) isr23, 0x08, 0x8E);
  104. set_idt_gate(24, (uint32_t) isr24, 0x08, 0x8E);
  105. set_idt_gate(25, (uint32_t) isr25, 0x08, 0x8E);
  106. set_idt_gate(26, (uint32_t) isr26, 0x08, 0x8E);
  107. set_idt_gate(27, (uint32_t) isr27, 0x08, 0x8E);
  108. set_idt_gate(28, (uint32_t) isr28, 0x08, 0x8E);
  109. set_idt_gate(29, (uint32_t) isr29, 0x08, 0x8E);
  110. set_idt_gate(30, (uint32_t) isr30, 0x08, 0x8E);
  111. set_idt_gate(31, (uint32_t) isr31, 0x08, 0x8E);
  112.  
  113. flush_idt();
  114. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement