interrupt_iar.s 5.8 KB

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