use core::mem;
use stack::Stack;
pub const STACK_ALIGNMENT: usize = 16;
#[derive(Debug, Clone, Copy)]
pub struct StackPointer(*mut usize);
pub unsafe fn init(stack: &Stack, f: unsafe extern "C" fn(usize, StackPointer) -> !) -> StackPointer {
#[cfg(not(target_vendor = "apple"))]
#[naked]
unsafe extern "C" fn trampoline_1() {
asm!(
r#"
# gdb has a hardcoded check that rejects backtraces where frame addresses
# do not monotonically decrease. It is turned off if the function is called
# "__morestack" and that is hardcoded. So, to make gdb backtraces match
# the actual unwinder behavior, we call ourselves "__morestack" and mark
# the symbol as local; it shouldn't interfere with anything.
__morestack:
.local __morestack
# Set up the first part of our DWARF CFI linking stacks together. When
# we reach this function from unwinding, x29 will be pointing at the bottom
# of the parent linked stack. This link is set each time swap() is called.
# When unwinding the frame corresponding to this function, a DWARF unwinder
# will use x29+16 as the next call frame address, restore return address (x30)
# from CFA-8 and restore x29 from CFA-16. This mirrors what the second half
# of `swap_trampoline` does.
.cfi_def_cfa x29, 16
.cfi_offset x30, -8
.cfi_offset x29, -16
# This nop is here so that the initial swap doesn't return to the start
# of the trampoline, which confuses the unwinder since it will look for
# frame information in the previous symbol rather than this one. It is
# never actually executed.
nop
.Lend:
.size __morestack, .Lend-__morestack
"#
: : : : "volatile")
}
#[cfg(target_vendor = "apple")]
#[naked]
unsafe extern "C" fn trampoline_1() {
asm!(
r#"
# Identical to the above, except avoids .local/.size that aren't available on Mach-O.
__morestack:
.private_extern __morestack
.cfi_def_cfa x29, 16
.cfi_offset x30, -8
.cfi_offset x29, -16
nop
"#
: : : : "volatile")
}
#[naked]
unsafe extern "C" fn trampoline_2() {
asm!(
r#"
# Set up the second part of our DWARF CFI.
# When unwinding the frame corresponding to this function, a DWARF unwinder
# will restore x29 (and thus CFA of the first trampoline) from the stack slot.
# This stack slot is updated every time swap() is called to point to the bottom
# of the stack of the context switch just switched from.
.cfi_def_cfa x29, 16
.cfi_offset x30, -8
.cfi_offset x29, -16
# This nop is here so that the return address of the swap trampoline
# doesn't point to the start of the symbol. This confuses gdb's backtraces,
# causing them to think the parent function is trampoline_1 instead of
# trampoline_2.
nop
# Call the provided function.
ldr x2, [sp, #16]
blr x2
"#
: : : : "volatile")
}
unsafe fn push(sp: &mut StackPointer, val: usize) {
sp.0 = sp.0.offset(-1);
*sp.0 = val
}
let mut sp = StackPointer(stack.base() as *mut usize);
push(&mut sp, 0 as usize); push(&mut sp, f as usize);
push(&mut sp, trampoline_1 as usize + 4); push(&mut sp, 0xdeaddeaddead0cfa);
let frame = sp;
push(&mut sp, trampoline_2 as usize + 4); push(&mut sp, frame.0 as usize);
sp
}
#[inline(always)]
pub unsafe fn swap(arg: usize, new_sp: StackPointer,
new_stack: Option<&Stack>) -> (usize, StackPointer) {
let mut dummy: usize = mem::uninitialized();
let new_cfa = if let Some(new_stack) = new_stack {
(new_stack.base() as *mut usize).offset(-4)
} else {
&mut dummy
};
let ret: usize;
let ret_sp: *mut usize;
asm!(
r#"
# Set up the link register
adr lr, 0f
# Save the frame pointer and link register; the unwinder uses them to find
# the CFA of the caller, and so they have to have the correct value immediately
# after the call instruction that invoked the trampoline.
stp x29, x30, [sp, #-16]!
# Pass the stack pointer of the old context to the new one.
mov x1, sp
# Link the call stacks together by writing the current stack bottom
# address to the CFA slot in the new stack.
str x1, [x3]
# Load stack pointer of the new context.
mov sp, x2
# Load frame and instruction pointers of the new context.
ldp x29, x30, [sp], #16
# Return into the new context. Use `br` instead of a `ret` to avoid
# return address mispredictions.
br x30
0:
"#
: "={x0}" (ret)
"={x1}" (ret_sp)
: "{x0}" (arg)
"{x2}" (new_sp.0)
"{x3}" (new_cfa)
:"x2", "x3", "x4", "x5", "x6", "x7",
"x8", "x9", "x10", "x11", "x12", "x13", "x14", "x15",
"x16", "x17", "x18", "x19", "x20", "x21", "x22", "x23",
"x24", "x25", "x26", "x27", "x28", "lr",
"v0", "v1", "v2", "v3", "v4", "v5", "v6", "v7",
"v8", "v9", "v10", "v11", "v12", "v13", "v14", "v15",
"v16", "v17", "v18", "v19", "v20", "v21", "v22", "v23",
"v24", "v25", "v26", "v27", "v28", "v29", "v30", "v31",
"cc", "memory"
: "volatile", "alignstack");
(ret, StackPointer(ret_sp))
}