irq.c 5.1 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208
  1. #include "irq.h"
  2. // 对进行
  3. #if _INTR_8259A_
  4. #include "../driver/interrupt/8259A/8259A.h"
  5. #else
  6. #include "../driver/interrupt/apic/apic.h"
  7. #endif
  8. #include "../common/asm.h"
  9. #include "../common/printk.h"
  10. #include "gate.h"
  11. // 保存函数调用现场的寄存器
  12. #define SAVE_ALL_REGS \
  13. "cld; \n\t" \
  14. "pushq %rax; \n\t" \
  15. "pushq %rax; \n\t" \
  16. "movq %es, %rax; \n\t" \
  17. "pushq %rax; \n\t" \
  18. "movq %ds, %rax; \n\t" \
  19. "pushq %rax; \n\t" \
  20. "xorq %rax, %rax;\n\t" \
  21. "pushq %rbp; \n\t" \
  22. "pushq %rdi; \n\t" \
  23. "pushq %rsi; \n\t" \
  24. "pushq %rdx; \n\t" \
  25. "pushq %rcx; \n\t" \
  26. "pushq %rbx; \n\t" \
  27. "pushq %r8 ; \n\t" \
  28. "pushq %r9 ; \n\t" \
  29. "pushq %r10; \n\t" \
  30. "pushq %r11; \n\t" \
  31. "pushq %r12; \n\t" \
  32. "pushq %r13; \n\t" \
  33. "pushq %r14; \n\t" \
  34. "pushq %r15; \n\t" \
  35. "movq $0x10, %rdx;\n\t" \
  36. "movq %rdx, %ds; \n\t" \
  37. "movq %rdx, %es; \n\t"
  38. // 定义IRQ处理函数的名字格式:IRQ+中断号+interrupt
  39. #define IRQ_NAME2(name1) name1##interrupt(void)
  40. #define IRQ_NAME(number) IRQ_NAME2(IRQ##number)
  41. // 构造中断entry
  42. // 为了复用返回函数的代码,需要压入一个错误码0
  43. #define Build_IRQ(number) \
  44. void IRQ_NAME(number); \
  45. __asm__(SYMBOL_NAME_STR(IRQ) #number "interrupt: \n\t" \
  46. "pushq $0x00 \n\t" \
  47. SAVE_ALL_REGS \
  48. "movq %rsp, %rdi \n\t" \
  49. "leaq ret_from_intr(%rip), %rax \n\t" \
  50. "pushq %rax \n\t" \
  51. "movq $"#number", %rsi \n\t" \
  52. "jmp do_IRQ \n\t");
  53. // 构造中断入口
  54. Build_IRQ(0x20);
  55. Build_IRQ(0x21);
  56. Build_IRQ(0x22);
  57. Build_IRQ(0x23);
  58. Build_IRQ(0x24);
  59. Build_IRQ(0x25);
  60. Build_IRQ(0x26);
  61. Build_IRQ(0x27);
  62. Build_IRQ(0x28);
  63. Build_IRQ(0x29);
  64. Build_IRQ(0x2a);
  65. Build_IRQ(0x2b);
  66. Build_IRQ(0x2c);
  67. Build_IRQ(0x2d);
  68. Build_IRQ(0x2e);
  69. Build_IRQ(0x2f);
  70. Build_IRQ(0x30);
  71. Build_IRQ(0x31);
  72. Build_IRQ(0x32);
  73. Build_IRQ(0x33);
  74. Build_IRQ(0x34);
  75. Build_IRQ(0x35);
  76. Build_IRQ(0x36);
  77. Build_IRQ(0x37);
  78. // 初始化中断数组
  79. void (*interrupt_table[24])(void) =
  80. {
  81. IRQ0x20interrupt,
  82. IRQ0x21interrupt,
  83. IRQ0x22interrupt,
  84. IRQ0x23interrupt,
  85. IRQ0x24interrupt,
  86. IRQ0x25interrupt,
  87. IRQ0x26interrupt,
  88. IRQ0x27interrupt,
  89. IRQ0x28interrupt,
  90. IRQ0x29interrupt,
  91. IRQ0x2ainterrupt,
  92. IRQ0x2binterrupt,
  93. IRQ0x2cinterrupt,
  94. IRQ0x2dinterrupt,
  95. IRQ0x2einterrupt,
  96. IRQ0x2finterrupt,
  97. IRQ0x30interrupt,
  98. IRQ0x31interrupt,
  99. IRQ0x32interrupt,
  100. IRQ0x33interrupt,
  101. IRQ0x34interrupt,
  102. IRQ0x35interrupt,
  103. IRQ0x36interrupt,
  104. IRQ0x37interrupt,
  105. };
  106. /**
  107. * @brief 声明10个IPI消息处理程序,向量号从200(0xc8)开始
  108. *
  109. */
  110. Build_IRQ(0xc8)
  111. Build_IRQ(0xc9)
  112. Build_IRQ(0xca)
  113. Build_IRQ(0xcb)
  114. Build_IRQ(0xcc)
  115. Build_IRQ(0xcd)
  116. Build_IRQ(0xce)
  117. Build_IRQ(0xcf)
  118. Build_IRQ(0xd0)
  119. Build_IRQ(0xd1)
  120. // 初始化IPI中断服务程序数组
  121. void (*SMP_interrupt_table[SMP_IRQ_NUM])(void) =
  122. {
  123. IRQ0xc8interrupt,
  124. IRQ0xc9interrupt,
  125. IRQ0xcainterrupt,
  126. IRQ0xcbinterrupt,
  127. IRQ0xccinterrupt,
  128. IRQ0xcdinterrupt,
  129. IRQ0xceinterrupt,
  130. IRQ0xcfinterrupt,
  131. IRQ0xd0interrupt,
  132. IRQ0xd1interrupt,
  133. };
  134. /**
  135. * @brief 中断注册函数
  136. *
  137. * @param irq_num 中断向量号
  138. * @param arg 传递给中断安装接口的参数
  139. * @param handler 中断处理函数
  140. * @param paramater 中断处理函数的参数
  141. * @param controller 中断控制器结构
  142. * @param irq_name 中断名
  143. * @return int
  144. */
  145. int irq_register(ul irq_num, void *arg, void (*handler)(ul irq_num, ul parameter, struct pt_regs *regs), ul paramater, hardware_intr_controller *controller, char *irq_name)
  146. {
  147. // 由于为I/O APIC分配的中断向量号是从32开始的,因此要减去32才是对应的interrupt_desc的元素
  148. irq_desc_t *p = &interrupt_desc[irq_num - 32];
  149. p->controller = controller;
  150. p->irq_name = irq_name;
  151. p->parameter = paramater;
  152. p->flags = 0;
  153. p->handler = handler;
  154. p->controller->install(irq_num, arg);
  155. p->controller->enable(irq_num);
  156. return 0;
  157. }
  158. /**
  159. * @brief 中断注销函数
  160. *
  161. * @param irq_num 中断向量号
  162. * @return int
  163. */
  164. int irq_unregister(ul irq_num)
  165. {
  166. irq_desc_t *p = &interrupt_desc[irq_num - 32];
  167. p->controller->disable(irq_num);
  168. p->controller->uninstall(irq_num);
  169. p->controller = NULL;
  170. p->irq_name = NULL;
  171. p->parameter = NULL;
  172. p->flags = 0;
  173. p->handler = NULL;
  174. return 0;
  175. }
  176. /**
  177. * @brief 初始化中断模块
  178. */
  179. void irq_init()
  180. {
  181. #if _INTR_8259A_
  182. init_8259A();
  183. #else
  184. apic_init();
  185. memset(interrupt_desc, 0, sizeof(irq_desc_t) * IRQ_NUM);
  186. #endif
  187. }