|
@@ -0,0 +1,87 @@
|
|
|
+/*
|
|
|
+ Copyright Edward Nevill + Oliver Kowalke 2015
|
|
|
+ Distributed under the Boost Software License, Version 1.0.
|
|
|
+ (See accompanying file LICENSE_1_0.txt or copy at
|
|
|
+ http://www.boost.org/LICENSE_1_0.txt)
|
|
|
+*/
|
|
|
+/*******************************************************
|
|
|
+ * *
|
|
|
+ * ------------------------------------------------- *
|
|
|
+ * | 0 | 1 | 2 | 3 | 4 | 5 | 6 | 7 | *
|
|
|
+ * ------------------------------------------------- *
|
|
|
+ * | 0x0 | 0x4 | 0x8 | 0xc | 0x10| 0x14| 0x18| 0x1c| *
|
|
|
+ * ------------------------------------------------- *
|
|
|
+ * | x19 | x20 | x21 | x22 | *
|
|
|
+ * ------------------------------------------------- *
|
|
|
+ * ------------------------------------------------- *
|
|
|
+ * | 8 | 9 | 10 | 11 | 12 | 13 | 14 | 15 | *
|
|
|
+ * ------------------------------------------------- *
|
|
|
+ * | 0x20| 0x24| 0x28| 0x2c| 0x30| 0x34| 0x38| 0x3c| *
|
|
|
+ * ------------------------------------------------- *
|
|
|
+ * | x23 | x24 | x25 | x26 | *
|
|
|
+ * ------------------------------------------------- *
|
|
|
+ * ------------------------------------------------- *
|
|
|
+ * | 16 | 17 | 18 | 19 | 20 | 21 | 22 | 23 | *
|
|
|
+ * ------------------------------------------------- *
|
|
|
+ * | 0x40| 0x44| 0x48| 0x4c| 0x50| 0x54| 0x58| 0x5c| *
|
|
|
+ * ------------------------------------------------- *
|
|
|
+ * | x27 | x28 | FP | LR | *
|
|
|
+ * ------------------------------------------------- *
|
|
|
+ * ------------------------------------------------- *
|
|
|
+ * | 24 | 25 | 26 | 27 | 28 | 29 | 30 | 31 | *
|
|
|
+ * ------------------------------------------------- *
|
|
|
+ * | 0x60| 0x64| 0x68| 0x6c| 0x70| 0x74| 0x78| 0x7c| *
|
|
|
+ * ------------------------------------------------- *
|
|
|
+ * | PC | align | | | *
|
|
|
+ * ------------------------------------------------- *
|
|
|
+ * *
|
|
|
+ *******************************************************/
|
|
|
+
|
|
|
+# .cpu generic+fp+simd
|
|
|
+.text
|
|
|
+.align 2
|
|
|
+.global ontop_fcontext
|
|
|
+.type ontop_fcontext, %function
|
|
|
+ontop_fcontext:
|
|
|
+ # prepare stack for GP + FPU
|
|
|
+ sub sp, sp, #0x70
|
|
|
+
|
|
|
+ # save x19-x30
|
|
|
+ stp x19, x20, [sp, #0x00]
|
|
|
+ stp x21, x22, [sp, #0x10]
|
|
|
+ stp x23, x24, [sp, #0x20]
|
|
|
+ stp x25, x26, [sp, #0x30]
|
|
|
+ stp x27, x28, [sp, #0x40]
|
|
|
+ stp x29, x30, [sp, #0x50]
|
|
|
+
|
|
|
+ # save LR as PC
|
|
|
+ str x30, [sp, #0x60]
|
|
|
+
|
|
|
+ # store RSP (pointing to context-data) in X5
|
|
|
+ mov x4, sp
|
|
|
+
|
|
|
+ # restore RSP (pointing to context-data) from X1
|
|
|
+ mov sp, x0
|
|
|
+
|
|
|
+ # load x19-x30
|
|
|
+ ldp x19, x20, [sp, #0x00]
|
|
|
+ ldp x21, x22, [sp, #0x10]
|
|
|
+ ldp x23, x24, [sp, #0x20]
|
|
|
+ ldp x25, x26, [sp, #0x30]
|
|
|
+ ldp x27, x28, [sp, #0x40]
|
|
|
+ ldp x29, x30, [sp, #0x50]
|
|
|
+
|
|
|
+ # return transfer_t from jump
|
|
|
+ # pass transfer_t as first arg in context function
|
|
|
+ # X0 == FCTX, X1 == DATA
|
|
|
+ mov x0, x4
|
|
|
+
|
|
|
+ # skip pc
|
|
|
+ # restore stack from GP + FPU
|
|
|
+ add sp, sp, #0x70
|
|
|
+
|
|
|
+ # jump to ontop-function
|
|
|
+ ret x2
|
|
|
+.size ontop_fcontext,.-ontop_fcontext
|
|
|
+# Mark that we don't need executable stack.
|
|
|
+.section .note.GNU-stack,"",%progbits
|