interrupt_gcc.S 5.7 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202
  1. /*
  2. * Copyright (c) 2006-2018, 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. */
  10. #define __ASSEMBLY__
  11. #include "cpuport.h"
  12. .section .text.entry, "ax"
  13. #if defined(SOC_SERIES_GD32VF103V)
  14. .align 6
  15. #else
  16. .align 2
  17. #endif
  18. .global SW_handler
  19. SW_handler:
  20. li t0, 0x08
  21. csrc mstatus, t0
  22. #ifdef ARCH_RISCV_FPU
  23. addi sp, sp, -32 * FREGBYTES
  24. FSTORE f0, 0 * FREGBYTES(sp)
  25. FSTORE f1, 1 * FREGBYTES(sp)
  26. FSTORE f2, 2 * FREGBYTES(sp)
  27. FSTORE f3, 3 * FREGBYTES(sp)
  28. FSTORE f4, 4 * FREGBYTES(sp)
  29. FSTORE f5, 5 * FREGBYTES(sp)
  30. FSTORE f6, 6 * FREGBYTES(sp)
  31. FSTORE f7, 7 * FREGBYTES(sp)
  32. FSTORE f8, 8 * FREGBYTES(sp)
  33. FSTORE f9, 9 * FREGBYTES(sp)
  34. FSTORE f10, 10 * FREGBYTES(sp)
  35. FSTORE f11, 11 * FREGBYTES(sp)
  36. FSTORE f12, 12 * FREGBYTES(sp)
  37. FSTORE f13, 13 * FREGBYTES(sp)
  38. FSTORE f14, 14 * FREGBYTES(sp)
  39. FSTORE f15, 15 * FREGBYTES(sp)
  40. FSTORE f16, 16 * FREGBYTES(sp)
  41. FSTORE f17, 17 * FREGBYTES(sp)
  42. FSTORE f18, 18 * FREGBYTES(sp)
  43. FSTORE f19, 19 * FREGBYTES(sp)
  44. FSTORE f20, 20 * FREGBYTES(sp)
  45. FSTORE f21, 21 * FREGBYTES(sp)
  46. FSTORE f22, 22 * FREGBYTES(sp)
  47. FSTORE f23, 23 * FREGBYTES(sp)
  48. FSTORE f24, 24 * FREGBYTES(sp)
  49. FSTORE f25, 25 * FREGBYTES(sp)
  50. FSTORE f26, 26 * FREGBYTES(sp)
  51. FSTORE f27, 27 * FREGBYTES(sp)
  52. FSTORE f28, 28 * FREGBYTES(sp)
  53. FSTORE f29, 29 * FREGBYTES(sp)
  54. FSTORE f30, 30 * FREGBYTES(sp)
  55. FSTORE f31, 31 * FREGBYTES(sp)
  56. #endif
  57. /* save all from thread context */
  58. addi sp, sp, -32 * REGBYTES
  59. STORE x5, 5 * REGBYTES(sp)
  60. STORE x1, 1 * REGBYTES(sp)
  61. /* Mandatory set the MPIE of mstatus */
  62. li t0, 0x80
  63. STORE t0, 2 * REGBYTES(sp)
  64. STORE x4, 4 * REGBYTES(sp)
  65. STORE x6, 6 * REGBYTES(sp)
  66. STORE x7, 7 * REGBYTES(sp)
  67. STORE x8, 8 * REGBYTES(sp)
  68. STORE x9, 9 * REGBYTES(sp)
  69. STORE x10, 10 * REGBYTES(sp)
  70. STORE x11, 11 * REGBYTES(sp)
  71. STORE x12, 12 * REGBYTES(sp)
  72. STORE x13, 13 * REGBYTES(sp)
  73. STORE x14, 14 * REGBYTES(sp)
  74. STORE x15, 15 * REGBYTES(sp)
  75. STORE x16, 16 * REGBYTES(sp)
  76. STORE x17, 17 * REGBYTES(sp)
  77. STORE x18, 18 * REGBYTES(sp)
  78. STORE x19, 19 * REGBYTES(sp)
  79. STORE x20, 20 * REGBYTES(sp)
  80. STORE x21, 21 * REGBYTES(sp)
  81. STORE x22, 22 * REGBYTES(sp)
  82. STORE x23, 23 * REGBYTES(sp)
  83. STORE x24, 24 * REGBYTES(sp)
  84. STORE x25, 25 * REGBYTES(sp)
  85. STORE x26, 26 * REGBYTES(sp)
  86. STORE x27, 27 * REGBYTES(sp)
  87. STORE x28, 28 * REGBYTES(sp)
  88. STORE x29, 29 * REGBYTES(sp)
  89. STORE x30, 30 * REGBYTES(sp)
  90. STORE x31, 31 * REGBYTES(sp)
  91. /* switch to interrupt stack */
  92. csrrw sp,mscratch,sp
  93. /* interrupt handle */
  94. call rt_interrupt_enter
  95. /* Do the work after saving the above */
  96. jal rt_hw_do_after_save_above
  97. call rt_interrupt_leave
  98. /* switch to from thread stack */
  99. csrrw sp,mscratch,sp
  100. /* Determine whether to trigger scheduling at the interrupt function */
  101. la s0, rt_thread_switch_interrupt_flag
  102. lw s2, 0(s0)
  103. beqz s2, 1f
  104. /* clear the flag of rt_thread_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. 1:
  117. LOAD x1, 1 * REGBYTES(sp)
  118. /* Set the mode after MRET */
  119. li t0, 0x1800
  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. LOAD x16, 16 * REGBYTES(sp)
  136. LOAD x17, 17 * REGBYTES(sp)
  137. LOAD x18, 18 * REGBYTES(sp)
  138. LOAD x19, 19 * REGBYTES(sp)
  139. LOAD x20, 20 * REGBYTES(sp)
  140. LOAD x21, 21 * REGBYTES(sp)
  141. LOAD x22, 22 * REGBYTES(sp)
  142. LOAD x23, 23 * REGBYTES(sp)
  143. LOAD x24, 24 * REGBYTES(sp)
  144. LOAD x25, 25 * REGBYTES(sp)
  145. LOAD x26, 26 * REGBYTES(sp)
  146. LOAD x27, 27 * REGBYTES(sp)
  147. LOAD x28, 28 * REGBYTES(sp)
  148. LOAD x29, 29 * REGBYTES(sp)
  149. LOAD x30, 30 * REGBYTES(sp)
  150. LOAD x31, 31 * REGBYTES(sp)
  151. addi sp, sp, 32 * REGBYTES
  152. #ifdef ARCH_RISCV_FPU
  153. FLOAD f0, 0 * FREGBYTES(sp)
  154. FLOAD f1, 1 * FREGBYTES(sp)
  155. FLOAD f2, 2 * FREGBYTES(sp)
  156. FLOAD f3, 3 * FREGBYTES(sp)
  157. FLOAD f4, 4 * FREGBYTES(sp)
  158. FLOAD f5, 5 * FREGBYTES(sp)
  159. FLOAD f6, 6 * FREGBYTES(sp)
  160. FLOAD f7, 7 * FREGBYTES(sp)
  161. FLOAD f8, 8 * FREGBYTES(sp)
  162. FLOAD f9, 9 * FREGBYTES(sp)
  163. FLOAD f10, 10 * FREGBYTES(sp)
  164. FLOAD f11, 11 * FREGBYTES(sp)
  165. FLOAD f12, 12 * FREGBYTES(sp)
  166. FLOAD f13, 13 * FREGBYTES(sp)
  167. FLOAD f14, 14 * FREGBYTES(sp)
  168. FLOAD f15, 15 * FREGBYTES(sp)
  169. FLOAD f16, 16 * FREGBYTES(sp)
  170. FLOAD f17, 17 * FREGBYTES(sp)
  171. FLOAD f18, 18 * FREGBYTES(sp)
  172. FLOAD f19, 19 * FREGBYTES(sp)
  173. FLOAD f20, 20 * FREGBYTES(sp)
  174. FLOAD f21, 21 * FREGBYTES(sp)
  175. FLOAD f22, 22 * FREGBYTES(sp)
  176. FLOAD f23, 23 * FREGBYTES(sp)
  177. FLOAD f24, 24 * FREGBYTES(sp)
  178. FLOAD f25, 25 * FREGBYTES(sp)
  179. FLOAD f26, 26 * FREGBYTES(sp)
  180. FLOAD f27, 27 * FREGBYTES(sp)
  181. FLOAD f28, 28 * FREGBYTES(sp)
  182. FLOAD f29, 29 * FREGBYTES(sp)
  183. FLOAD f30, 30 * FREGBYTES(sp)
  184. FLOAD f31, 31 * FREGBYTES(sp)
  185. addi sp, sp, 32 * FREGBYTES
  186. #endif
  187. mret