trap.c 9.3 KB

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