|
| 1 | +use {UnwindPayload, StackFrames}; |
| 2 | +use registers::{Registers, DwarfRegisterAArch64}; |
| 3 | + |
| 4 | +#[allow(improper_ctypes)] // trampoline just forwards the ptr |
| 5 | +extern "C" { |
| 6 | + #[cfg(not(feature = "nightly"))] |
| 7 | + pub fn unwind_trampoline(payload: *mut UnwindPayload); |
| 8 | + #[cfg(not(feature = "nightly"))] |
| 9 | + fn unwind_lander(regs: *const LandingRegisters); |
| 10 | +} |
| 11 | + |
| 12 | +#[cfg(feature = "nightly")] |
| 13 | +#[naked] |
| 14 | +pub unsafe extern fn unwind_trampoline(_payload: *mut UnwindPayload) { |
| 15 | + asm!(" |
| 16 | + mov x1, sp |
| 17 | + sub sp, sp, 0x70 |
| 18 | + .cfi_adjust_cfa_offset 0x70 |
| 19 | + str lr, [sp, #0x60] |
| 20 | + .cfi_rel_offset lr, 0x60 |
| 21 | + stp x19, x20, [sp, #0x00] |
| 22 | + stp x21, x22, [sp, #0x10] |
| 23 | + stp x23, x24, [sp, #0x20] |
| 24 | + stp x25, x26, [sp, #0x30] |
| 25 | + stp x27, x28, [sp, #0x40] |
| 26 | + stp x29, lr, [sp, #0x50] |
| 27 | + mov x2, sp |
| 28 | + bl unwind_recorder |
| 29 | + ldr lr, [sp, #0x60] |
| 30 | + .cfi_restore lr |
| 31 | + add sp, sp, 0x70 |
| 32 | + .cfi_adjust_cfa_offset -0x70 |
| 33 | + ret |
| 34 | + "); |
| 35 | + ::std::hint::unreachable_unchecked(); |
| 36 | +} |
| 37 | + |
| 38 | +#[cfg(feature = "nightly")] |
| 39 | +#[naked] |
| 40 | +unsafe extern fn unwind_lander(_regs: *const LandingRegisters) { |
| 41 | + asm!(" |
| 42 | + ldp x2, x3, [x0, #0x010] |
| 43 | + ldp x4, x5, [x0, #0x020] |
| 44 | + ldp x6, x7, [x0, #0x030] |
| 45 | + ldp x8, x9, [x0, #0x040] |
| 46 | + ldp x10, x11, [x0, #0x050] |
| 47 | + ldp x12, x13, [x0, #0x060] |
| 48 | + ldp x14, x15, [x0, #0x070] |
| 49 | + ldp x16, x17, [x0, #0x080] |
| 50 | + ldp x18, x19, [x0, #0x090] |
| 51 | + ldp x20, x21, [x0, #0x0A0] |
| 52 | + ldp x22, x23, [x0, #0x0B0] |
| 53 | + ldp x24, x25, [x0, #0x0C0] |
| 54 | + ldp x26, x27, [x0, #0x0D0] |
| 55 | + ldp x28, x29, [x0, #0x0E0] |
| 56 | + ldp x30, x1, [x0, #0x0F0] |
| 57 | + mov x1, sp |
| 58 | +
|
| 59 | + ldp d0, d1, [x0, #0x110] |
| 60 | + ldp d2, d3, [x0, #0x120] |
| 61 | + ldp d4, d5, [x0, #0x130] |
| 62 | + ldp d6, d7, [x0, #0x140] |
| 63 | + ldp d8, d9, [x0, #0x150] |
| 64 | + ldp d10, d11, [x0, #0x160] |
| 65 | + ldp d12, d13, [x0, #0x170] |
| 66 | + ldp d14, d15, [x0, #0x180] |
| 67 | + ldp d16, d17, [x0, #0x190] |
| 68 | + ldp d18, d19, [x0, #0x1A0] |
| 69 | + ldp d20, d21, [x0, #0x1B0] |
| 70 | + ldp d22, d23, [x0, #0x1C0] |
| 71 | + ldp d24, d25, [x0, #0x1D0] |
| 72 | + ldp d26, d27, [x0, #0x1E0] |
| 73 | + ldp d28, d29, [x0, #0x1F0] |
| 74 | + ldr d30, [x0, #0x200] |
| 75 | + ldr d31, [x0, #0x208] |
| 76 | +
|
| 77 | + ldp x0, x1, [x0, #0x000] |
| 78 | + ret x30 // HYPERSPACE JUMP :D |
| 79 | + "); |
| 80 | + ::std::hint::unreachable_unchecked(); |
| 81 | +} |
| 82 | + |
| 83 | +#[repr(C)] |
| 84 | +struct LandingRegisters { |
| 85 | + r: [u64; 29], // x0-x28 |
| 86 | + fp: u64, // x29, Frame Pointer |
| 87 | + lr: u64, // x30, Link Register |
| 88 | + sp: u64, // x31, Stack Pointer |
| 89 | + |
| 90 | + pad: u64, |
| 91 | + vector_half: [u64; 32], // d0-d31 |
| 92 | +} |
| 93 | + |
| 94 | +// TODO: Doc hidden |
| 95 | +#[repr(C)] |
| 96 | +pub struct SavedRegs { |
| 97 | + r: [u64; 11], // x19-x29 |
| 98 | + lr: u64 |
| 99 | +} |
| 100 | + |
| 101 | +// TODO: doc hidden |
| 102 | +#[no_mangle] |
| 103 | +pub unsafe extern "C" fn unwind_recorder(payload: *mut UnwindPayload, stack: u64, saved_regs: *mut SavedRegs) { |
| 104 | + let payload = &mut *payload; |
| 105 | + let saved_regs = &*saved_regs; |
| 106 | + |
| 107 | + let mut registers = Registers::default(); |
| 108 | + for (regnum, v) in saved_regs.r.iter().enumerate() { |
| 109 | + registers[DwarfRegisterAArch64::X19 as u8 + regnum as u8] = Some(*v); |
| 110 | + } |
| 111 | + registers[DwarfRegisterAArch64::SP] = Some(stack); |
| 112 | + registers[DwarfRegisterAArch64::IP] = Some(saved_regs.lr); |
| 113 | + |
| 114 | + let mut frames = StackFrames { |
| 115 | + unwinder: payload.unwinder, |
| 116 | + registers, |
| 117 | + state: None, |
| 118 | + }; |
| 119 | + |
| 120 | + (payload.tracer)(&mut frames); |
| 121 | +} |
| 122 | + |
| 123 | +pub unsafe fn land(regs: &Registers) { |
| 124 | + let mut lr = LandingRegisters { |
| 125 | + r: [0; 29], |
| 126 | + fp: regs[DwarfRegisterAArch64::X29].unwrap_or(0), |
| 127 | + lr: regs[DwarfRegisterAArch64::IP].unwrap_or(0), |
| 128 | + sp: regs[DwarfRegisterAArch64::SP].unwrap_or(0), |
| 129 | + pad: 0, |
| 130 | + vector_half: [0; 32] |
| 131 | + }; |
| 132 | + for (i, v) in lr.r.iter_mut().enumerate() { |
| 133 | + *v = regs[i as u8].unwrap_or(0); |
| 134 | + } |
| 135 | + unwind_lander(&lr); |
| 136 | +} |
0 commit comments