1*e1a6547dSJerome Forissier // SPDX-License-Identifier: BSD-2-Clause 2*e1a6547dSJerome Forissier /*- 3*e1a6547dSJerome Forissier * Copyright (c) 2015-2019 Linaro Limited 4*e1a6547dSJerome Forissier * Copyright (c) 2015 The FreeBSD Foundation 5*e1a6547dSJerome Forissier * All rights reserved. 6*e1a6547dSJerome Forissier * 7*e1a6547dSJerome Forissier * This software was developed by Semihalf under 8*e1a6547dSJerome Forissier * the sponsorship of the FreeBSD Foundation. 9*e1a6547dSJerome Forissier * 10*e1a6547dSJerome Forissier * Redistribution and use in source and binary forms, with or without 11*e1a6547dSJerome Forissier * modification, are permitted provided that the following conditions 12*e1a6547dSJerome Forissier * are met: 13*e1a6547dSJerome Forissier * 1. Redistributions of source code must retain the above copyright 14*e1a6547dSJerome Forissier * notice, this list of conditions and the following disclaimer. 15*e1a6547dSJerome Forissier * 2. Redistributions in binary form must reproduce the above copyright 16*e1a6547dSJerome Forissier * notice, this list of conditions and the following disclaimer in the 17*e1a6547dSJerome Forissier * documentation and/or other materials provided with the distribution. 18*e1a6547dSJerome Forissier * 19*e1a6547dSJerome Forissier * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 20*e1a6547dSJerome Forissier * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 21*e1a6547dSJerome Forissier * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 22*e1a6547dSJerome Forissier * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 23*e1a6547dSJerome Forissier * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 24*e1a6547dSJerome Forissier * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 25*e1a6547dSJerome Forissier * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 26*e1a6547dSJerome Forissier * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 27*e1a6547dSJerome Forissier * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 28*e1a6547dSJerome Forissier * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 29*e1a6547dSJerome Forissier * SUCH DAMAGE. 30*e1a6547dSJerome Forissier */ 31*e1a6547dSJerome Forissier 32*e1a6547dSJerome Forissier #include <compiler.h> 33*e1a6547dSJerome Forissier #include <string.h> 34*e1a6547dSJerome Forissier #include <trace.h> 35*e1a6547dSJerome Forissier #include <types_ext.h> 36*e1a6547dSJerome Forissier #include <unw/unwind.h> 37*e1a6547dSJerome Forissier 38*e1a6547dSJerome Forissier void __weak ftrace_map_lr(uint64_t *lr __unused) 39*e1a6547dSJerome Forissier {} 40*e1a6547dSJerome Forissier 41*e1a6547dSJerome Forissier static bool copy_in_reg(uint64_t *reg, vaddr_t addr) 42*e1a6547dSJerome Forissier { 43*e1a6547dSJerome Forissier memcpy(reg, (void *)addr, sizeof(*reg)); 44*e1a6547dSJerome Forissier return true; 45*e1a6547dSJerome Forissier } 46*e1a6547dSJerome Forissier 47*e1a6547dSJerome Forissier bool unwind_stack_arm64(struct unwind_state_arm64 *frame, 48*e1a6547dSJerome Forissier vaddr_t stack, size_t stack_size) 49*e1a6547dSJerome Forissier { 50*e1a6547dSJerome Forissier vaddr_t fp = frame->fp; 51*e1a6547dSJerome Forissier 52*e1a6547dSJerome Forissier if (fp < stack) 53*e1a6547dSJerome Forissier return false; 54*e1a6547dSJerome Forissier if (fp + sizeof(uint64_t) * 3 > stack + stack_size) 55*e1a6547dSJerome Forissier return false; 56*e1a6547dSJerome Forissier 57*e1a6547dSJerome Forissier frame->sp = fp + 0x10; 58*e1a6547dSJerome Forissier /* FP to previous frame (X29) */ 59*e1a6547dSJerome Forissier if (!copy_in_reg(&frame->fp, fp)) 60*e1a6547dSJerome Forissier return false; 61*e1a6547dSJerome Forissier if (!frame->fp) 62*e1a6547dSJerome Forissier return false; 63*e1a6547dSJerome Forissier /* LR (X30) */ 64*e1a6547dSJerome Forissier if (!copy_in_reg(&frame->pc, fp + 8)) 65*e1a6547dSJerome Forissier return false; 66*e1a6547dSJerome Forissier 67*e1a6547dSJerome Forissier ftrace_map_lr(&frame->pc); 68*e1a6547dSJerome Forissier 69*e1a6547dSJerome Forissier frame->pc -= 4; 70*e1a6547dSJerome Forissier 71*e1a6547dSJerome Forissier return true; 72*e1a6547dSJerome Forissier } 73*e1a6547dSJerome Forissier 74*e1a6547dSJerome Forissier void print_stack_arm64(struct unwind_state_arm64 *state, 75*e1a6547dSJerome Forissier vaddr_t stack, size_t stack_size) 76*e1a6547dSJerome Forissier { 77*e1a6547dSJerome Forissier trace_printf_helper_raw(TRACE_ERROR, true, "Call stack:"); 78*e1a6547dSJerome Forissier 79*e1a6547dSJerome Forissier ftrace_map_lr(&state->pc); 80*e1a6547dSJerome Forissier do { 81*e1a6547dSJerome Forissier trace_printf_helper_raw(TRACE_ERROR, true, " 0x%016" PRIx64, 82*e1a6547dSJerome Forissier state->pc); 83*e1a6547dSJerome Forissier } while (unwind_stack_arm64(state, stack, stack_size)); 84*e1a6547dSJerome Forissier } 85