context_gcc.S 5.3 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217
  1. ;/*
  2. ; * File : context_gcc.S
  3. ; * This file is part of RT-Thread RTOS
  4. ; * COPYRIGHT (C) 2006, RT-Thread Development Team
  5. ; *
  6. ; * This program is free software; you can redistribute it and/or modify
  7. ; * it under the terms of the GNU General Public License as published by
  8. ; * the Free Software Foundation; either version 2 of the License, or
  9. ; * (at your option) any later version.
  10. ; *
  11. ; * This program is distributed in the hope that it will be useful,
  12. ; * but WITHOUT ANY WARRANTY; without even the implied warranty of
  13. ; * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  14. ; * GNU General Public License for more details.
  15. ; *
  16. ; * You should have received a copy of the GNU General Public License along
  17. ; * with this program; if not, write to the Free Software Foundation, Inc.,
  18. ; * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
  19. ; *
  20. ; * Change Logs:
  21. ; * Date Author Notes
  22. ; * 2017-07-16 zhangjun for hifive1
  23. ; */
  24. #include "encoding.h"
  25. #include "sifive/bits.h"
  26. /*
  27. * rt_base_t rt_hw_interrupt_disable();
  28. */
  29. .globl rt_hw_interrupt_disable
  30. rt_hw_interrupt_disable:
  31. addi sp, sp, -12
  32. sw a5, (sp)
  33. csrr a0, mie
  34. li a5, MIP_MEIP|MIP_MTIP|MIP_MSIP
  35. /* csrrc a5, mstatus, MSTATUS_MIE*/
  36. lw a5, (sp)
  37. addi sp, sp, 12
  38. ret
  39. /*
  40. * void rt_hw_interrupt_enable(rt_base_t level);
  41. */
  42. .globl rt_hw_interrupt_enable
  43. rt_hw_interrupt_enable:
  44. addi sp, sp, -12
  45. sw a5, (sp)
  46. li a5, MIP_MEIP|MIP_MTIP|MIP_MSIP
  47. csrrs a5, mie, a5
  48. /* csrrsi a5, mstatus, MSTATUS_MIE*/
  49. lw a5, (sp)
  50. addi sp, sp, 12
  51. ret
  52. /*
  53. * void rt_hw_context_switch(rt_uint32 from, rt_uint32 to);
  54. * a0 --> from
  55. * a1 --> to
  56. */
  57. .globl rt_hw_context_switch
  58. rt_hw_context_switch:
  59. addi sp, sp, -32*REGBYTES
  60. STORE sp, (a0)
  61. STORE x30, 1*REGBYTES(sp)
  62. STORE x31, 2*REGBYTES(sp)
  63. STORE x3, 3*REGBYTES(sp)
  64. STORE x4, 4*REGBYTES(sp)
  65. STORE x5, 5*REGBYTES(sp)
  66. STORE x6, 6*REGBYTES(sp)
  67. STORE x7, 7*REGBYTES(sp)
  68. STORE x8, 8*REGBYTES(sp)
  69. STORE x9, 9*REGBYTES(sp)
  70. STORE x10, 10*REGBYTES(sp)
  71. STORE x11, 11*REGBYTES(sp)
  72. STORE x12, 12*REGBYTES(sp)
  73. STORE x13, 13*REGBYTES(sp)
  74. STORE x14, 14*REGBYTES(sp)
  75. STORE x15, 15*REGBYTES(sp)
  76. STORE x16, 16*REGBYTES(sp)
  77. STORE x17, 17*REGBYTES(sp)
  78. STORE x18, 18*REGBYTES(sp)
  79. STORE x19, 19*REGBYTES(sp)
  80. STORE x20, 20*REGBYTES(sp)
  81. STORE x21, 21*REGBYTES(sp)
  82. STORE x22, 22*REGBYTES(sp)
  83. STORE x23, 23*REGBYTES(sp)
  84. STORE x24, 24*REGBYTES(sp)
  85. STORE x25, 25*REGBYTES(sp)
  86. STORE x26, 26*REGBYTES(sp)
  87. STORE x27, 27*REGBYTES(sp)
  88. STORE x28, 28*REGBYTES(sp)
  89. STORE x1, 31*REGBYTES(sp)
  90. STORE x10, 29*REGBYTES(sp)
  91. STORE x1, 30*REGBYTES(sp)
  92. /*
  93. *Remain in M-mode after mret
  94. *enable interrupt in M-mode
  95. */
  96. li t0, MSTATUS_MPIE|MSTATUS_MPP
  97. csrs mstatus, t0
  98. LOAD sp, (a1)
  99. LOAD x30, 1*REGBYTES(sp)
  100. LOAD x31, 2*REGBYTES(sp)
  101. LOAD x3, 3*REGBYTES(sp)
  102. LOAD x4, 4*REGBYTES(sp)
  103. LOAD x5, 5*REGBYTES(sp)
  104. LOAD x6, 6*REGBYTES(sp)
  105. LOAD x7, 7*REGBYTES(sp)
  106. LOAD x8, 8*REGBYTES(sp)
  107. LOAD x9, 9*REGBYTES(sp)
  108. LOAD x29, 10*REGBYTES(sp)
  109. LOAD x11, 11*REGBYTES(sp)
  110. LOAD x12, 12*REGBYTES(sp)
  111. LOAD x13, 13*REGBYTES(sp)
  112. LOAD x14, 14*REGBYTES(sp)
  113. LOAD x15, 15*REGBYTES(sp)
  114. LOAD x16, 16*REGBYTES(sp)
  115. LOAD x17, 17*REGBYTES(sp)
  116. LOAD x18, 18*REGBYTES(sp)
  117. LOAD x19, 19*REGBYTES(sp)
  118. LOAD x20, 20*REGBYTES(sp)
  119. LOAD x21, 21*REGBYTES(sp)
  120. LOAD x22, 22*REGBYTES(sp)
  121. LOAD x23, 23*REGBYTES(sp)
  122. LOAD x24, 24*REGBYTES(sp)
  123. LOAD x25, 25*REGBYTES(sp)
  124. LOAD x26, 26*REGBYTES(sp)
  125. LOAD x27, 27*REGBYTES(sp)
  126. LOAD x28, 28*REGBYTES(sp)
  127. LOAD x10, 31*REGBYTES(sp)
  128. csrw mepc,x10
  129. LOAD x10, 29*REGBYTES(sp)
  130. LOAD x1, 30*REGBYTES(sp)
  131. addi sp, sp, 32*REGBYTES
  132. mret
  133. /*
  134. * void rt_hw_context_switch_to(rt_uint32 to);
  135. * a0 --> to
  136. */
  137. .globl rt_hw_context_switch_to
  138. rt_hw_context_switch_to:
  139. LOAD sp, (a0)
  140. LOAD x30, 1*REGBYTES(sp)
  141. LOAD x31, 2*REGBYTES(sp)
  142. LOAD x3, 3*REGBYTES(sp)
  143. LOAD x4, 4*REGBYTES(sp)
  144. LOAD x5, 5*REGBYTES(sp)
  145. LOAD x6, 6*REGBYTES(sp)
  146. LOAD x7, 7*REGBYTES(sp)
  147. LOAD x8, 8*REGBYTES(sp)
  148. LOAD x9, 9*REGBYTES(sp)
  149. LOAD x29, 10*REGBYTES(sp)
  150. LOAD x11, 11*REGBYTES(sp)
  151. LOAD x12, 12*REGBYTES(sp)
  152. LOAD x13, 13*REGBYTES(sp)
  153. LOAD x14, 14*REGBYTES(sp)
  154. LOAD x15, 15*REGBYTES(sp)
  155. LOAD x16, 16*REGBYTES(sp)
  156. LOAD x17, 17*REGBYTES(sp)
  157. LOAD x18, 18*REGBYTES(sp)
  158. LOAD x19, 19*REGBYTES(sp)
  159. LOAD x20, 20*REGBYTES(sp)
  160. LOAD x21, 21*REGBYTES(sp)
  161. LOAD x22, 22*REGBYTES(sp)
  162. LOAD x23, 23*REGBYTES(sp)
  163. LOAD x24, 24*REGBYTES(sp)
  164. LOAD x25, 25*REGBYTES(sp)
  165. LOAD x26, 26*REGBYTES(sp)
  166. LOAD x27, 27*REGBYTES(sp)
  167. LOAD x28, 28*REGBYTES(sp)
  168. LOAD x10, 31*REGBYTES(sp)
  169. csrw mepc,a0
  170. LOAD x10, 29*REGBYTES(sp)
  171. LOAD x1, 30*REGBYTES(sp)
  172. addi sp, sp, 32*REGBYTES
  173. mret
  174. /*
  175. * void rt_hw_context_switch_interrupt(rt_uint32 from, rt_uint32 to);
  176. */
  177. .globl rt_thread_switch_interrupt_flag
  178. .globl rt_interrupt_from_thread
  179. .globl rt_interrupt_to_thread
  180. .globl rt_hw_context_switch_interrupt
  181. rt_hw_context_switch_interrupt:
  182. addi sp, sp, -16
  183. sw s0, 12(sp)
  184. sw a0, 8(sp)
  185. sw a5, 4(sp)
  186. la a0, rt_thread_switch_interrupt_flag
  187. lw a5, (a0)
  188. bnez a5, _reswitch
  189. li a5, 1
  190. sw a5, (a0)
  191. la a5, rt_interrupt_from_thread
  192. lw a0, 8(sp)
  193. sw a0, (a5)
  194. _reswitch:
  195. la a5, rt_interrupt_to_thread
  196. sw a1, (a5)
  197. lw a5, 4(sp)
  198. lw a0, 8(sp)
  199. lw s0, 12(sp)
  200. addi sp, sp, 16
  201. ret