irq.c 4.5 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175
  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" SAVE_ALL_REGS \
  47. "movq %rsp, %rdi\n\t" \
  48. "leaq ret_from_intr(%rip), %rax\n\t" \
  49. "pushq %rax \n\t" \
  50. "movq $" #number ", %rsi \n\t" \
  51. "jmp do_IRQ\n\t");
  52. // 构造中断入口
  53. Build_IRQ(0x20);
  54. Build_IRQ(0x21);
  55. Build_IRQ(0x22);
  56. Build_IRQ(0x23);
  57. Build_IRQ(0x24);
  58. Build_IRQ(0x25);
  59. Build_IRQ(0x26);
  60. Build_IRQ(0x27);
  61. Build_IRQ(0x28);
  62. Build_IRQ(0x29);
  63. Build_IRQ(0x2a);
  64. Build_IRQ(0x2b);
  65. Build_IRQ(0x2c);
  66. Build_IRQ(0x2d);
  67. Build_IRQ(0x2e);
  68. Build_IRQ(0x2f);
  69. Build_IRQ(0x30);
  70. Build_IRQ(0x31);
  71. Build_IRQ(0x32);
  72. Build_IRQ(0x33);
  73. Build_IRQ(0x34);
  74. Build_IRQ(0x35);
  75. Build_IRQ(0x36);
  76. Build_IRQ(0x37);
  77. // 初始化中断数组
  78. void (*interrupt_table[24])(void) =
  79. {
  80. IRQ0x20interrupt,
  81. IRQ0x21interrupt,
  82. IRQ0x22interrupt,
  83. IRQ0x23interrupt,
  84. IRQ0x24interrupt,
  85. IRQ0x25interrupt,
  86. IRQ0x26interrupt,
  87. IRQ0x27interrupt,
  88. IRQ0x28interrupt,
  89. IRQ0x29interrupt,
  90. IRQ0x2ainterrupt,
  91. IRQ0x2binterrupt,
  92. IRQ0x2cinterrupt,
  93. IRQ0x2dinterrupt,
  94. IRQ0x2einterrupt,
  95. IRQ0x2finterrupt,
  96. IRQ0x30interrupt,
  97. IRQ0x31interrupt,
  98. IRQ0x32interrupt,
  99. IRQ0x33interrupt,
  100. IRQ0x34interrupt,
  101. IRQ0x35interrupt,
  102. IRQ0x36interrupt,
  103. IRQ0x37interrupt,
  104. };
  105. /**
  106. * @brief 中断注册函数
  107. *
  108. * @param irq_num 中断向量号
  109. * @param arg 传递给中断安装接口的参数
  110. * @param handler 中断处理函数
  111. * @param paramater 中断处理函数的参数
  112. * @param controller 中断控制器结构
  113. * @param irq_name 中断名
  114. * @return int
  115. */
  116. 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)
  117. {
  118. // 由于为I/O APIC分配的中断向量号是从32开始的,因此要减去32才是对应的interrupt_desc的元素
  119. irq_desc_t *p = &interrupt_desc[irq_num - 32];
  120. p->controller = controller;
  121. p->irq_name = irq_name;
  122. p->parameter = paramater;
  123. p->flags = 0;
  124. p->handler = handler;
  125. p->controller->install(irq_num, arg);
  126. p->controller->enable(irq_num);
  127. return 0;
  128. }
  129. /**
  130. * @brief 中断注销函数
  131. *
  132. * @param irq_num 中断向量号
  133. * @return int
  134. */
  135. int irq_unregister(ul irq_num)
  136. {
  137. irq_desc_t *p = &interrupt_desc[irq_num - 32];
  138. p->controller->disable(irq_num);
  139. p->controller->uninstall(irq_num);
  140. p->controller = NULL;
  141. p->irq_name = NULL;
  142. p->parameter = NULL;
  143. p->flags = 0;
  144. p->handler = NULL;
  145. return 0;
  146. }
  147. /**
  148. * @brief 初始化中断模块
  149. */
  150. void irq_init()
  151. {
  152. #if _INTR_8259A_
  153. init_8259A();
  154. #else
  155. memset(interrupt_desc, 0, sizeof(irq_desc_t) * IRQ_NUM);
  156. apic_init();
  157. #endif
  158. }