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(struct unwind_state *frame) 38 { 39 uint64_t fp; 40 41 fp = frame->fp; 42 if (!thread_addr_is_in_stack(fp)) 43 return false; 44 45 frame->sp = fp + 0x10; 46 /* FP to previous frame (X29) */ 47 frame->fp = *(uint64_t *)(fp); 48 /* LR (X30) */ 49 frame->pc = *(uint64_t *)(fp + 8) - 4; 50 51 return true; 52 } 53 54 #if defined(CFG_CORE_UNWIND) && (TRACE_LEVEL > 0) 55 56 void print_stack(int level) 57 { 58 struct unwind_state state; 59 60 memset(&state, 0, sizeof(state)); 61 state.pc = read_pc(); 62 state.fp = read_fp(); 63 64 do { 65 switch (level) { 66 case TRACE_FLOW: 67 FMSG_RAW("pc 0x%016" PRIx64, state.pc); 68 break; 69 case TRACE_DEBUG: 70 DMSG_RAW("pc 0x%016" PRIx64, state.pc); 71 break; 72 case TRACE_INFO: 73 IMSG_RAW("pc 0x%016" PRIx64, state.pc); 74 break; 75 case TRACE_ERROR: 76 EMSG_RAW("pc 0x%016" PRIx64, state.pc); 77 break; 78 default: 79 break; 80 } 81 } while (unwind_stack(&state)); 82 } 83 84 #endif /* defined(CFG_CORE_UNWIND) && (TRACE_LEVEL > 0) */ 85