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