irq.c 3.6 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148
  1. #include "irq.h"
  2. #include "8259A.h"
  3. #include "../common/asm.h"
  4. #include"../common/printk.h"
  5. #include "gate.h"
  6. // 保存函数调用现场的寄存器
  7. #define SAVE_ALL_REGS \
  8. "cld; \n\t" \
  9. "pushq %rax; \n\t" \
  10. "pushq %rax; \n\t" \
  11. "movq %es, %rax; \n\t" \
  12. "pushq %rax; \n\t" \
  13. "movq %ds, %rax; \n\t" \
  14. "pushq %rax; \n\t" \
  15. "xorq %rax, %rax;\n\t" \
  16. "pushq %rbp; \n\t" \
  17. "pushq %rdi; \n\t" \
  18. "pushq %rsi; \n\t" \
  19. "pushq %rdx; \n\t" \
  20. "pushq %rcx; \n\t" \
  21. "pushq %rbx; \n\t" \
  22. "pushq %r8 ; \n\t" \
  23. "pushq %r9 ; \n\t" \
  24. "pushq %r10; \n\t" \
  25. "pushq %r11; \n\t" \
  26. "pushq %r12; \n\t" \
  27. "pushq %r13; \n\t" \
  28. "pushq %r14; \n\t" \
  29. "pushq %r15; \n\t" \
  30. "movq $0x10, %rdx;\n\t" \
  31. "movq %rdx, %ds; \n\t" \
  32. "movq %rdx, %es; \n\t"
  33. // 定义IRQ处理函数的名字格式:IRQ+中断号+interrupt
  34. #define IRQ_NAME2(name1) name1##interrupt(void)
  35. #define IRQ_NAME(number) IRQ_NAME2(IRQ##number)
  36. // 构造中断entry
  37. // 为了复用返回函数的代码,需要压入一个错误码0
  38. #define Build_IRQ(number) \
  39. void IRQ_NAME(number); \
  40. __asm__ (SYMBOL_NAME_STR(IRQ)#number"interrupt: \n\t" \
  41. "pushq $0x00 \n\t" \
  42. SAVE_ALL_REGS \
  43. "movq %rsp, %rdi\n\t" \
  44. "leaq ret_from_intr(%rip), %rax\n\t" \
  45. "pushq %rax \n\t" \
  46. "movq $"#number", %rsi \n\t" \
  47. "jmp do_IRQ\n\t");
  48. // 构造中断入口
  49. Build_IRQ(0x20)
  50. Build_IRQ(0x21)
  51. Build_IRQ(0x22)
  52. Build_IRQ(0x23)
  53. Build_IRQ(0x24)
  54. Build_IRQ(0x25)
  55. Build_IRQ(0x26)
  56. Build_IRQ(0x27)
  57. Build_IRQ(0x28)
  58. Build_IRQ(0x29)
  59. Build_IRQ(0x2a)
  60. Build_IRQ(0x2b)
  61. Build_IRQ(0x2c)
  62. Build_IRQ(0x2d)
  63. Build_IRQ(0x2e)
  64. Build_IRQ(0x2f)
  65. Build_IRQ(0x30)
  66. Build_IRQ(0x31)
  67. Build_IRQ(0x32)
  68. Build_IRQ(0x33)
  69. Build_IRQ(0x34)
  70. Build_IRQ(0x35)
  71. Build_IRQ(0x36)
  72. Build_IRQ(0x37)
  73. // 初始化中断数组
  74. void (*interrupt[24])(void)=
  75. {
  76. IRQ0x20interrupt,
  77. IRQ0x21interrupt,
  78. IRQ0x22interrupt,
  79. IRQ0x23interrupt,
  80. IRQ0x24interrupt,
  81. IRQ0x25interrupt,
  82. IRQ0x26interrupt,
  83. IRQ0x27interrupt,
  84. IRQ0x28interrupt,
  85. IRQ0x29interrupt,
  86. IRQ0x2ainterrupt,
  87. IRQ0x2binterrupt,
  88. IRQ0x2cinterrupt,
  89. IRQ0x2dinterrupt,
  90. IRQ0x2einterrupt,
  91. IRQ0x2finterrupt,
  92. IRQ0x30interrupt,
  93. IRQ0x31interrupt,
  94. IRQ0x32interrupt,
  95. IRQ0x33interrupt,
  96. IRQ0x34interrupt,
  97. IRQ0x35interrupt,
  98. IRQ0x36interrupt,
  99. IRQ0x37interrupt,
  100. };
  101. /**
  102. * @brief 初始化中断模块
  103. */
  104. void init_irq()
  105. {
  106. init_8259A();
  107. }
  108. /**
  109. * @brief 中断服务程序
  110. *
  111. * @param rsp 中断栈指针
  112. * @param number 中断号
  113. */
  114. void do_IRQ(struct pt_regs *regs, ul number)
  115. {
  116. unsigned char x;
  117. switch (number)
  118. {
  119. case 0x20: // 时钟中断信号
  120. break;
  121. case 0x21: // 键盘中断
  122. x = io_in8(0x60);
  123. printk_color(ORANGE, BLACK, "Received key irq, key code:%#018lx\n", x);
  124. break;
  125. default:
  126. break;
  127. }
  128. if(number!=0x20)
  129. printk_color(ORANGE, BLACK, "Received irq:%#018x\n", number);
  130. // 向主芯片发送中断结束信号
  131. io_out8(PIC_master, PIC_EOI);
  132. }