stackframe.h 6.6 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349
  1. /*
  2. * This file is subject to the terms and conditions of the GNU General Public
  3. * License. See the file "COPYING" in the main directory of this archive
  4. * for more details.
  5. *
  6. * Copyright (C) 1994, 95, 96, 99, 2001 Ralf Baechle
  7. * Copyright (C) 1994, 1995, 1996 Paul M. Antoine.
  8. * Copyright (C) 1999 Silicon Graphics, Inc.
  9. */
  10. #ifndef _ASM_STACKFRAME_H
  11. #define _ASM_STACKFRAME_H
  12. #include <linux/config.h>
  13. #include <linux/threads.h>
  14. #include <asm/asm.h>
  15. #include <asm/mipsregs.h>
  16. #include <asm/asm-offsets.h>
  17. .macro SAVE_AT
  18. .set push
  19. .set noat
  20. LONG_S $1, PT_R1(sp)
  21. .set pop
  22. .endm
  23. .macro SAVE_TEMP
  24. mfhi v1
  25. #ifdef CONFIG_32BIT
  26. LONG_S $8, PT_R8(sp)
  27. LONG_S $9, PT_R9(sp)
  28. #endif
  29. LONG_S v1, PT_HI(sp)
  30. mflo v1
  31. LONG_S $10, PT_R10(sp)
  32. LONG_S $11, PT_R11(sp)
  33. LONG_S v1, PT_LO(sp)
  34. LONG_S $12, PT_R12(sp)
  35. LONG_S $13, PT_R13(sp)
  36. LONG_S $14, PT_R14(sp)
  37. LONG_S $15, PT_R15(sp)
  38. LONG_S $24, PT_R24(sp)
  39. .endm
  40. .macro SAVE_STATIC
  41. LONG_S $16, PT_R16(sp)
  42. LONG_S $17, PT_R17(sp)
  43. LONG_S $18, PT_R18(sp)
  44. LONG_S $19, PT_R19(sp)
  45. LONG_S $20, PT_R20(sp)
  46. LONG_S $21, PT_R21(sp)
  47. LONG_S $22, PT_R22(sp)
  48. LONG_S $23, PT_R23(sp)
  49. LONG_S $30, PT_R30(sp)
  50. .endm
  51. #ifdef CONFIG_SMP
  52. .macro get_saved_sp /* SMP variation */
  53. #ifdef CONFIG_32BIT
  54. mfc0 k0, CP0_CONTEXT
  55. lui k1, %hi(kernelsp)
  56. srl k0, k0, 23
  57. addu k1, k0
  58. LONG_L k1, %lo(kernelsp)(k1)
  59. #endif
  60. #if defined(CONFIG_64BIT) && !defined(CONFIG_BUILD_ELF64)
  61. MFC0 k1, CP0_CONTEXT
  62. dsra k1, 23
  63. lui k0, %hi(pgd_current)
  64. addiu k0, %lo(pgd_current)
  65. dsubu k1, k0
  66. lui k0, %hi(kernelsp)
  67. daddu k1, k0
  68. LONG_L k1, %lo(kernelsp)(k1)
  69. #endif
  70. #if defined(CONFIG_64BIT) && defined(CONFIG_BUILD_ELF64)
  71. MFC0 k1, CP0_CONTEXT
  72. lui k0, %highest(kernelsp)
  73. dsrl k1, 23
  74. daddiu k0, %higher(kernelsp)
  75. dsll k0, k0, 16
  76. daddiu k0, %hi(kernelsp)
  77. dsll k0, k0, 16
  78. daddu k1, k1, k0
  79. LONG_L k1, %lo(kernelsp)(k1)
  80. #endif
  81. .endm
  82. .macro set_saved_sp stackp temp temp2
  83. #ifdef CONFIG_32BIT
  84. mfc0 \temp, CP0_CONTEXT
  85. srl \temp, 23
  86. LONG_S \stackp, kernelsp(\temp)
  87. #endif
  88. #if defined(CONFIG_64BIT) && !defined(CONFIG_BUILD_ELF64)
  89. lw \temp, TI_CPU(gp)
  90. dsll \temp, 3
  91. lui \temp2, %hi(kernelsp)
  92. daddu \temp, \temp2
  93. LONG_S \stackp, %lo(kernelsp)(\temp)
  94. #endif
  95. #if defined(CONFIG_64BIT) && defined(CONFIG_BUILD_ELF64)
  96. MFC0 \temp, CP0_CONTEXT
  97. dsrl \temp, 23
  98. LONG_S \stackp, kernelsp(\temp)
  99. #endif
  100. .endm
  101. #else
  102. .macro get_saved_sp /* Uniprocessor variation */
  103. lui k1, %hi(kernelsp)
  104. LONG_L k1, %lo(kernelsp)(k1)
  105. .endm
  106. .macro set_saved_sp stackp temp temp2
  107. LONG_S \stackp, kernelsp
  108. .endm
  109. #endif
  110. .macro SAVE_SOME
  111. .set push
  112. .set noat
  113. .set reorder
  114. mfc0 k0, CP0_STATUS
  115. sll k0, 3 /* extract cu0 bit */
  116. .set noreorder
  117. bltz k0, 8f
  118. move k1, sp
  119. .set reorder
  120. /* Called from user mode, new stack. */
  121. get_saved_sp
  122. 8: move k0, sp
  123. PTR_SUBU sp, k1, PT_SIZE
  124. LONG_S k0, PT_R29(sp)
  125. LONG_S $3, PT_R3(sp)
  126. LONG_S $0, PT_R0(sp)
  127. mfc0 v1, CP0_STATUS
  128. LONG_S $2, PT_R2(sp)
  129. LONG_S v1, PT_STATUS(sp)
  130. LONG_S $4, PT_R4(sp)
  131. mfc0 v1, CP0_CAUSE
  132. LONG_S $5, PT_R5(sp)
  133. LONG_S v1, PT_CAUSE(sp)
  134. LONG_S $6, PT_R6(sp)
  135. MFC0 v1, CP0_EPC
  136. LONG_S $7, PT_R7(sp)
  137. #ifdef CONFIG_64BIT
  138. LONG_S $8, PT_R8(sp)
  139. LONG_S $9, PT_R9(sp)
  140. #endif
  141. LONG_S v1, PT_EPC(sp)
  142. LONG_S $25, PT_R25(sp)
  143. LONG_S $28, PT_R28(sp)
  144. LONG_S $31, PT_R31(sp)
  145. ori $28, sp, _THREAD_MASK
  146. xori $28, _THREAD_MASK
  147. .set pop
  148. .endm
  149. .macro SAVE_ALL
  150. SAVE_SOME
  151. SAVE_AT
  152. SAVE_TEMP
  153. SAVE_STATIC
  154. .endm
  155. .macro RESTORE_AT
  156. .set push
  157. .set noat
  158. LONG_L $1, PT_R1(sp)
  159. .set pop
  160. .endm
  161. .macro RESTORE_TEMP
  162. LONG_L $24, PT_LO(sp)
  163. #ifdef CONFIG_32BIT
  164. LONG_L $8, PT_R8(sp)
  165. LONG_L $9, PT_R9(sp)
  166. #endif
  167. mtlo $24
  168. LONG_L $24, PT_HI(sp)
  169. LONG_L $10, PT_R10(sp)
  170. LONG_L $11, PT_R11(sp)
  171. mthi $24
  172. LONG_L $12, PT_R12(sp)
  173. LONG_L $13, PT_R13(sp)
  174. LONG_L $14, PT_R14(sp)
  175. LONG_L $15, PT_R15(sp)
  176. LONG_L $24, PT_R24(sp)
  177. .endm
  178. .macro RESTORE_STATIC
  179. LONG_L $16, PT_R16(sp)
  180. LONG_L $17, PT_R17(sp)
  181. LONG_L $18, PT_R18(sp)
  182. LONG_L $19, PT_R19(sp)
  183. LONG_L $20, PT_R20(sp)
  184. LONG_L $21, PT_R21(sp)
  185. LONG_L $22, PT_R22(sp)
  186. LONG_L $23, PT_R23(sp)
  187. LONG_L $30, PT_R30(sp)
  188. .endm
  189. #if defined(CONFIG_CPU_R3000) || defined(CONFIG_CPU_TX39XX)
  190. .macro RESTORE_SOME
  191. .set push
  192. .set reorder
  193. .set noat
  194. mfc0 a0, CP0_STATUS
  195. ori a0, 0x1f
  196. xori a0, 0x1f
  197. mtc0 a0, CP0_STATUS
  198. li v1, 0xff00
  199. and a0, v1
  200. LONG_L v0, PT_STATUS(sp)
  201. nor v1, $0, v1
  202. and v0, v1
  203. or v0, a0
  204. mtc0 v0, CP0_STATUS
  205. LONG_L $31, PT_R31(sp)
  206. LONG_L $28, PT_R28(sp)
  207. LONG_L $25, PT_R25(sp)
  208. #ifdef CONFIG_64BIT
  209. LONG_L $8, PT_R8(sp)
  210. LONG_L $9, PT_R9(sp)
  211. #endif
  212. LONG_L $7, PT_R7(sp)
  213. LONG_L $6, PT_R6(sp)
  214. LONG_L $5, PT_R5(sp)
  215. LONG_L $4, PT_R4(sp)
  216. LONG_L $3, PT_R3(sp)
  217. LONG_L $2, PT_R2(sp)
  218. .set pop
  219. .endm
  220. .macro RESTORE_SP_AND_RET
  221. .set push
  222. .set noreorder
  223. LONG_L k0, PT_EPC(sp)
  224. LONG_L sp, PT_R29(sp)
  225. jr k0
  226. rfe
  227. .set pop
  228. .endm
  229. #else
  230. .macro RESTORE_SOME
  231. .set push
  232. .set reorder
  233. .set noat
  234. mfc0 a0, CP0_STATUS
  235. ori a0, 0x1f
  236. xori a0, 0x1f
  237. mtc0 a0, CP0_STATUS
  238. li v1, 0xff00
  239. and a0, v1
  240. LONG_L v0, PT_STATUS(sp)
  241. nor v1, $0, v1
  242. and v0, v1
  243. or v0, a0
  244. mtc0 v0, CP0_STATUS
  245. LONG_L v1, PT_EPC(sp)
  246. MTC0 v1, CP0_EPC
  247. LONG_L $31, PT_R31(sp)
  248. LONG_L $28, PT_R28(sp)
  249. LONG_L $25, PT_R25(sp)
  250. #ifdef CONFIG_64BIT
  251. LONG_L $8, PT_R8(sp)
  252. LONG_L $9, PT_R9(sp)
  253. #endif
  254. LONG_L $7, PT_R7(sp)
  255. LONG_L $6, PT_R6(sp)
  256. LONG_L $5, PT_R5(sp)
  257. LONG_L $4, PT_R4(sp)
  258. LONG_L $3, PT_R3(sp)
  259. LONG_L $2, PT_R2(sp)
  260. .set pop
  261. .endm
  262. .macro RESTORE_SP_AND_RET
  263. LONG_L sp, PT_R29(sp)
  264. .set mips3
  265. eret
  266. .set mips0
  267. .endm
  268. #endif
  269. .macro RESTORE_SP
  270. LONG_L sp, PT_R29(sp)
  271. .endm
  272. .macro RESTORE_ALL
  273. RESTORE_TEMP
  274. RESTORE_STATIC
  275. RESTORE_AT
  276. RESTORE_SOME
  277. RESTORE_SP
  278. .endm
  279. .macro RESTORE_ALL_AND_RET
  280. RESTORE_TEMP
  281. RESTORE_STATIC
  282. RESTORE_AT
  283. RESTORE_SOME
  284. RESTORE_SP_AND_RET
  285. .endm
  286. /*
  287. * Move to kernel mode and disable interrupts.
  288. * Set cp0 enable bit as sign that we're running on the kernel stack
  289. */
  290. .macro CLI
  291. mfc0 t0, CP0_STATUS
  292. li t1, ST0_CU0 | 0x1f
  293. or t0, t1
  294. xori t0, 0x1f
  295. mtc0 t0, CP0_STATUS
  296. irq_disable_hazard
  297. .endm
  298. /*
  299. * Move to kernel mode and enable interrupts.
  300. * Set cp0 enable bit as sign that we're running on the kernel stack
  301. */
  302. .macro STI
  303. mfc0 t0, CP0_STATUS
  304. li t1, ST0_CU0 | 0x1f
  305. or t0, t1
  306. xori t0, 0x1e
  307. mtc0 t0, CP0_STATUS
  308. irq_enable_hazard
  309. .endm
  310. /*
  311. * Just move to kernel mode and leave interrupts as they are.
  312. * Set cp0 enable bit as sign that we're running on the kernel stack
  313. */
  314. .macro KMODE
  315. mfc0 t0, CP0_STATUS
  316. li t1, ST0_CU0 | 0x1e
  317. or t0, t1
  318. xori t0, 0x1e
  319. mtc0 t0, CP0_STATUS
  320. irq_disable_hazard
  321. .endm
  322. #endif /* _ASM_STACKFRAME_H */