trap.c 8.4 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307
  1. #include "trap.h"
  2. #include "gate.h"
  3. #include "../process/ptrace.h"
  4. #include"../common/kprint.h"
  5. void sys_vector_init()
  6. {
  7. set_trap_gate(0, 1, divide_error);
  8. set_trap_gate(1, 1, debug);
  9. set_intr_gate(2, 1, nmi);
  10. set_system_trap_gate(3, 1, int3);
  11. set_system_trap_gate(4, 1, overflow);
  12. set_system_trap_gate(5, 1, bounds);
  13. set_trap_gate(6, 1, undefined_opcode);
  14. set_trap_gate(7, 1, dev_not_avaliable);
  15. set_trap_gate(8, 1, double_fault);
  16. set_trap_gate(9, 1, coprocessor_segment_overrun);
  17. set_trap_gate(10, 1, invalid_TSS);
  18. set_trap_gate(11, 1, segment_not_exists);
  19. set_trap_gate(12, 1, stack_segment_fault);
  20. set_trap_gate(13, 1, general_protection);
  21. set_trap_gate(14, 1, page_fault);
  22. // 中断号15由Intel保留,不能使用
  23. set_trap_gate(16, 1, x87_FPU_error);
  24. set_trap_gate(17, 1, alignment_check);
  25. set_trap_gate(18, 1, machine_check);
  26. set_trap_gate(19, 1, SIMD_exception);
  27. set_trap_gate(20, 1, virtualization_exception);
  28. // 中断号21-31由Intel保留,不能使用
  29. // 32-255为用户自定义中断内部
  30. }
  31. // 0 #DE 除法错误
  32. void do_divide_error(struct pt_regs * regs, unsigned long error_code)
  33. {
  34. kerror("do_divide_error(0),\tError Code:%#18lx,\tRSP:%#18lx,\tRIP:%#18lx\n", error_code, regs->rsp, regs->rip);
  35. while (1)
  36. ;
  37. }
  38. // 1 #DB 调试异常
  39. void do_debug(struct pt_regs * regs, unsigned long error_code)
  40. {
  41. printk("[ ");
  42. printk_color(RED, BLACK, "ERROR / TRAP");
  43. printk(" ] do_debug(1),\tError Code:%#18lx,\tRSP:%#18lx,\tRIP:%#18lx\n", error_code, regs->rsp, regs->rip);
  44. while (1)
  45. ;
  46. }
  47. // 2 不可屏蔽中断
  48. void do_nmi(struct pt_regs * regs, unsigned long error_code)
  49. {
  50. printk("[ ");
  51. printk_color(BLUE, BLACK, "INT");
  52. printk(" ] do_nmi(2),\tError Code:%#18lx,\tRSP:%#18lx,\tRIP:%#18lx\n", error_code, regs->rsp, regs->rip);
  53. while (1)
  54. ;
  55. }
  56. // 3 #BP 断点异常
  57. void do_int3(struct pt_regs * regs, unsigned long error_code)
  58. {
  59. printk("[ ");
  60. printk_color(YELLOW, BLACK, "TRAP");
  61. printk(" ] do_int3(3),\tError Code:%#18lx,\tRSP:%#18lx,\tRIP:%#18lx\n", error_code, regs->rsp, regs->rip);
  62. while (1)
  63. ;
  64. }
  65. // 4 #OF 溢出异常
  66. void do_overflow(struct pt_regs * regs, unsigned long error_code)
  67. {
  68. printk("[ ");
  69. printk_color(YELLOW, BLACK, "TRAP");
  70. printk(" ] do_overflow(4),\tError Code:%#18lx,\tRSP:%#18lx,\tRIP:%#18lx\n", error_code, regs->rsp, regs->rip);
  71. while (1)
  72. ;
  73. }
  74. // 5 #BR 越界异常
  75. void do_bounds(struct pt_regs * regs, unsigned long error_code)
  76. {
  77. kerror("do_bounds(5),\tError Code:%#18lx,\tRSP:%#18lx,\tRIP:%#18lx\n", error_code, regs->rsp, regs->rip);
  78. while (1)
  79. ;
  80. }
  81. // 6 #UD 无效/未定义的机器码
  82. void do_undefined_opcode(struct pt_regs * regs, unsigned long error_code)
  83. {
  84. kerror("do_undefined_opcode(6),\tError Code:%#18lx,\tRSP:%#18lx,\tRIP:%#18lx", error_code, regs->rsp, regs->rip);
  85. while (1)
  86. ;
  87. }
  88. // 7 #NM 设备异常(FPU不存在)
  89. void do_dev_not_avaliable(struct pt_regs * regs, unsigned long error_code)
  90. {
  91. kerror("do_dev_not_avaliable(7),\tError Code:%#18lx,\tRSP:%#18lx,\tRIP:%#18lx\n", error_code, regs->rsp, regs->rip);
  92. while (1)
  93. ;
  94. }
  95. // 8 #DF 双重错误
  96. void do_double_fault(struct pt_regs * regs, unsigned long error_code)
  97. {
  98. printk("[ ");
  99. printk_color(RED, BLACK, "Terminate");
  100. printk(" ] do_double_fault(8),\tError Code:%#18lx,\tRSP:%#18lx,\tRIP:%#18lx\n", error_code, regs->rsp, regs->rip);
  101. while (1)
  102. ;
  103. }
  104. // 9 协处理器越界(保留)
  105. void do_coprocessor_segment_overrun(struct pt_regs * regs, unsigned long error_code)
  106. {
  107. kerror("do_coprocessor_segment_overrun(9),\tError Code:%#18lx,\tRSP:%#18lx,\tRIP:%#18lx\n", error_code, regs->rsp, regs->rip);
  108. while (1)
  109. ;
  110. }
  111. // 10 #TS 无效的TSS段
  112. void do_invalid_TSS(struct pt_regs * regs, unsigned long error_code)
  113. {
  114. printk("[");
  115. printk_color(RED, BLACK, "ERROR");
  116. printk("] do_invalid_TSS(10),\tError Code:%#18lx,\tRSP:%#18lx,\tRIP:%#18lx\n", error_code, regs->rsp, regs->rip);
  117. printk_color(YELLOW, BLACK, "Information:\n");
  118. // 解析错误码
  119. if (error_code & 0x01)
  120. printk("The exception occurred during delivery of an event external to the program.\n");
  121. if (error_code & 0x02)
  122. printk("Refers to a descriptor in the IDT.\n");
  123. else
  124. {
  125. if (error_code & 0x04)
  126. printk("Refers to a descriptor in the current LDT.\n");
  127. else
  128. printk("Refers to a descriptor in the GDT.\n");
  129. }
  130. printk("Segment Selector Index:%10x\n", error_code & 0xfff8);
  131. printk("\n");
  132. while (1)
  133. ;
  134. }
  135. // 11 #NP 段不存在
  136. void do_segment_not_exists(struct pt_regs * regs, unsigned long error_code)
  137. {
  138. kerror("do_segment_not_exists(11),\tError Code:%#18lx,\tRSP:%#18lx,\tRIP:%#18lx\n", error_code, regs->rsp, regs->rip);
  139. while (1)
  140. ;
  141. }
  142. // 12 #SS SS段错误
  143. void do_stack_segment_fault(struct pt_regs * regs, unsigned long error_code)
  144. {
  145. kerror("do_stack_segment_fault(12),\tError Code:%#18lx,\tRSP:%#18lx,\tRIP:%#18lx\n", error_code, regs->rsp, regs->rip);
  146. while (1)
  147. ;
  148. }
  149. // 13 #GP 通用保护性异常
  150. void do_general_protection(struct pt_regs * regs, unsigned long error_code)
  151. {
  152. kerror("do_general_protection(13),\tError Code:%#18lx,\tRSP:%#18lx,\tRIP:%#18lx\n", error_code, regs->rsp, regs->rip);
  153. if(error_code & 0x01)
  154. printk_color(RED,BLACK,"The exception occurred during delivery of an event external to the program,such as an interrupt or an earlier exception.\n");
  155. if(error_code & 0x02)
  156. printk_color(RED,BLACK,"Refers to a gate descriptor in the IDT;\n");
  157. else
  158. printk_color(RED,BLACK,"Refers to a descriptor in the GDT or the current LDT;\n");
  159. if((error_code & 0x02) == 0)
  160. if(error_code & 0x04)
  161. printk_color(RED,BLACK,"Refers to a segment or gate descriptor in the LDT;\n");
  162. else
  163. printk_color(RED,BLACK,"Refers to a descriptor in the current GDT;\n");
  164. printk_color(RED,BLACK,"Segment Selector Index:%#010x\n",error_code & 0xfff8);
  165. while (1)
  166. ;
  167. }
  168. // 14 #PF 页故障
  169. void do_page_fault(struct pt_regs * regs, unsigned long error_code)
  170. {
  171. unsigned long cr2 = 0;
  172. // 先保存cr2寄存器的值,避免由于再次触发页故障而丢失值
  173. // cr2存储着触发异常的线性地址
  174. __asm__ __volatile__("movq %%cr2, %0"
  175. : "=r"(cr2)::"memory");
  176. kerror("do_page_fault(14),\tError Code:%#18lx,\tRSP:%#18lx,\tRIP:%#18lx\tCR2:%#18lx\n", error_code, regs->rsp, regs->rip, cr2);
  177. printk_color(YELLOW, BLACK, "Information:\n");
  178. if (!(error_code & 0x01))
  179. printk("Page does not exist.\n");
  180. if (error_code & 0x02)
  181. printk("Fault occurred during operation: writing\n");
  182. else
  183. printk("Fault occurred during operation: reading\n");
  184. if (error_code & 0x04)
  185. printk("Fault in user level(3).\n");
  186. else
  187. printk("Fault in supervisor level(0,1,2).\n");
  188. if (error_code & 0x08)
  189. printk("Reserved bit caused the fault.\n");
  190. if (error_code & 0x10)
  191. printk("Fault occurred during fetching instruction.\n");
  192. while (1)
  193. ;
  194. }
  195. // 15 Intel保留,请勿使用
  196. // 16 #MF x87FPU错误
  197. void do_x87_FPU_error(struct pt_regs * regs, unsigned long error_code)
  198. {
  199. kerror("do_x87_FPU_error(16),\tError Code:%#18lx,\tRSP:%#18lx,\tRIP:%#18lx\n", error_code, regs->rsp, regs->rip);
  200. while (1)
  201. ;
  202. }
  203. // 17 #AC 对齐检测
  204. void do_alignment_check(struct pt_regs * regs, unsigned long error_code)
  205. {
  206. kerror("do_alignment_check(17),\tError Code:%#18lx,\tRSP:%#18lx,\tRIP:%#18lx\n", error_code, regs->rsp, regs->rip);
  207. while (1)
  208. ;
  209. }
  210. // 18 #MC 机器检测
  211. void do_machine_check(struct pt_regs * regs, unsigned long error_code)
  212. {
  213. kerror("do_machine_check(18),\tError Code:%#18lx,\tRSP:%#18lx,\tRIP:%#18lx\n", error_code, regs->rsp, regs->rip);
  214. while (1)
  215. ;
  216. }
  217. // 19 #XM SIMD浮点异常
  218. void do_SIMD_exception(struct pt_regs * regs, unsigned long error_code)
  219. {
  220. kerror("do_SIMD_exception(19),\tError Code:%#18lx,\tRSP:%#18lx,\tRIP:%#18lx\n", error_code, regs->rsp, regs->rip);
  221. while (1)
  222. ;
  223. }
  224. // 20 #VE 虚拟化异常
  225. void do_virtualization_exception(struct pt_regs * regs, unsigned long error_code)
  226. {
  227. kerror("do_virtualization_exception(20),\tError Code:%#18lx,\tRSP:%#18lx,\tRIP:%#18lx\n", error_code, regs->rsp, regs->rip);
  228. while (1)
  229. ;
  230. }
  231. // 21-21 Intel保留,请勿使用