irq.c 5.4 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219
  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. #include <mm/slab.h>
  12. // 保存函数调用现场的寄存器
  13. #define SAVE_ALL_REGS \
  14. "cld; \n\t" \
  15. "pushq %rax; \n\t" \
  16. "pushq %rax; \n\t" \
  17. "movq %es, %rax; \n\t" \
  18. "pushq %rax; \n\t" \
  19. "movq %ds, %rax; \n\t" \
  20. "pushq %rax; \n\t" \
  21. "xorq %rax, %rax;\n\t" \
  22. "pushq %rbp; \n\t" \
  23. "pushq %rdi; \n\t" \
  24. "pushq %rsi; \n\t" \
  25. "pushq %rdx; \n\t" \
  26. "pushq %rcx; \n\t" \
  27. "pushq %rbx; \n\t" \
  28. "pushq %r8 ; \n\t" \
  29. "pushq %r9 ; \n\t" \
  30. "pushq %r10; \n\t" \
  31. "pushq %r11; \n\t" \
  32. "pushq %r12; \n\t" \
  33. "pushq %r13; \n\t" \
  34. "pushq %r14; \n\t" \
  35. "pushq %r15; \n\t" \
  36. "movq $0x10, %rdx;\n\t" \
  37. "movq %rdx, %ds; \n\t" \
  38. "movq %rdx, %es; \n\t"
  39. // 定义IRQ处理函数的名字格式:IRQ+中断号+interrupt
  40. #define IRQ_NAME2(name1) name1##interrupt(void)
  41. #define IRQ_NAME(number) IRQ_NAME2(IRQ##number)
  42. // 构造中断entry
  43. // 为了复用返回函数的代码,需要压入一个错误码0
  44. #define Build_IRQ(number) \
  45. void IRQ_NAME(number); \
  46. __asm__(SYMBOL_NAME_STR(IRQ) #number "interrupt: \n\t" \
  47. "pushq $0x00 \n\t" 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. /*
  111. */
  112. Build_IRQ(0xc8);
  113. Build_IRQ(0xc9);
  114. Build_IRQ(0xca);
  115. Build_IRQ(0xcb);
  116. Build_IRQ(0xcc);
  117. Build_IRQ(0xcd);
  118. Build_IRQ(0xce);
  119. Build_IRQ(0xcf);
  120. Build_IRQ(0xd0);
  121. Build_IRQ(0xd1);
  122. Build_IRQ(0x80); // 系统调用入口
  123. void (*syscall_intr_table[1])(void) = {IRQ0x80interrupt};
  124. // 初始化IPI中断服务程序数组
  125. void (*SMP_interrupt_table[SMP_IRQ_NUM])(void) =
  126. {
  127. IRQ0xc8interrupt,
  128. IRQ0xc9interrupt,
  129. IRQ0xcainterrupt,
  130. IRQ0xcbinterrupt,
  131. IRQ0xccinterrupt,
  132. IRQ0xcdinterrupt,
  133. IRQ0xceinterrupt,
  134. IRQ0xcfinterrupt,
  135. IRQ0xd0interrupt,
  136. IRQ0xd1interrupt,
  137. };
  138. /**
  139. * @brief 中断注册函数
  140. *
  141. * @param irq_num 中断向量号
  142. * @param arg 传递给中断安装接口的参数
  143. * @param handler 中断处理函数
  144. * @param paramater 中断处理函数的参数
  145. * @param controller 中断控制器结构
  146. * @param irq_name 中断名
  147. * @return int
  148. */
  149. 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)
  150. {
  151. // 由于为I/O APIC分配的中断向量号是从32开始的,因此要减去32才是对应的interrupt_desc的元素
  152. irq_desc_t *p = &interrupt_desc[irq_num - 32];
  153. p->controller = controller;
  154. int namelen = sizeof(strlen(irq_name)+1);
  155. p->irq_name = (char *)kmalloc(namelen,0);
  156. memset(p->irq_name, 0, namelen);
  157. strncpy(p->irq_name, irq_name, namelen);
  158. p->parameter = paramater;
  159. p->flags = 0;
  160. p->handler = handler;
  161. p->controller->install(irq_num, arg);
  162. p->controller->enable(irq_num);
  163. return 0;
  164. }
  165. /**
  166. * @brief 中断注销函数
  167. *
  168. * @param irq_num 中断向量号
  169. * @return int
  170. */
  171. int irq_unregister(ul irq_num)
  172. {
  173. irq_desc_t *p = &interrupt_desc[irq_num - 32];
  174. p->controller->disable(irq_num);
  175. p->controller->uninstall(irq_num);
  176. p->controller = NULL;
  177. kfree(p->irq_name);
  178. p->irq_name = NULL;
  179. p->parameter = NULL;
  180. p->flags = 0;
  181. p->handler = NULL;
  182. return 0;
  183. }
  184. /**
  185. * @brief 初始化中断模块
  186. */
  187. void irq_init()
  188. {
  189. #if _INTR_8259A_
  190. init_8259A();
  191. #else
  192. memset((void *)interrupt_desc, 0, sizeof(irq_desc_t) * IRQ_NUM);
  193. apic_init();
  194. #endif
  195. }