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 *  |    d8     |    d9     |    d10    |    d11    |  *
15 *  -------------------------------------------------  *
16 *  -------------------------------------------------  *
17 *  |  8  |  9  |  10 |  11 |  12 |  13 |  14 |  15 |  *
18 *  -------------------------------------------------  *
19 *  | 0x20| 0x24| 0x28| 0x2c| 0x30| 0x34| 0x38| 0x3c|  *
20 *  -------------------------------------------------  *
21 *  |    d12    |    d13    |    d14    |    d15    |  *
22 *  -------------------------------------------------  *
23 *  -------------------------------------------------  *
24 *  |  16 |  17 |  18 |  19 |  20 |  21 |  22 |  23 |  *
25 *  -------------------------------------------------  *
26 *  | 0x40| 0x44| 0x48| 0x4c| 0x50| 0x54| 0x58| 0x5c|  *
27 *  -------------------------------------------------  *
28 *  |    x19    |    x20    |    x21    |    x22    |  *
29 *  -------------------------------------------------  *
30 *  -------------------------------------------------  *
31 *  |  24 |  25 |  26 |  27 |  28 |  29 |  30 |  31 |  *
32 *  -------------------------------------------------  *
33 *  | 0x60| 0x64| 0x68| 0x6c| 0x70| 0x74| 0x78| 0x7c|  *
34 *  -------------------------------------------------  *
35 *  |    x23    |    x24    |    x25    |    x26    |  *
36 *  -------------------------------------------------  *
37 *  -------------------------------------------------  *
38 *  |  32 |  33 |  34 |  35 |  36 |  37 |  38 |  39 |  *
39 *  -------------------------------------------------  *
40 *  | 0x80| 0x84| 0x88| 0x8c| 0x90| 0x94| 0x98| 0x9c|  *
41 *  -------------------------------------------------  *
42 *  |    x27    |    x28    |    FP     |     LR    |  *
43 *  -------------------------------------------------  *
44 *  -------------------------------------------------  *
45 *  |  40 |  41 |  42 | 43  |           |           |  *
46 *  -------------------------------------------------  *
47 *  | 0xa0| 0xa4| 0xa8| 0xac|           |           |  *
48 *  -------------------------------------------------  *
49 *  |     PC    |   align   |           |           |  *
50 *  -------------------------------------------------  *
51 *                                                     *
52 *******************************************************/
53
54.file "jump_arm64_aapcs_elf_gas.S"
55.text
56.align  2
57.global jump_fcontext
58.type   jump_fcontext, %function
59jump_fcontext:
60    # prepare stack for GP + FPU
61    sub  sp, sp, #0xb0
62
63    # save d8 - d15
64    stp  d8,  d9,  [sp, #0x00]
65    stp  d10, d11, [sp, #0x10]
66    stp  d12, d13, [sp, #0x20]
67    stp  d14, d15, [sp, #0x30]
68
69    # save x19-x30
70    stp  x19, x20, [sp, #0x40]
71    stp  x21, x22, [sp, #0x50]
72    stp  x23, x24, [sp, #0x60]
73    stp  x25, x26, [sp, #0x70]
74    stp  x27, x28, [sp, #0x80]
75    stp  x29, x30, [sp, #0x90]
76
77    # save LR as PC
78    str  x30, [sp, #0xa0]
79
80    # store RSP (pointing to context-data) in X0
81    mov  x4, sp
82
83    # restore RSP (pointing to context-data) from X1
84    mov  sp, x0
85
86    # load d8 - d15
87    ldp  d8,  d9,  [sp, #0x00]
88    ldp  d10, d11, [sp, #0x10]
89    ldp  d12, d13, [sp, #0x20]
90    ldp  d14, d15, [sp, #0x30]
91
92    # load x19-x30
93    ldp  x19, x20, [sp, #0x40]
94    ldp  x21, x22, [sp, #0x50]
95    ldp  x23, x24, [sp, #0x60]
96    ldp  x25, x26, [sp, #0x70]
97    ldp  x27, x28, [sp, #0x80]
98    ldp  x29, x30, [sp, #0x90]
99
100    # return transfer_t from jump
101    # pass transfer_t as first arg in context function
102    # X0 == FCTX, X1 == DATA
103    mov x0, x4
104
105    # load pc
106    ldr  x4, [sp, #0xa0]
107
108    # restore stack from GP + FPU
109    add  sp, sp, #0xb0
110
111    ret x4
112.size   jump_fcontext,.-jump_fcontext
113# Mark that we don't need executable stack.
114.section .note.GNU-stack,"",%progbits
115