1
0

interrupt_gcc.S 5.4 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191
  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. * 2021-09-09 WCH the first version
  9. */
  10. #include "cpuport.h"
  11. .global SW_handler
  12. .align 2
  13. SW_handler:
  14. /* save all from thread context */
  15. #ifdef ARCH_RISCV_FPU
  16. addi sp, sp, -32 * FREGBYTES
  17. FSTORE f0, 0 * FREGBYTES(sp)
  18. FSTORE f1, 1 * FREGBYTES(sp)
  19. FSTORE f2, 2 * FREGBYTES(sp)
  20. FSTORE f3, 3 * FREGBYTES(sp)
  21. FSTORE f4, 4 * FREGBYTES(sp)
  22. FSTORE f5, 5 * FREGBYTES(sp)
  23. FSTORE f6, 6 * FREGBYTES(sp)
  24. FSTORE f7, 7 * FREGBYTES(sp)
  25. FSTORE f8, 8 * FREGBYTES(sp)
  26. FSTORE f9, 9 * FREGBYTES(sp)
  27. FSTORE f10, 10 * FREGBYTES(sp)
  28. FSTORE f11, 11 * FREGBYTES(sp)
  29. FSTORE f12, 12 * FREGBYTES(sp)
  30. FSTORE f13, 13 * FREGBYTES(sp)
  31. FSTORE f14, 14 * FREGBYTES(sp)
  32. FSTORE f15, 15 * FREGBYTES(sp)
  33. FSTORE f16, 16 * FREGBYTES(sp)
  34. FSTORE f17, 17 * FREGBYTES(sp)
  35. FSTORE f18, 18 * FREGBYTES(sp)
  36. FSTORE f19, 19 * FREGBYTES(sp)
  37. FSTORE f20, 20 * FREGBYTES(sp)
  38. FSTORE f21, 21 * FREGBYTES(sp)
  39. FSTORE f22, 22 * FREGBYTES(sp)
  40. FSTORE f23, 23 * FREGBYTES(sp)
  41. FSTORE f24, 24 * FREGBYTES(sp)
  42. FSTORE f25, 25 * FREGBYTES(sp)
  43. FSTORE f26, 26 * FREGBYTES(sp)
  44. FSTORE f27, 27 * FREGBYTES(sp)
  45. FSTORE f28, 28 * FREGBYTES(sp)
  46. FSTORE f29, 29 * FREGBYTES(sp)
  47. FSTORE f30, 30 * FREGBYTES(sp)
  48. FSTORE f31, 31 * FREGBYTES(sp)
  49. #endif
  50. addi sp, sp, -32 * REGBYTES
  51. STORE x5, 5 * REGBYTES(sp)
  52. /* saved MPIE */
  53. li t0, 0x80
  54. STORE t0, 2 * REGBYTES(sp)
  55. STORE x1, 1 * REGBYTES(sp)
  56. STORE x4, 4 * REGBYTES(sp)
  57. STORE x6, 6 * REGBYTES(sp)
  58. STORE x7, 7 * REGBYTES(sp)
  59. STORE x8, 8 * REGBYTES(sp)
  60. STORE x9, 9 * REGBYTES(sp)
  61. STORE x10, 10 * REGBYTES(sp)
  62. STORE x11, 11 * REGBYTES(sp)
  63. STORE x12, 12 * REGBYTES(sp)
  64. STORE x13, 13 * REGBYTES(sp)
  65. STORE x14, 14 * REGBYTES(sp)
  66. STORE x15, 15 * REGBYTES(sp)
  67. STORE x16, 16 * REGBYTES(sp)
  68. STORE x17, 17 * REGBYTES(sp)
  69. STORE x18, 18 * REGBYTES(sp)
  70. STORE x19, 19 * REGBYTES(sp)
  71. STORE x20, 20 * REGBYTES(sp)
  72. STORE x21, 21 * REGBYTES(sp)
  73. STORE x22, 22 * REGBYTES(sp)
  74. STORE x23, 23 * REGBYTES(sp)
  75. STORE x24, 24 * REGBYTES(sp)
  76. STORE x25, 25 * REGBYTES(sp)
  77. STORE x26, 26 * REGBYTES(sp)
  78. STORE x27, 27 * REGBYTES(sp)
  79. STORE x28, 28 * REGBYTES(sp)
  80. STORE x29, 29 * REGBYTES(sp)
  81. STORE x30, 30 * REGBYTES(sp)
  82. STORE x31, 31 * REGBYTES(sp)
  83. /* switch to interrupt stack */
  84. csrrw sp,mscratch,sp
  85. call rt_interrupt_enter
  86. /* clear interrupt */
  87. jal sw_clearpend
  88. call rt_interrupt_leave
  89. /* switch to from thread stack */
  90. csrrw sp,mscratch,sp
  91. /* if rt_thread_switch_interrupt_flag=1,then clear it */
  92. la s0, rt_thread_switch_interrupt_flag
  93. lw s2, 0(s0)
  94. beqz s2, 1f
  95. sw zero, 0(s0)
  96. #1:
  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. 1: LOAD x1, 1 * REGBYTES(sp)
  108. li t0,0x1800
  109. csrs mstatus, t0
  110. LOAD t0, 2*REGBYTES(sp)
  111. csrs mstatus, t0
  112. LOAD x4, 4 * REGBYTES(sp)
  113. LOAD x5, 5 * REGBYTES(sp)
  114. LOAD x6, 6 * REGBYTES(sp)
  115. LOAD x7, 7 * REGBYTES(sp)
  116. LOAD x8, 8 * REGBYTES(sp)
  117. LOAD x9, 9 * REGBYTES(sp)
  118. LOAD x10, 10 * REGBYTES(sp)
  119. LOAD x11, 11 * REGBYTES(sp)
  120. LOAD x12, 12 * REGBYTES(sp)
  121. LOAD x13, 13 * REGBYTES(sp)
  122. LOAD x14, 14 * REGBYTES(sp)
  123. LOAD x15, 15 * REGBYTES(sp)
  124. LOAD x16, 16 * REGBYTES(sp)
  125. LOAD x17, 17 * REGBYTES(sp)
  126. LOAD x18, 18 * REGBYTES(sp)
  127. LOAD x19, 19 * REGBYTES(sp)
  128. LOAD x20, 20 * REGBYTES(sp)
  129. LOAD x21, 21 * REGBYTES(sp)
  130. LOAD x22, 22 * REGBYTES(sp)
  131. LOAD x23, 23 * REGBYTES(sp)
  132. LOAD x24, 24 * REGBYTES(sp)
  133. LOAD x25, 25 * REGBYTES(sp)
  134. LOAD x26, 26 * REGBYTES(sp)
  135. LOAD x27, 27 * REGBYTES(sp)
  136. LOAD x28, 28 * REGBYTES(sp)
  137. LOAD x29, 29 * REGBYTES(sp)
  138. LOAD x30, 30 * REGBYTES(sp)
  139. LOAD x31, 31 * REGBYTES(sp)
  140. addi sp, sp, 32 * REGBYTES
  141. /* load float reg */
  142. #ifdef ARCH_RISCV_FPU
  143. FLOAD f0, 0 * FREGBYTES(sp)
  144. FLOAD f1, 1 * FREGBYTES(sp)
  145. FLOAD f2, 2 * FREGBYTES(sp)
  146. FLOAD f3, 3 * FREGBYTES(sp)
  147. FLOAD f4, 4 * FREGBYTES(sp)
  148. FLOAD f5, 5 * FREGBYTES(sp)
  149. FLOAD f6, 6 * FREGBYTES(sp)
  150. FLOAD f7, 7 * FREGBYTES(sp)
  151. FLOAD f8, 8 * FREGBYTES(sp)
  152. FLOAD f9, 9 * FREGBYTES(sp)
  153. FLOAD f10, 10 * FREGBYTES(sp)
  154. FLOAD f11, 11 * FREGBYTES(sp)
  155. FLOAD f12, 12 * FREGBYTES(sp)
  156. FLOAD f13, 13 * FREGBYTES(sp)
  157. FLOAD f14, 14 * FREGBYTES(sp)
  158. FLOAD f15, 15 * FREGBYTES(sp)
  159. FLOAD f16, 16 * FREGBYTES(sp)
  160. FLOAD f17, 17 * FREGBYTES(sp)
  161. FLOAD f18, 18 * FREGBYTES(sp)
  162. FLOAD f19, 19 * FREGBYTES(sp)
  163. FLOAD f20, 20 * FREGBYTES(sp)
  164. FLOAD f21, 21 * FREGBYTES(sp)
  165. FLOAD f22, 22 * FREGBYTES(sp)
  166. FLOAD f23, 23 * FREGBYTES(sp)
  167. FLOAD f24, 24 * FREGBYTES(sp)
  168. FLOAD f25, 25 * FREGBYTES(sp)
  169. FLOAD f26, 26 * FREGBYTES(sp)
  170. FLOAD f27, 27 * FREGBYTES(sp)
  171. FLOAD f28, 28 * FREGBYTES(sp)
  172. FLOAD f29, 29 * FREGBYTES(sp)
  173. FLOAD f30, 30 * FREGBYTES(sp)
  174. FLOAD f31, 31 * FREGBYTES(sp)
  175. addi sp, sp, 32 * FREGBYTES
  176. #endif
  177. mret