trap.c 9.8 KB

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