jump.S 3.1 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788
  1. /*
  2. Copyright Edward Nevill + Oliver Kowalke 2015
  3. Distributed under the Boost Software License, Version 1.0.
  4. (See accompanying file LICENSE_1_0.txt or copy at
  5. http://www.boost.org/LICENSE_1_0.txt)
  6. */
  7. /*******************************************************
  8. * *
  9. * ------------------------------------------------- *
  10. * | 0 | 1 | 2 | 3 | 4 | 5 | 6 | 7 | *
  11. * ------------------------------------------------- *
  12. * | 0x0 | 0x4 | 0x8 | 0xc | 0x10| 0x14| 0x18| 0x1c| *
  13. * ------------------------------------------------- *
  14. * | x19 | x20 | x21 | x22 | *
  15. * ------------------------------------------------- *
  16. * ------------------------------------------------- *
  17. * | 8 | 9 | 10 | 11 | 12 | 13 | 14 | 15 | *
  18. * ------------------------------------------------- *
  19. * | 0x20| 0x24| 0x28| 0x2c| 0x30| 0x34| 0x38| 0x3c| *
  20. * ------------------------------------------------- *
  21. * | x23 | x24 | x25 | x26 | *
  22. * ------------------------------------------------- *
  23. * ------------------------------------------------- *
  24. * | 16 | 17 | 18 | 19 | 20 | 21 | 22 | 23 | *
  25. * ------------------------------------------------- *
  26. * | 0x40| 0x44| 0x48| 0x4c| 0x50| 0x54| 0x58| 0x5c| *
  27. * ------------------------------------------------- *
  28. * | x27 | x28 | FP | LR | *
  29. * ------------------------------------------------- *
  30. * ------------------------------------------------- *
  31. * | 24 | 25 | 26 | 27 | 28 | 29 | 30 | 31 | *
  32. * ------------------------------------------------- *
  33. * | 0x60| 0x64| 0x68| 0x6c| 0x70| 0x74| 0x78| 0x7c| *
  34. * ------------------------------------------------- *
  35. * | PC | align | | | *
  36. * ------------------------------------------------- *
  37. * *
  38. *******************************************************/
  39. # .cpu generic+fp+simd
  40. .text
  41. .align 2
  42. .global jump_fcontext
  43. .type jump_fcontext, %function
  44. jump_fcontext:
  45. # prepare stack for GP + FPU
  46. sub sp, sp, #0x70
  47. # save x19-x30
  48. stp x19, x20, [sp, #0x00]
  49. stp x21, x22, [sp, #0x10]
  50. stp x23, x24, [sp, #0x20]
  51. stp x25, x26, [sp, #0x30]
  52. stp x27, x28, [sp, #0x40]
  53. stp x29, x30, [sp, #0x50]
  54. # save LR as PC
  55. str x30, [sp, #0x60]
  56. # store RSP (pointing to context-data) in X0
  57. mov x4, sp
  58. # restore RSP (pointing to context-data) from X1
  59. mov sp, x0
  60. # load x19-x30
  61. ldp x19, x20, [sp, #0x00]
  62. ldp x21, x22, [sp, #0x10]
  63. ldp x23, x24, [sp, #0x20]
  64. ldp x25, x26, [sp, #0x30]
  65. ldp x27, x28, [sp, #0x40]
  66. ldp x29, x30, [sp, #0x50]
  67. # return transfer_t from jump
  68. # pass transfer_t as first arg in context function
  69. # X0 == FCTX, X1 == DATA
  70. mov x0, x4
  71. # load pc
  72. ldr x4, [sp, #0x60]
  73. # restore stack from GP + FPU
  74. add sp, sp, #0x70
  75. ret x4
  76. .size jump_fcontext,.-jump_fcontext
  77. # Mark that we don't need executable stack.
  78. .section .note.GNU-stack,"",%progbits