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