backtrace-arm.c revision bd57bd00b2172af9f315f2d3d62d68ca369e3666
1501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown/*
2501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown * Copyright (C) 2011 The Android Open Source Project
3501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown *
4501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown * Licensed under the Apache License, Version 2.0 (the "License");
5501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown * you may not use this file except in compliance with the License.
6501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown * You may obtain a copy of the License at
7501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown *
8501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown *      http://www.apache.org/licenses/LICENSE-2.0
9501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown *
10501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown * Unless required by applicable law or agreed to in writing, software
11501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown * distributed under the License is distributed on an "AS IS" BASIS,
12501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
13501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown * See the License for the specific language governing permissions and
14501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown * limitations under the License.
15501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown */
16501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown
17501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown/*
18501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown * Backtracing functions for ARM.
19501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown *
20501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown * This implementation uses the exception unwinding tables provided by
21501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown * the compiler to unwind call frames.  Refer to the ARM Exception Handling ABI
22501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown * documentation (EHABI) for more details about what's going on here.
23501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown *
24501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown * An ELF binary may contain an EXIDX section that provides an index to
25501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown * the exception handling table of each function, sorted by program
26501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown * counter address.
27501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown *
28501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown * This implementation also supports unwinding other processes via ptrace().
29501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown * In that case, the EXIDX section is found by reading the ELF section table
30501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown * structures using ptrace().
31501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown *
32501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown * Because the tables are used for exception handling, it can happen that
33501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown * a given function will not have an exception handling table.  In particular,
349524e4158fbb988b6a5e4f5be68ee10b7e4dd6d8Jeff Brown * exceptions are assumed to only ever be thrown at call sites.  Therefore,
35501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown * by definition leaf functions will not have exception handling tables.
36501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown * This may make unwinding impossible in some cases although we can still get
37501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown * some idea of the call stack by examining the PC and LR registers.
38501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown *
39501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown * As we are only interested in backtrace information, we do not need
40501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown * to perform all of the work of unwinding such as restoring register
41501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown * state and running cleanup functions.  Unwinding is performed virtually on
42501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown * an abstract machine context consisting of just the ARM core registers.
43501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown * Furthermore, we do not run generic "personality functions" because
44501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown * we may not be in a position to execute arbitrary code, especially if
45501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown * we are running in a signal handler or using ptrace()!
46501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown */
47501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown
48501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown#define LOG_TAG "Corkscrew"
49501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown//#define LOG_NDEBUG 0
50501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown
51501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown#include "../backtrace-arch.h"
52501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown#include "../backtrace-helper.h"
53501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown#include "../ptrace-arch.h"
54501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown#include <corkscrew/ptrace.h>
55501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown
56501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown#include <stdlib.h>
57501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown#include <signal.h>
58501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown#include <stdbool.h>
59501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown#include <limits.h>
60501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown#include <errno.h>
61501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown#include <sys/ptrace.h>
62501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown#include <sys/exec_elf.h>
63501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown#include <cutils/log.h>
64501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown
65501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown/* Machine context at the time a signal was raised. */
66501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Browntypedef struct ucontext {
67501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown    uint32_t uc_flags;
68501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown    struct ucontext* uc_link;
69501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown    stack_t uc_stack;
70501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown    struct sigcontext {
71501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown        uint32_t trap_no;
72501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown        uint32_t error_code;
73501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown        uint32_t oldmask;
74501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown        uint32_t gregs[16];
75501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown        uint32_t arm_cpsr;
76501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown        uint32_t fault_address;
77501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown    } uc_mcontext;
78501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown    uint32_t uc_sigmask;
79501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown} ucontext_t;
80501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown
81501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown/* Unwind state. */
82501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Browntypedef struct {
83501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown    uint32_t gregs[16];
84501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown} unwind_state_t;
85501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown
86501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brownstatic const int R_SP = 13;
87501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brownstatic const int R_LR = 14;
88501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brownstatic const int R_PC = 15;
89501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown
90501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown/* Special EXIDX value that indicates that a frame cannot be unwound. */
91501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brownstatic const uint32_t EXIDX_CANTUNWIND = 1;
92501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown
939524e4158fbb988b6a5e4f5be68ee10b7e4dd6d8Jeff Brown/* Get the EXIDX section start and size for the module that contains a
949524e4158fbb988b6a5e4f5be68ee10b7e4dd6d8Jeff Brown * given program counter address.
959524e4158fbb988b6a5e4f5be68ee10b7e4dd6d8Jeff Brown *
969524e4158fbb988b6a5e4f5be68ee10b7e4dd6d8Jeff Brown * When the executable is statically linked, the EXIDX section can be
979524e4158fbb988b6a5e4f5be68ee10b7e4dd6d8Jeff Brown * accessed by querying the values of the __exidx_start and __exidx_end
989524e4158fbb988b6a5e4f5be68ee10b7e4dd6d8Jeff Brown * symbols.
999524e4158fbb988b6a5e4f5be68ee10b7e4dd6d8Jeff Brown *
1009524e4158fbb988b6a5e4f5be68ee10b7e4dd6d8Jeff Brown * When the executable is dynamically linked, the linker exports a function
1019524e4158fbb988b6a5e4f5be68ee10b7e4dd6d8Jeff Brown * called dl_unwind_find_exidx that obtains the EXIDX section for a given
1029524e4158fbb988b6a5e4f5be68ee10b7e4dd6d8Jeff Brown * absolute program counter address.
1039524e4158fbb988b6a5e4f5be68ee10b7e4dd6d8Jeff Brown *
1049524e4158fbb988b6a5e4f5be68ee10b7e4dd6d8Jeff Brown * Bionic exports a helpful function called __gnu_Unwind_Find_exidx that
1059524e4158fbb988b6a5e4f5be68ee10b7e4dd6d8Jeff Brown * handles both cases, so we use that here.
1069524e4158fbb988b6a5e4f5be68ee10b7e4dd6d8Jeff Brown */
1079524e4158fbb988b6a5e4f5be68ee10b7e4dd6d8Jeff Browntypedef long unsigned int* _Unwind_Ptr;
1089524e4158fbb988b6a5e4f5be68ee10b7e4dd6d8Jeff Brownextern _Unwind_Ptr __gnu_Unwind_Find_exidx(_Unwind_Ptr pc, int *pcount);
1099524e4158fbb988b6a5e4f5be68ee10b7e4dd6d8Jeff Brown
1109524e4158fbb988b6a5e4f5be68ee10b7e4dd6d8Jeff Brownstatic uintptr_t find_exidx(uintptr_t pc, size_t* out_exidx_size) {
1119524e4158fbb988b6a5e4f5be68ee10b7e4dd6d8Jeff Brown    int count;
1129524e4158fbb988b6a5e4f5be68ee10b7e4dd6d8Jeff Brown    uintptr_t start = (uintptr_t)__gnu_Unwind_Find_exidx((_Unwind_Ptr)pc, &count);
1139524e4158fbb988b6a5e4f5be68ee10b7e4dd6d8Jeff Brown    *out_exidx_size = count;
1149524e4158fbb988b6a5e4f5be68ee10b7e4dd6d8Jeff Brown    return start;
1159524e4158fbb988b6a5e4f5be68ee10b7e4dd6d8Jeff Brown}
116501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown
117501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown/* Transforms a 31-bit place-relative offset to an absolute address.
118501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown * We assume the most significant bit is clear. */
119501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brownstatic uintptr_t prel_to_absolute(uintptr_t place, uint32_t prel_offset) {
120501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown    return place + (((int32_t)(prel_offset << 1)) >> 1);
121501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown}
122501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown
123501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brownstatic uintptr_t get_exception_handler(
124501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown        const ptrace_context_t* context, pid_t tid, uintptr_t pc) {
125501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown    uintptr_t exidx_start;
126501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown    size_t exidx_size;
127bd57bd00b2172af9f315f2d3d62d68ca369e3666Jeff Brown    const map_info_t* mi;
128501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown    if (tid < 0) {
129bd57bd00b2172af9f315f2d3d62d68ca369e3666Jeff Brown        mi = NULL;
1309524e4158fbb988b6a5e4f5be68ee10b7e4dd6d8Jeff Brown        exidx_start = find_exidx(pc, &exidx_size);
131501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown    } else {
132bd57bd00b2172af9f315f2d3d62d68ca369e3666Jeff Brown        mi = find_map_info(context->map_info_list, pc);
133501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown        if (mi && mi->data) {
134501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            const map_info_data_t* data = (const map_info_data_t*)mi->data;
135501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            exidx_start = data->exidx_start;
136bd57bd00b2172af9f315f2d3d62d68ca369e3666Jeff Brown            exidx_size = data->exidx_size / 8;
137501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown        } else {
138501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            exidx_start = 0;
139501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            exidx_size = 0;
140501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown        }
141501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown    }
142501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown
143501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown    // The PC points to the instruction following the branch.
144501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown    // We want to find the exception handler entry that corresponds to the branch itself,
145501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown    // so we offset the PC backwards into the previous instruction.
146501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown    // ARM instructions are 4 bytes, Thumb are 2, so we just subtract two so we either
147501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown    // end up in the middle (ARM) or at the beginning of the instruction (Thumb).
148501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown    if (pc >= 2) {
149501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown        pc -= 2;
150501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown    }
151501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown
152bd57bd00b2172af9f315f2d3d62d68ca369e3666Jeff Brown    uintptr_t handler = 0;
153501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown    if (exidx_start) {
154501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown        uint32_t low = 0;
155501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown        uint32_t high = exidx_size;
156501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown        while (low < high) {
157501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            uint32_t index = (low + high) / 2;
158501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            uintptr_t entry = exidx_start + index * 8;
159501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            uint32_t entry_prel_pc;
160501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            if (!try_get_word(tid, entry, &entry_prel_pc)) {
161501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown                break;
162501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            }
163501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            uintptr_t entry_pc = prel_to_absolute(entry, entry_prel_pc);
164501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            if (pc < entry_pc) {
165501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown                high = index;
166501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown                continue;
167501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            }
168501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            if (index + 1 < exidx_size) {
169501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown                uintptr_t next_entry = entry + 8;
170501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown                uint32_t next_entry_prel_pc;
171501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown                if (!try_get_word(tid, next_entry, &next_entry_prel_pc)) {
172501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown                    break;
173501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown                }
174501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown                uintptr_t next_entry_pc = prel_to_absolute(next_entry, next_entry_prel_pc);
175501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown                if (pc >= next_entry_pc) {
176501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown                    low = index + 1;
177501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown                    continue;
178501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown                }
179501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            }
180501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown
181501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            uintptr_t entry_handler_ptr = entry + 4;
182501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            uint32_t entry_handler;
183501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            if (!try_get_word(tid, entry_handler_ptr, &entry_handler)) {
184501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown                break;
185501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            }
186501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            if (entry_handler & (1L << 31)) {
187501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown                handler = entry_handler_ptr; // in-place handler data
188501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            } else if (entry_handler != EXIDX_CANTUNWIND) {
189501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown                handler = prel_to_absolute(entry_handler_ptr, entry_handler);
190501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            }
191501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            break;
192501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown        }
193501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown    }
194bd57bd00b2172af9f315f2d3d62d68ca369e3666Jeff Brown    LOGV("get_exception_handler: pc=0x%08x, module='%s', module_start=0x%08x, "
195bd57bd00b2172af9f315f2d3d62d68ca369e3666Jeff Brown            "exidx_start=0x%08x, exidx_size=%d, handler=0x%08x",
196bd57bd00b2172af9f315f2d3d62d68ca369e3666Jeff Brown            pc, mi ? mi->name : "<unknown>", mi ? mi->start : 0,
197bd57bd00b2172af9f315f2d3d62d68ca369e3666Jeff Brown            exidx_start, exidx_size, handler);
198501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown    return handler;
199501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown}
200501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown
201501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Browntypedef struct {
202501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown    uintptr_t ptr;
203501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown    uint32_t word;
204501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown} byte_stream_t;
205501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown
206501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brownstatic bool try_next_byte(pid_t tid, byte_stream_t* stream, uint8_t* out_value) {
207501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown    uint8_t result;
208501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown    switch (stream->ptr & 3) {
209501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown    case 0:
210501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown        if (!try_get_word(tid, stream->ptr, &stream->word)) {
211501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            *out_value = 0;
212501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            return false;
213501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown        }
214501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown        *out_value = stream->word >> 24;
215501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown        break;
216501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown
217501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown    case 1:
218501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown        *out_value = stream->word >> 16;
219501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown        break;
220501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown
221501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown    case 2:
222501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown        *out_value = stream->word >> 8;
223501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown        break;
224501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown
225501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown    default:
226501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown        *out_value = stream->word;
227501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown        break;
228501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown    }
229501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown
230501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown    LOGV("next_byte: ptr=0x%08x, value=0x%02x", stream->ptr, *out_value);
231501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown    stream->ptr += 1;
232501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown    return true;
233501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown}
234501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown
235501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brownstatic void set_reg(unwind_state_t* state, uint32_t reg, uint32_t value) {
236501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown    LOGV("set_reg: reg=%d, value=0x%08x", reg, value);
237501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown    state->gregs[reg] = value;
238501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown}
239501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown
240501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brownstatic bool try_pop_registers(pid_t tid, unwind_state_t* state, uint32_t mask) {
241501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown    uint32_t sp = state->gregs[R_SP];
242501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown    bool sp_updated = false;
243501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown    for (int i = 0; i < 16; i++) {
244501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown        if (mask & (1 << i)) {
245501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            uint32_t value;
246501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            if (!try_get_word(tid, sp, &value)) {
247501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown                return false;
248501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            }
249501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            if (i == R_SP) {
250501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown                sp_updated = true;
251501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            }
252501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            set_reg(state, i, value);
253501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            sp += 4;
254501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown        }
255501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown    }
256501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown    if (!sp_updated) {
257501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown        set_reg(state, R_SP, sp);
258501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown    }
259501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown    return true;
260501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown}
261501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown
262501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown/* Executes a built-in personality routine as defined in the EHABI.
263501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown * Returns true if unwinding should continue.
264501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown *
265501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown * The data for the built-in personality routines consists of a sequence
266501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown * of unwinding instructions, followed by a sequence of scope descriptors,
267501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown * each of which has a length and offset encoded using 16-bit or 32-bit
268501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown * values.
269501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown *
270501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown * We only care about the unwinding instructions.  They specify the
271501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown * operations of an abstract machine whose purpose is to transform the
272501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown * virtual register state (including the stack pointer) such that
273501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown * the call frame is unwound and the PC register points to the call site.
274501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown */
275501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brownstatic bool execute_personality_routine(pid_t tid, unwind_state_t* state,
276501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown        byte_stream_t* stream, int pr_index) {
277501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown    size_t size;
278501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown    switch (pr_index) {
279501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown    case 0: // Personality routine #0, short frame, descriptors have 16-bit scope.
280501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown        size = 3;
281501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown        break;
282501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown    case 1: // Personality routine #1, long frame, descriptors have 16-bit scope.
283501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown    case 2: { // Personality routine #2, long frame, descriptors have 32-bit scope.
284501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown        uint8_t size_byte;
285501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown        if (!try_next_byte(tid, stream, &size_byte)) {
286501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            return false;
287501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown        }
288501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown        size = (uint32_t)size_byte * sizeof(uint32_t) + 2;
289501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown        break;
290501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown    }
291501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown    default: // Unknown personality routine.  Stop here.
292501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown        return false;
293501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown    }
294501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown
295501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown    bool pc_was_set = false;
296501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown    while (size--) {
297501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown        uint8_t op;
298501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown        if (!try_next_byte(tid, stream, &op)) {
299501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            return false;
300501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown        }
301501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown        if ((op & 0xc0) == 0x00) {
302501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            // "vsp = vsp + (xxxxxx << 2) + 4"
303501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            set_reg(state, R_SP, state->gregs[R_SP] + ((op & 0x3f) << 2) + 4);
304501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown        } else if ((op & 0xc0) == 0x40) {
305501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            // "vsp = vsp - (xxxxxx << 2) - 4"
306501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            set_reg(state, R_SP, state->gregs[R_SP] - ((op & 0x3f) << 2) - 4);
307501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown        } else if ((op & 0xf0) == 0x80) {
308501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            uint8_t op2;
309501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            if (!(size--) || !try_next_byte(tid, stream, &op2)) {
310501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown                return false;
311501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            }
312501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            uint32_t mask = (((uint32_t)op & 0x0f) << 12) | ((uint32_t)op2 << 4);
313501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            if (mask) {
314501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown                // "Pop up to 12 integer registers under masks {r15-r12}, {r11-r4}"
315501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown                if (!try_pop_registers(tid, state, mask)) {
316501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown                    return false;
317501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown                }
318501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown                if (mask & (1 << R_PC)) {
319501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown                    pc_was_set = true;
320501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown                }
321501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            } else {
322501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown                // "Refuse to unwind"
323501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown                return false;
324501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            }
325501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown        } else if ((op & 0xf0) == 0x90) {
326501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            if (op != 0x9d && op != 0x9f) {
327501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown                // "Set vsp = r[nnnn]"
328501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown                set_reg(state, R_SP, state->gregs[op & 0x0f]);
329501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            } else {
330501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown                // "Reserved as prefix for ARM register to register moves"
331501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown                // "Reserved as prefix for Intel Wireless MMX register to register moves"
332501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown                return false;
333501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            }
334501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown        } else if ((op & 0xf8) == 0xa0) {
335501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            // "Pop r4-r[4+nnn]"
336501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            uint32_t mask = (0x0ff0 >> (7 - (op & 0x07))) & 0x0ff0;
337501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            if (!try_pop_registers(tid, state, mask)) {
338501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown                return false;
339501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            }
340501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown        } else if ((op & 0xf8) == 0xa8) {
341501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            // "Pop r4-r[4+nnn], r14"
342501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            uint32_t mask = ((0x0ff0 >> (7 - (op & 0x07))) & 0x0ff0) | 0x4000;
343501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            if (!try_pop_registers(tid, state, mask)) {
344501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown                return false;
345501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            }
346501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown        } else if (op == 0xb0) {
347501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            // "Finish"
348501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            break;
349501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown        } else if (op == 0xb1) {
350501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            uint8_t op2;
351501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            if (!(size--) || !try_next_byte(tid, stream, &op2)) {
352501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown                return false;
353501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            }
354501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            if (op2 != 0x00 && (op2 & 0xf0) == 0x00) {
355501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown                // "Pop integer registers under mask {r3, r2, r1, r0}"
356501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown                if (!try_pop_registers(tid, state, op2)) {
357501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown                    return false;
358501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown                }
359501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            } else {
360501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown                // "Spare"
361501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown                return false;
362501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            }
363501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown        } else if (op == 0xb2) {
364501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            // "vsp = vsp + 0x204 + (uleb128 << 2)"
365501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            uint32_t value = 0;
366501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            uint32_t shift = 0;
367501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            uint8_t op2;
368501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            do {
369501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown                if (!(size--) || !try_next_byte(tid, stream, &op2)) {
370501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown                    return false;
371501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown                }
372501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown                value |= (op2 & 0x7f) << shift;
373501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown                shift += 7;
374501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            } while (op2 & 0x80);
375501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            set_reg(state, R_SP, state->gregs[R_SP] + (value << 2) + 0x204);
376501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown        } else if (op == 0xb3) {
377501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            // "Pop VFP double-precision registers D[ssss]-D[ssss+cccc] saved (as if) by FSTMFDX"
378501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            uint8_t op2;
379501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            if (!(size--) || !try_next_byte(tid, stream, &op2)) {
380501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown                return false;
381501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            }
382501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            set_reg(state, R_SP, state->gregs[R_SP] + (uint32_t)(op2 & 0x0f) * 8 + 12);
383501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown        } else if ((op & 0xf8) == 0xb8) {
384501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            // "Pop VFP double-precision registers D[8]-D[8+nnn] saved (as if) by FSTMFDX"
385501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            set_reg(state, R_SP, state->gregs[R_SP] + (uint32_t)(op & 0x07) * 8 + 12);
386501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown        } else if ((op & 0xf8) == 0xc0) {
387501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            // "Intel Wireless MMX pop wR[10]-wR[10+nnn]"
388501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            set_reg(state, R_SP, state->gregs[R_SP] + (uint32_t)(op & 0x07) * 8 + 8);
389501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown        } else if (op == 0xc6) {
390501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            // "Intel Wireless MMX pop wR[ssss]-wR[ssss+cccc]"
391501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            uint8_t op2;
392501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            if (!(size--) || !try_next_byte(tid, stream, &op2)) {
393501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown                return false;
394501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            }
395501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            set_reg(state, R_SP, state->gregs[R_SP] + (uint32_t)(op2 & 0x0f) * 8 + 8);
396501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown        } else if (op == 0xc7) {
397501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            uint8_t op2;
398501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            if (!(size--) || !try_next_byte(tid, stream, &op2)) {
399501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown                return false;
400501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            }
401501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            if (op2 != 0x00 && (op2 & 0xf0) == 0x00) {
402501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown                // "Intel Wireless MMX pop wCGR registers under mask {wCGR3,2,1,0}"
403501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown                set_reg(state, R_SP, state->gregs[R_SP] + __builtin_popcount(op2) * 4);
404501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            } else {
405501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown                // "Spare"
406501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown                return false;
407501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            }
408501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown        } else if (op == 0xc8) {
409501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            // "Pop VFP double precision registers D[16+ssss]-D[16+ssss+cccc]
410501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            // saved (as if) by FSTMFD"
411501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            uint8_t op2;
412501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            if (!(size--) || !try_next_byte(tid, stream, &op2)) {
413501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown                return false;
414501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            }
415501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            set_reg(state, R_SP, state->gregs[R_SP] + (uint32_t)(op2 & 0x0f) * 8 + 8);
416501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown        } else if (op == 0xc9) {
417501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            // "Pop VFP double precision registers D[ssss]-D[ssss+cccc] saved (as if) by FSTMFDD"
418501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            uint8_t op2;
419501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            if (!(size--) || !try_next_byte(tid, stream, &op2)) {
420501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown                return false;
421501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            }
422501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            set_reg(state, R_SP, state->gregs[R_SP] + (uint32_t)(op2 & 0x0f) * 8 + 8);
423501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown        } else if ((op == 0xf8) == 0xd0) {
424501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            // "Pop VFP double-precision registers D[8]-D[8+nnn] saved (as if) by FSTMFDD"
425501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            set_reg(state, R_SP, state->gregs[R_SP] + (uint32_t)(op & 0x07) * 8 + 8);
426501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown        } else {
427501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            // "Spare"
428501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            return false;
429501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown        }
430501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown    }
431501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown    if (!pc_was_set) {
432501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown        set_reg(state, R_PC, state->gregs[R_LR]);
433501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown    }
434501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown    return true;
435501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown}
436501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown
437501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brownstatic ssize_t unwind_backtrace_common(pid_t tid, const ptrace_context_t* context,
438501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown        unwind_state_t* state, backtrace_frame_t* backtrace,
439501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown        size_t ignore_depth, size_t max_depth) {
440501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown    size_t ignored_frames = 0;
441501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown    size_t returned_frames = 0;
442501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown
443501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown    uintptr_t handler = get_exception_handler(context, tid, state->gregs[R_PC]);
444501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown    if (!handler) {
445501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown        // If there is no handler for the PC, the program may have branched to
446501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown        // an invalid address.  Check whether we have a handler for the LR
447501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown        // where we came from and use that instead.
448501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown        backtrace_frame_t* frame = add_backtrace_entry(state->gregs[R_PC], backtrace,
449501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown                ignore_depth, max_depth, &ignored_frames, &returned_frames);
450501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown        if (frame) {
451501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            frame->stack_top = state->gregs[R_SP];
452501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown        }
453501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown
454501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown        handler = get_exception_handler(context, tid, state->gregs[R_LR]);
455501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown        if (!handler) {
456501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            // We don't have a handler here either.  Unwinding will not be possible.
457501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            // Return the PC and LR (if it looks sane) and call it good.
458501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            if (state->gregs[R_LR] && state->gregs[R_LR] != state->gregs[R_PC]) {
459501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown                // Don't return the SP for this second frame because we don't
460501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown                // know how big the first one is so we don't know where this
461501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown                // one starts.
462bd57bd00b2172af9f315f2d3d62d68ca369e3666Jeff Brown                add_backtrace_entry(state->gregs[R_LR], backtrace,
463501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown                        ignore_depth, max_depth, &ignored_frames, &returned_frames);
464501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            }
465501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            return returned_frames;
466501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown        }
467501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown
468501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown        // Ok, continue from the LR.
469501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown        set_reg(state, R_PC, state->gregs[R_LR]);
470501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown    }
471501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown
472501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown    while (handler && returned_frames < max_depth) {
473501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown        backtrace_frame_t* frame = add_backtrace_entry(state->gregs[R_PC], backtrace,
474501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown                ignore_depth, max_depth, &ignored_frames, &returned_frames);
475501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown        if (frame) {
476501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            frame->stack_top = state->gregs[R_SP];
477501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown        }
478501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown
479501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown        byte_stream_t stream;
480501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown        stream.ptr = handler;
481501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown        uint8_t pr;
482501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown        if (!try_next_byte(tid, &stream, &pr)) {
483501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            break;
484501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown        }
485501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown        if ((pr & 0xf0) != 0x80) {
486501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            // The first word is a place-relative pointer to a generic personality
487501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            // routine function.  We don't support invoking such functions, so stop here.
488501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            break;
489501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown        }
490501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown
491501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown        // The first byte indicates the personality routine to execute.
492501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown        // Following bytes provide instructions to the personality routine.
493501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown        if (!execute_personality_routine(tid, state, &stream, pr & 0x0f)) {
494501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            break;
495501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown        }
496501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown        if (frame && state->gregs[R_SP] > frame->stack_top) {
497501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown            frame->stack_size = state->gregs[R_SP] - frame->stack_top;
498501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown        }
499501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown
500501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown        handler = get_exception_handler(context, tid, state->gregs[R_PC]);
501501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown    }
502501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown    return returned_frames;
503501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown}
504501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown
505501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brownssize_t unwind_backtrace_signal_arch(siginfo_t* siginfo, void* sigcontext,
506501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown        backtrace_frame_t* backtrace, size_t ignore_depth, size_t max_depth) {
507501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown    const ucontext_t* uc = (const ucontext_t*)sigcontext;
508501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown
509501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown    unwind_state_t state;
510501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown    for (int i = 0; i < 16; i++) {
511501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown        state.gregs[i] = uc->uc_mcontext.gregs[i];
512501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown    }
513501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown
514501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown    return unwind_backtrace_common(-1, NULL, &state, backtrace, ignore_depth, max_depth);
515501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown}
516501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown
517501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brownssize_t unwind_backtrace_ptrace_arch(pid_t tid, const ptrace_context_t* context,
518501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown        backtrace_frame_t* backtrace, size_t ignore_depth, size_t max_depth) {
519501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown    struct pt_regs regs;
520501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown    if (ptrace(PTRACE_GETREGS, tid, 0, &regs)) {
521501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown        return -1;
522501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown    }
523501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown
524501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown    unwind_state_t state;
525501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown    for (int i = 0; i < 16; i++) {
526501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown        state.gregs[i] = regs.uregs[i];
527501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown    }
528501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown
529501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown    return unwind_backtrace_common(tid, context, &state, backtrace, ignore_depth, max_depth);
530501edd29b823ce1301d2effdd3a9e4b6e2b20b76Jeff Brown}
531