interrupt_gcc.S 5.6 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200
  1. #include "cpuport.h"
  2. .global rtt_risc_v_trap_handler
  3. .section .isr_vector.rtt_risc_v_trap_handler, "ax"
  4. .align 2
  5. .type rtt_risc_v_trap_handler, function
  6. rtt_risc_v_trap_handler:
  7. #ifdef ARCH_RISCV_FPU
  8. addi sp, sp, -32 * FREGBYTES
  9. FSTORE f0, 0 * FREGBYTES(sp)
  10. FSTORE f1, 1 * FREGBYTES(sp)
  11. FSTORE f2, 2 * FREGBYTES(sp)
  12. FSTORE f3, 3 * FREGBYTES(sp)
  13. FSTORE f4, 4 * FREGBYTES(sp)
  14. FSTORE f5, 5 * FREGBYTES(sp)
  15. FSTORE f6, 6 * FREGBYTES(sp)
  16. FSTORE f7, 7 * FREGBYTES(sp)
  17. FSTORE f8, 8 * FREGBYTES(sp)
  18. FSTORE f9, 9 * FREGBYTES(sp)
  19. FSTORE f10, 10 * FREGBYTES(sp)
  20. FSTORE f11, 11 * FREGBYTES(sp)
  21. FSTORE f12, 12 * FREGBYTES(sp)
  22. FSTORE f13, 13 * FREGBYTES(sp)
  23. FSTORE f14, 14 * FREGBYTES(sp)
  24. FSTORE f15, 15 * FREGBYTES(sp)
  25. FSTORE f16, 16 * FREGBYTES(sp)
  26. FSTORE f17, 17 * FREGBYTES(sp)
  27. FSTORE f18, 18 * FREGBYTES(sp)
  28. FSTORE f19, 19 * FREGBYTES(sp)
  29. FSTORE f20, 20 * FREGBYTES(sp)
  30. FSTORE f21, 21 * FREGBYTES(sp)
  31. FSTORE f22, 22 * FREGBYTES(sp)
  32. FSTORE f23, 23 * FREGBYTES(sp)
  33. FSTORE f24, 24 * FREGBYTES(sp)
  34. FSTORE f25, 25 * FREGBYTES(sp)
  35. FSTORE f26, 26 * FREGBYTES(sp)
  36. FSTORE f27, 27 * FREGBYTES(sp)
  37. FSTORE f28, 28 * FREGBYTES(sp)
  38. FSTORE f29, 29 * FREGBYTES(sp)
  39. FSTORE f30, 30 * FREGBYTES(sp)
  40. FSTORE f31, 31 * FREGBYTES(sp)
  41. #endif
  42. /* save all from thread context */
  43. #ifndef __riscv_32e
  44. addi sp, sp, -32 * REGBYTES
  45. #else
  46. addi sp, sp, -16 * REGBYTES
  47. #endif
  48. STORE x1, 1 * REGBYTES(sp)
  49. STORE x4, 4 * REGBYTES(sp)
  50. STORE x5, 5 * REGBYTES(sp)
  51. STORE x6, 6 * REGBYTES(sp)
  52. STORE x7, 7 * REGBYTES(sp)
  53. STORE x8, 8 * REGBYTES(sp)
  54. STORE x9, 9 * REGBYTES(sp)
  55. STORE x10, 10 * REGBYTES(sp)
  56. STORE x11, 11 * REGBYTES(sp)
  57. STORE x12, 12 * REGBYTES(sp)
  58. STORE x13, 13 * REGBYTES(sp)
  59. STORE x14, 14 * REGBYTES(sp)
  60. STORE x15, 15 * REGBYTES(sp)
  61. #ifndef __riscv_32e
  62. STORE x16, 16 * REGBYTES(sp)
  63. STORE x17, 17 * REGBYTES(sp)
  64. STORE x18, 18 * REGBYTES(sp)
  65. STORE x19, 19 * REGBYTES(sp)
  66. STORE x20, 20 * REGBYTES(sp)
  67. STORE x21, 21 * REGBYTES(sp)
  68. STORE x22, 22 * REGBYTES(sp)
  69. STORE x23, 23 * REGBYTES(sp)
  70. STORE x24, 24 * REGBYTES(sp)
  71. STORE x25, 25 * REGBYTES(sp)
  72. STORE x26, 26 * REGBYTES(sp)
  73. STORE x27, 27 * REGBYTES(sp)
  74. STORE x28, 28 * REGBYTES(sp)
  75. STORE x29, 29 * REGBYTES(sp)
  76. STORE x30, 30 * REGBYTES(sp)
  77. STORE x31, 31 * REGBYTES(sp)
  78. #endif
  79. li t0, 0x80
  80. STORE t0, 2 * REGBYTES(sp)
  81. move s0, sp
  82. /* switch to interrupt stack */
  83. la t0, _stack
  84. move sp, t0
  85. /* interrupt handle */
  86. call rt_interrupt_enter
  87. call irq_handler_trap
  88. call rt_interrupt_leave
  89. /* switch to from thread stack */
  90. move sp, s0
  91. /* need to switch new thread */
  92. la s0, rt_thread_switch_interrupt_flag
  93. lw s2, 0(s0)
  94. beqz s2, spurious_interrupt
  95. /* clear switch interrupt flag */
  96. sw zero, 0(s0)
  97. csrr a0, mepc
  98. STORE a0, 0 * REGBYTES(sp)
  99. la s0, rt_interrupt_from_thread
  100. LOAD s1, 0(s0)
  101. STORE sp, 0(s1)
  102. la s0, rt_interrupt_to_thread
  103. LOAD s1, 0(s0)
  104. LOAD sp, 0(s1)
  105. LOAD a0, 0 * REGBYTES(sp)
  106. csrw mepc, a0
  107. spurious_interrupt:
  108. LOAD x1, 1 * REGBYTES(sp)
  109. /* Remain in M-mode after mret */
  110. li t0, 0x00001800
  111. csrs mstatus, t0
  112. LOAD t0, 2 * REGBYTES(sp)
  113. csrs mstatus, t0
  114. LOAD x4, 4 * REGBYTES(sp)
  115. LOAD x5, 5 * REGBYTES(sp)
  116. LOAD x6, 6 * REGBYTES(sp)
  117. LOAD x7, 7 * REGBYTES(sp)
  118. LOAD x8, 8 * REGBYTES(sp)
  119. LOAD x9, 9 * REGBYTES(sp)
  120. LOAD x10, 10 * REGBYTES(sp)
  121. LOAD x11, 11 * REGBYTES(sp)
  122. LOAD x12, 12 * REGBYTES(sp)
  123. LOAD x13, 13 * REGBYTES(sp)
  124. LOAD x14, 14 * REGBYTES(sp)
  125. LOAD x15, 15 * REGBYTES(sp)
  126. #ifndef __riscv_32e
  127. LOAD x16, 16 * REGBYTES(sp)
  128. LOAD x17, 17 * REGBYTES(sp)
  129. LOAD x18, 18 * REGBYTES(sp)
  130. LOAD x19, 19 * REGBYTES(sp)
  131. LOAD x20, 20 * REGBYTES(sp)
  132. LOAD x21, 21 * REGBYTES(sp)
  133. LOAD x22, 22 * REGBYTES(sp)
  134. LOAD x23, 23 * REGBYTES(sp)
  135. LOAD x24, 24 * REGBYTES(sp)
  136. LOAD x25, 25 * REGBYTES(sp)
  137. LOAD x26, 26 * REGBYTES(sp)
  138. LOAD x27, 27 * REGBYTES(sp)
  139. LOAD x28, 28 * REGBYTES(sp)
  140. LOAD x29, 29 * REGBYTES(sp)
  141. LOAD x30, 30 * REGBYTES(sp)
  142. LOAD x31, 31 * REGBYTES(sp)
  143. addi sp, sp, 32 * REGBYTES
  144. #else
  145. addi sp, sp, 16 * REGBYTES
  146. #endif
  147. #ifdef ARCH_RISCV_FPU
  148. FLOAD f0, 0 * FREGBYTES(sp)
  149. FLOAD f1, 1 * FREGBYTES(sp)
  150. FLOAD f2, 2 * FREGBYTES(sp)
  151. FLOAD f3, 3 * FREGBYTES(sp)
  152. FLOAD f4, 4 * FREGBYTES(sp)
  153. FLOAD f5, 5 * FREGBYTES(sp)
  154. FLOAD f6, 6 * FREGBYTES(sp)
  155. FLOAD f7, 7 * FREGBYTES(sp)
  156. FLOAD f8, 8 * FREGBYTES(sp)
  157. FLOAD f9, 9 * FREGBYTES(sp)
  158. FLOAD f10, 10 * FREGBYTES(sp)
  159. FLOAD f11, 11 * FREGBYTES(sp)
  160. FLOAD f12, 12 * FREGBYTES(sp)
  161. FLOAD f13, 13 * FREGBYTES(sp)
  162. FLOAD f14, 14 * FREGBYTES(sp)
  163. FLOAD f15, 15 * FREGBYTES(sp)
  164. FLOAD f16, 16 * FREGBYTES(sp)
  165. FLOAD f17, 17 * FREGBYTES(sp)
  166. FLOAD f18, 18 * FREGBYTES(sp)
  167. FLOAD f19, 19 * FREGBYTES(sp)
  168. FLOAD f20, 20 * FREGBYTES(sp)
  169. FLOAD f21, 21 * FREGBYTES(sp)
  170. FLOAD f22, 22 * FREGBYTES(sp)
  171. FLOAD f23, 23 * FREGBYTES(sp)
  172. FLOAD f24, 24 * FREGBYTES(sp)
  173. FLOAD f25, 25 * FREGBYTES(sp)
  174. FLOAD f26, 26 * FREGBYTES(sp)
  175. FLOAD f27, 27 * FREGBYTES(sp)
  176. FLOAD f28, 28 * FREGBYTES(sp)
  177. FLOAD f29, 29 * FREGBYTES(sp)
  178. FLOAD f30, 30 * FREGBYTES(sp)
  179. FLOAD f31, 31 * FREGBYTES(sp)
  180. addi sp, sp, 32 * FREGBYTES
  181. #endif
  182. mret