interrupt_gcc.S 6.0 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212
  1. /*
  2. * Copyright (c) 2006-2023, RT-Thread Development Team
  3. *
  4. * SPDX-License-Identifier: Apache-2.0
  5. *
  6. * Change Logs:
  7. * Date Author Notes
  8. * 2023/01/17 WangShun The first version
  9. * 2023/03/19 Flyingcys Add riscv_32e support
  10. * 2023/08/09 HPMicro Fix the issue t0 was modified unexpectedly before being saved
  11. */
  12. #define __ASSEMBLY__
  13. #include "cpuport.h"
  14. .section .text.entry, "ax"
  15. #if defined(SOC_SERIES_GD32VF103V)
  16. .align 6
  17. #else
  18. .align 2
  19. #endif
  20. .global SW_handler
  21. SW_handler:
  22. csrci mstatus, 0x8
  23. #ifdef ARCH_RISCV_FPU
  24. addi sp, sp, -32 * FREGBYTES
  25. FSTORE f0, 0 * FREGBYTES(sp)
  26. FSTORE f1, 1 * FREGBYTES(sp)
  27. FSTORE f2, 2 * FREGBYTES(sp)
  28. FSTORE f3, 3 * FREGBYTES(sp)
  29. FSTORE f4, 4 * FREGBYTES(sp)
  30. FSTORE f5, 5 * FREGBYTES(sp)
  31. FSTORE f6, 6 * FREGBYTES(sp)
  32. FSTORE f7, 7 * FREGBYTES(sp)
  33. FSTORE f8, 8 * FREGBYTES(sp)
  34. FSTORE f9, 9 * FREGBYTES(sp)
  35. FSTORE f10, 10 * FREGBYTES(sp)
  36. FSTORE f11, 11 * FREGBYTES(sp)
  37. FSTORE f12, 12 * FREGBYTES(sp)
  38. FSTORE f13, 13 * FREGBYTES(sp)
  39. FSTORE f14, 14 * FREGBYTES(sp)
  40. FSTORE f15, 15 * FREGBYTES(sp)
  41. FSTORE f16, 16 * FREGBYTES(sp)
  42. FSTORE f17, 17 * FREGBYTES(sp)
  43. FSTORE f18, 18 * FREGBYTES(sp)
  44. FSTORE f19, 19 * FREGBYTES(sp)
  45. FSTORE f20, 20 * FREGBYTES(sp)
  46. FSTORE f21, 21 * FREGBYTES(sp)
  47. FSTORE f22, 22 * FREGBYTES(sp)
  48. FSTORE f23, 23 * FREGBYTES(sp)
  49. FSTORE f24, 24 * FREGBYTES(sp)
  50. FSTORE f25, 25 * FREGBYTES(sp)
  51. FSTORE f26, 26 * FREGBYTES(sp)
  52. FSTORE f27, 27 * FREGBYTES(sp)
  53. FSTORE f28, 28 * FREGBYTES(sp)
  54. FSTORE f29, 29 * FREGBYTES(sp)
  55. FSTORE f30, 30 * FREGBYTES(sp)
  56. FSTORE f31, 31 * FREGBYTES(sp)
  57. #endif
  58. /* save all from thread context */
  59. #ifndef __riscv_32e
  60. addi sp, sp, -32 * REGBYTES
  61. #else
  62. addi sp, sp, -16 * REGBYTES
  63. #endif
  64. STORE x5, 5 * REGBYTES(sp)
  65. STORE x1, 1 * REGBYTES(sp)
  66. /* Mandatory set the MPIE of mstatus */
  67. li t0, 0x80
  68. STORE t0, 2 * REGBYTES(sp)
  69. STORE x4, 4 * REGBYTES(sp)
  70. STORE x6, 6 * REGBYTES(sp)
  71. STORE x7, 7 * REGBYTES(sp)
  72. STORE x8, 8 * REGBYTES(sp)
  73. STORE x9, 9 * REGBYTES(sp)
  74. STORE x10, 10 * REGBYTES(sp)
  75. STORE x11, 11 * REGBYTES(sp)
  76. STORE x12, 12 * REGBYTES(sp)
  77. STORE x13, 13 * REGBYTES(sp)
  78. STORE x14, 14 * REGBYTES(sp)
  79. STORE x15, 15 * REGBYTES(sp)
  80. #ifndef __riscv_32e
  81. STORE x16, 16 * REGBYTES(sp)
  82. STORE x17, 17 * REGBYTES(sp)
  83. STORE x18, 18 * REGBYTES(sp)
  84. STORE x19, 19 * REGBYTES(sp)
  85. STORE x20, 20 * REGBYTES(sp)
  86. STORE x21, 21 * REGBYTES(sp)
  87. STORE x22, 22 * REGBYTES(sp)
  88. STORE x23, 23 * REGBYTES(sp)
  89. STORE x24, 24 * REGBYTES(sp)
  90. STORE x25, 25 * REGBYTES(sp)
  91. STORE x26, 26 * REGBYTES(sp)
  92. STORE x27, 27 * REGBYTES(sp)
  93. STORE x28, 28 * REGBYTES(sp)
  94. STORE x29, 29 * REGBYTES(sp)
  95. STORE x30, 30 * REGBYTES(sp)
  96. STORE x31, 31 * REGBYTES(sp)
  97. #endif
  98. /* switch to interrupt stack */
  99. csrrw sp,mscratch,sp
  100. /* interrupt handle */
  101. call rt_interrupt_enter
  102. /* Do the work after saving the above */
  103. jal rt_hw_do_after_save_above
  104. call rt_interrupt_leave
  105. /* switch to from thread stack */
  106. csrrw sp,mscratch,sp
  107. /* Determine whether to trigger scheduling at the interrupt function */
  108. la t0, rt_thread_switch_interrupt_flag
  109. lw t2, 0(t0)
  110. beqz t2, 1f
  111. /* clear the flag of rt_thread_switch_interrupt_flag */
  112. sw zero, 0(t0)
  113. csrr a0, mepc
  114. STORE a0, 0 * REGBYTES(sp)
  115. la t0, rt_interrupt_from_thread
  116. LOAD t1, 0(t0)
  117. STORE sp, 0(t1)
  118. la t0, rt_interrupt_to_thread
  119. LOAD t1, 0(t0)
  120. LOAD sp, 0(t1)
  121. LOAD a0, 0 * REGBYTES(sp)
  122. csrw mepc, a0
  123. 1:
  124. LOAD x1, 1 * REGBYTES(sp)
  125. /* Set the mode after MRET */
  126. li t0, 0x1800
  127. csrs mstatus, t0
  128. LOAD t0, 2 * REGBYTES(sp)
  129. csrs mstatus, t0
  130. LOAD x4, 4 * REGBYTES(sp)
  131. LOAD x5, 5 * REGBYTES(sp)
  132. LOAD x6, 6 * REGBYTES(sp)
  133. LOAD x7, 7 * REGBYTES(sp)
  134. LOAD x8, 8 * REGBYTES(sp)
  135. LOAD x9, 9 * REGBYTES(sp)
  136. LOAD x10, 10 * REGBYTES(sp)
  137. LOAD x11, 11 * REGBYTES(sp)
  138. LOAD x12, 12 * REGBYTES(sp)
  139. LOAD x13, 13 * REGBYTES(sp)
  140. LOAD x14, 14 * REGBYTES(sp)
  141. LOAD x15, 15 * REGBYTES(sp)
  142. #ifndef __riscv_32e
  143. LOAD x16, 16 * REGBYTES(sp)
  144. LOAD x17, 17 * REGBYTES(sp)
  145. LOAD x18, 18 * REGBYTES(sp)
  146. LOAD x19, 19 * REGBYTES(sp)
  147. LOAD x20, 20 * REGBYTES(sp)
  148. LOAD x21, 21 * REGBYTES(sp)
  149. LOAD x22, 22 * REGBYTES(sp)
  150. LOAD x23, 23 * REGBYTES(sp)
  151. LOAD x24, 24 * REGBYTES(sp)
  152. LOAD x25, 25 * REGBYTES(sp)
  153. LOAD x26, 26 * REGBYTES(sp)
  154. LOAD x27, 27 * REGBYTES(sp)
  155. LOAD x28, 28 * REGBYTES(sp)
  156. LOAD x29, 29 * REGBYTES(sp)
  157. LOAD x30, 30 * REGBYTES(sp)
  158. LOAD x31, 31 * REGBYTES(sp)
  159. addi sp, sp, 32 * REGBYTES
  160. #else
  161. addi sp, sp, 16 * REGBYTES
  162. #endif
  163. #ifdef ARCH_RISCV_FPU
  164. FLOAD f0, 0 * FREGBYTES(sp)
  165. FLOAD f1, 1 * FREGBYTES(sp)
  166. FLOAD f2, 2 * FREGBYTES(sp)
  167. FLOAD f3, 3 * FREGBYTES(sp)
  168. FLOAD f4, 4 * FREGBYTES(sp)
  169. FLOAD f5, 5 * FREGBYTES(sp)
  170. FLOAD f6, 6 * FREGBYTES(sp)
  171. FLOAD f7, 7 * FREGBYTES(sp)
  172. FLOAD f8, 8 * FREGBYTES(sp)
  173. FLOAD f9, 9 * FREGBYTES(sp)
  174. FLOAD f10, 10 * FREGBYTES(sp)
  175. FLOAD f11, 11 * FREGBYTES(sp)
  176. FLOAD f12, 12 * FREGBYTES(sp)
  177. FLOAD f13, 13 * FREGBYTES(sp)
  178. FLOAD f14, 14 * FREGBYTES(sp)
  179. FLOAD f15, 15 * FREGBYTES(sp)
  180. FLOAD f16, 16 * FREGBYTES(sp)
  181. FLOAD f17, 17 * FREGBYTES(sp)
  182. FLOAD f18, 18 * FREGBYTES(sp)
  183. FLOAD f19, 19 * FREGBYTES(sp)
  184. FLOAD f20, 20 * FREGBYTES(sp)
  185. FLOAD f21, 21 * FREGBYTES(sp)
  186. FLOAD f22, 22 * FREGBYTES(sp)
  187. FLOAD f23, 23 * FREGBYTES(sp)
  188. FLOAD f24, 24 * FREGBYTES(sp)
  189. FLOAD f25, 25 * FREGBYTES(sp)
  190. FLOAD f26, 26 * FREGBYTES(sp)
  191. FLOAD f27, 27 * FREGBYTES(sp)
  192. FLOAD f28, 28 * FREGBYTES(sp)
  193. FLOAD f29, 29 * FREGBYTES(sp)
  194. FLOAD f30, 30 * FREGBYTES(sp)
  195. FLOAD f31, 31 * FREGBYTES(sp)
  196. addi sp, sp, 32 * FREGBYTES
  197. #endif
  198. mret