gate.h 3.4 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129
  1. /**
  2. * @file gate.h
  3. * @author longjin
  4. * @brief 门定义
  5. * @date 2022-01-24
  6. *
  7. */
  8. #pragma once
  9. //描述符表的结构体
  10. struct desc_struct
  11. {
  12. unsigned char x[8];
  13. };
  14. //门的结构体
  15. struct gate_struct
  16. {
  17. unsigned char x[16];
  18. };
  19. extern struct desc_struct GDT_Table[]; // GDT_Table是head.S中的GDT_Table
  20. extern struct gate_struct IDT_Table[]; // IDT_Table是head.S中的IDT_Table
  21. extern unsigned int TSS64_Table[26];
  22. /**
  23. * @brief 初始化中段描述符表内的门描述符(每个16B)
  24. * @param gate_selector_addr IDT表项的地址
  25. * @param attr P、DPL、TYPE的属性
  26. * @param ist 中断栈表号
  27. * @param code_addr 指向中断服务程序的指针的地址
  28. */
  29. void set_gate(ul *gate_selector_addr, ul attr, unsigned char ist, ul *code_addr)
  30. {
  31. ul __d0 = 0, __d1 = 0;
  32. ul tmp_code_addr = *code_addr;
  33. __d0 = attr << 40; //设置P、DPL、Type
  34. __d0 |= ((ul)(ist) << 32); // 设置ist
  35. __d0 |= 8 << 16; //设置段选择子为0x1000
  36. __d0 |= (0xffff & tmp_code_addr); //设置段内偏移的[15:00]
  37. tmp_code_addr >>= 16;
  38. __d0 |= (0xffff & tmp_code_addr) << 48; // 设置段内偏移[31:16]
  39. tmp_code_addr >>= 16;
  40. __d1 = (0xffffffff & tmp_code_addr); //设置段内偏移[63:32]
  41. *gate_selector_addr = __d0;
  42. *(gate_selector_addr + 1) = __d1;
  43. }
  44. void set_tss_descriptor(unsigned int n, void *addr)
  45. {
  46. *(unsigned long *)(GDT_Table + n) = (103UL & 0xffff) | (((unsigned long)addr & 0xffff) << 16) | (((unsigned long)addr >> 16 & 0xff) << 32) | ((unsigned long)0x89 << 40) | ((103UL >> 16 & 0xf) << 48) | (((unsigned long)addr >> 24 & 0xff) << 56); /////89 is attribute
  47. *(unsigned long *)(GDT_Table + n + 1) = ((unsigned long)addr >> 32 & 0xffffffff) | 0;
  48. }
  49. /**
  50. * @brief 加载任务状态段寄存器
  51. * @param n TSS基地址在GDT中的第几项
  52. * 左移3位的原因是GDT每项占8字节
  53. */
  54. #define load_TR(n) \
  55. do \
  56. { \
  57. __asm__ __volatile__("ltr %%ax" ::"a"((n)<< 3)); \
  58. } while (0)
  59. /**
  60. * @brief 设置中断门
  61. *
  62. * @param n 中断号
  63. * @param ist ist
  64. * @param addr 服务程序的地址
  65. */
  66. void set_intr_gate(unsigned int n, unsigned char ist, void *addr)
  67. {
  68. set_gate((ul *)(IDT_Table + n), 0x8E, ist, (ul *)(&addr)); // p=1,DPL=0, type=E
  69. }
  70. /**
  71. * @brief 设置64位,DPL=0的陷阱门
  72. *
  73. * @param n 中断号
  74. * @param ist ist
  75. * @param addr 服务程序的地址
  76. */
  77. void set_trap_gate(unsigned int n, unsigned char ist, void *addr)
  78. {
  79. set_gate((ul *)(IDT_Table + n), 0x8F, ist, (ul *)(&addr)); // p=1,DPL=0, type=F
  80. }
  81. /**
  82. * @brief 设置64位,DPL=3的陷阱门
  83. *
  84. * @param n 中断号
  85. * @param ist ist
  86. * @param addr 服务程序的地址
  87. */
  88. void set_system_trap_gate(unsigned int n, unsigned char ist, void *addr)
  89. {
  90. set_gate((ul *)(IDT_Table + n), 0xEF, ist, (ul *)(&addr)); // p=1,DPL=3, type=F
  91. }
  92. /**
  93. * @brief 初始化TSS表的内容
  94. *
  95. */
  96. void set_TSS64(ul rsp0, ul rsp1, ul rsp2, ul ist1, ul ist2, ul ist3, ul ist4, ul ist5, ul ist6, ul ist7)
  97. {
  98. *(ul *)(TSS64_Table + 1) = rsp0;
  99. *(ul *)(TSS64_Table + 3) = rsp1;
  100. *(ul *)(TSS64_Table + 5) = rsp2;
  101. *(ul *)(TSS64_Table + 9) = ist1;
  102. *(ul *)(TSS64_Table + 11) = ist2;
  103. *(ul *)(TSS64_Table + 13) = ist3;
  104. *(ul *)(TSS64_Table + 15) = ist4;
  105. *(ul *)(TSS64_Table + 17) = ist5;
  106. *(ul *)(TSS64_Table + 19) = ist6;
  107. *(ul *)(TSS64_Table + 21) = ist7;
  108. }