87 lines
2.5 KiB
NASM
87 lines
2.5 KiB
NASM
;/*
|
|
; Copyright Oliver Kowalke 2009.
|
|
; 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| *
|
|
; * ------------------------------------------------- *
|
|
; * |deall|limit| base|hiddn| v1 | v2 | v3 | v4 | *
|
|
; * ------------------------------------------------- *
|
|
; * ------------------------------------------------- *
|
|
; * | 8 | 9 | 10 | 11 | 12 | 13 | 14 | 15 | *
|
|
; * ------------------------------------------------- *
|
|
; * | 0x20| 0x24| 0x28| 0x2c| 0x30| 0x34| 0x38| 0x3c| *
|
|
; * ------------------------------------------------- *
|
|
; * | v5 | v6 | v7 | v8 | lr | pc | FCTX| DATA| *
|
|
; * ------------------------------------------------- *
|
|
; * *
|
|
; *******************************************************
|
|
|
|
AREA |.text|, CODE
|
|
ALIGN 4
|
|
EXPORT ostd_ontop_fcontext
|
|
|
|
ostd_ontop_fcontext PROC
|
|
; save LR as PC
|
|
push {lr}
|
|
; save hidden,V1-V8,LR
|
|
push {a1,v1-v8,lr}
|
|
|
|
; load TIB to save/restore thread size and limit.
|
|
; we do not need preserve CPU flag and can use it's arg register
|
|
mrc p15, #0, v1, c13, c0, #2
|
|
|
|
; save current stack base
|
|
ldr a1, [v1, #0x04]
|
|
push {a1}
|
|
; save current stack limit
|
|
ldr a1, [v1, #0x08]
|
|
push {a1}
|
|
; save current deallocation stack
|
|
ldr a1, [v1, #0xe0c]
|
|
push {a1}
|
|
|
|
; store RSP (pointing to context-data) in A1
|
|
mov a1, sp
|
|
|
|
; restore RSP (pointing to context-data) from A2
|
|
mov sp, a2
|
|
|
|
; restore stack base
|
|
pop {a1}
|
|
str a1, [v1, #0x04]
|
|
; restore stack limit
|
|
pop {a1}
|
|
str a1, [v1, #0x08]
|
|
; restore deallocation stack
|
|
pop {a1}
|
|
str a1, [v1, #0xe0c]
|
|
|
|
; store parent context in A2
|
|
mov a2, a1
|
|
|
|
; restore hidden,V1-V8,LR
|
|
pop {a1,v1-v8,lr}
|
|
|
|
; return transfer_t from jump
|
|
str a2, [a1, #0]
|
|
str a3, [a1, #4]
|
|
; pass transfer_t as first arg in context function
|
|
; A1 == hidden, A2 == FCTX, A3 == DATA
|
|
|
|
; skip PC
|
|
add sp, sp, #4
|
|
|
|
; jump to ontop-function
|
|
bx a4
|
|
|
|
ENDP
|
|
END
|