context_gcc.h 2.1 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677
  1. /*
  2. * Copyright (c) 2006-2020, RT-Thread Development Team
  3. *
  4. * SPDX-License-Identifier: Apache-2.0
  5. *
  6. * Change Logs:
  7. * Date Author Notes
  8. * 2024-03-28 Shell Move vector handling codes from context_gcc.S
  9. */
  10. #ifndef __ARM64_INC_CONTEXT_H__
  11. #define __ARM64_INC_CONTEXT_H__
  12. .macro SAVE_CONTEXT_SWITCH
  13. /* Save the entire context. */
  14. SAVE_FPU sp
  15. stp x0, x1, [sp, #-0x10]!
  16. stp x2, x3, [sp, #-0x10]!
  17. stp x4, x5, [sp, #-0x10]!
  18. stp x6, x7, [sp, #-0x10]!
  19. stp x8, x9, [sp, #-0x10]!
  20. stp x10, x11, [sp, #-0x10]!
  21. stp x12, x13, [sp, #-0x10]!
  22. stp x14, x15, [sp, #-0x10]!
  23. stp x16, x17, [sp, #-0x10]!
  24. stp x18, x19, [sp, #-0x10]!
  25. stp x20, x21, [sp, #-0x10]!
  26. stp x22, x23, [sp, #-0x10]!
  27. stp x24, x25, [sp, #-0x10]!
  28. stp x26, x27, [sp, #-0x10]!
  29. stp x28, x29, [sp, #-0x10]!
  30. mrs x28, fpcr
  31. mrs x29, fpsr
  32. stp x28, x29, [sp, #-0x10]!
  33. mrs x29, sp_el0
  34. stp x29, x30, [sp, #-0x10]!
  35. mov x19, #((3 << 6) | 0x4 | 0x1) /* el1h, disable interrupt */
  36. mov x18, x30
  37. stp x18, x19, [sp, #-0x10]!
  38. .endm
  39. .macro _RESTORE_CONTEXT_SWITCH
  40. ldp x2, x3, [sp], #0x10 /* SPSR and ELR. */
  41. tst x3, #0x1f
  42. msr spsr_el1, x3
  43. msr elr_el1, x2
  44. ldp x29, x30, [sp], #0x10
  45. msr sp_el0, x29
  46. ldp x28, x29, [sp], #0x10
  47. msr fpcr, x28
  48. msr fpsr, x29
  49. ldp x28, x29, [sp], #0x10
  50. ldp x26, x27, [sp], #0x10
  51. ldp x24, x25, [sp], #0x10
  52. ldp x22, x23, [sp], #0x10
  53. ldp x20, x21, [sp], #0x10
  54. ldp x18, x19, [sp], #0x10
  55. ldp x16, x17, [sp], #0x10
  56. ldp x14, x15, [sp], #0x10
  57. ldp x12, x13, [sp], #0x10
  58. ldp x10, x11, [sp], #0x10
  59. ldp x8, x9, [sp], #0x10
  60. ldp x6, x7, [sp], #0x10
  61. ldp x4, x5, [sp], #0x10
  62. ldp x2, x3, [sp], #0x10
  63. ldp x0, x1, [sp], #0x10
  64. RESTORE_FPU sp
  65. #ifdef RT_USING_SMART
  66. beq arch_ret_to_user
  67. #endif
  68. eret
  69. .endm
  70. #endif /* __ARM64_INC_CONTEXT_H__ */