1 /* 2 * Copyright (c) 2016, ARM Limited and Contributors. All rights reserved. 3 * 4 * SPDX-License-Identifier: BSD-3-Clause 5 */ 6 7 #include <asm_macros.S> 8 9 .macro push ra, rb, sp=sp 10 stp \ra, \rb, [\sp,#-16]! 11 .endm 12 13 .macro pop ra, rb, sp=sp 14 ldp \ra, \rb, [\sp], #16 15 .endm 16 17 .global trusty_context_switch_helper 18 func trusty_context_switch_helper 19 push x8, xzr 20 push x19, x20 21 push x21, x22 22 push x23, x24 23 push x25, x26 24 push x27, x28 25 push x29, x30 26 27 mov x9, sp 28 ldr x10, [x0] 29 mov sp, x10 30 str x9, [x0] 31 32 pop x29, x30 33 pop x27, x28 34 pop x25, x26 35 pop x23, x24 36 pop x21, x22 37 pop x19, x20 38 pop x8, xzr 39 40 ldr x2, [x1] 41 ldr x3, [x1, #0x08] 42 ldr x4, [x1, #0x10] 43 ldr x5, [x1, #0x18] 44 ldr x6, [x1, #0x20] 45 ldr x7, [x1, #0x28] 46 ldr x10, [x1, #0x30] 47 ldr x11, [x1, #0x38] 48 49 stp x2, x3, [x8] 50 stp x4, x5, [x8, #16] 51 stp x6, x7, [x8, #32] 52 stp x10, x11, [x8, #48] 53 54 ret 55 endfunc trusty_context_switch_helper 56 57 .global trusty_init_context_stack 58 func trusty_init_context_stack 59 push x8, xzr, x1 60 push xzr, xzr, x1 61 push xzr, xzr, x1 62 push xzr, xzr, x1 63 push xzr, xzr, x1 64 push xzr, xzr, x1 65 adr x9, el3_exit 66 push xzr, x9, x1 67 str x1, [x0] 68 ret 69 endfunc trusty_init_context_stack 70
