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_kernel_stack(int level) 58 { 59 struct unwind_state_arm64 state; 60 61 memset(&state, 0, sizeof(state)); 62 state.pc = read_pc(); 63 state.fp = read_fp(); 64 65 do { 66 switch (level) { 67 case TRACE_FLOW: 68 FMSG_RAW("pc 0x%016" PRIx64, state.pc); 69 break; 70 case TRACE_DEBUG: 71 DMSG_RAW("pc 0x%016" PRIx64, state.pc); 72 break; 73 case TRACE_INFO: 74 IMSG_RAW("pc 0x%016" PRIx64, state.pc); 75 break; 76 case TRACE_ERROR: 77 EMSG_RAW("pc 0x%016" PRIx64, state.pc); 78 break; 79 default: 80 break; 81 } 82 } while (unwind_stack_arm64(&state, 0, 0)); 83 } 84 85 #endif 86