#include <errno.h>
#include <stdlib.h>
#include <string.h>
#include <sys/mman.h>
#include <stdatomic.h>
#include "unwind_i.h"
#ifdef UNW_REMOTE_ONLY
unw_addr_space_t unw_local_addr_space;
#else
static struct unw_addr_space local_addr_space;
unw_addr_space_t unw_local_addr_space = &local_addr_space;
static inline void *
uc_addr (unw_context_t *uc, int reg)
{
if (reg == UNW_AARCH64_VG)
{
Debug(1, "Accessing VG register from context is not supported\n");
return NULL;
}
#ifdef __FreeBSD__
if (reg >= UNW_AARCH64_X0 && reg < UNW_AARCH64_X30)
return &uc->uc_mcontext.mc_gpregs.gp_x[reg];
else if (reg == UNW_AARCH64_X30)
return &uc->uc_mcontext.mc_gpregs.gp_lr;
else if (reg == UNW_AARCH64_SP)
return &uc->uc_mcontext.mc_gpregs.gp_sp;
else if (reg == UNW_AARCH64_PC)
return &uc->uc_mcontext.mc_gpregs.gp_elr;
else if (reg >= UNW_AARCH64_V0 && reg <= UNW_AARCH64_V31)
return &uc->uc_mcontext.mc_fpregs.fp_q[reg - UNW_AARCH64_V0];
else
return NULL;
#elif defined(__QNX__)
if (reg >= UNW_AARCH64_X0 && reg <= UNW_AARCH64_X30)
return &uc->uc_mcontext.cpu.gpr[reg];
else if (reg == UNW_AARCH64_SP)
return &AARCH64_GET_REGSP(&uc->uc_mcontext.cpu);
else if (reg == UNW_AARCH64_PC)
return &AARCH64_GET_REGIP(&uc->uc_mcontext.cpu);
else if (reg >= UNW_AARCH64_V0 && reg <= UNW_AARCH64_V31)
return &uc->uc_mcontext.fpu.reg[reg - UNW_AARCH64_V0];
else
return NULL;
# else
if (reg >= UNW_AARCH64_X0 && reg <= UNW_AARCH64_X30)
return &uc->uc_mcontext.regs[reg];
else if (reg == UNW_AARCH64_SP)
return &uc->uc_mcontext.sp;
else if (reg == UNW_AARCH64_PC)
return &uc->uc_mcontext.pc;
else if (reg >= UNW_AARCH64_V0 && reg <= UNW_AARCH64_V31)
return &GET_FPCTX(uc)->vregs[reg - UNW_AARCH64_V0];
else
return NULL;
#endif
}
# ifdef UNW_LOCAL_ONLY
HIDDEN void *
tdep_uc_addr (unw_context_t *uc, int reg)
{
return uc_addr (uc, reg);
}
# endif
static void
put_unwind_info (unw_addr_space_t as, unw_proc_info_t *proc_info, void *arg)
{
}
static int
get_dyn_info_list_addr (unw_addr_space_t as, unw_word_t *dyn_info_list_addr,
void *arg)
{
#ifndef UNW_LOCAL_ONLY
# pragma weak _U_dyn_info_list_addr
if (!_U_dyn_info_list_addr)
return -UNW_ENOINFO;
#endif
*dyn_info_list_addr = _U_dyn_info_list_addr ();
return 0;
}
static int
access_mem (unw_addr_space_t as, unw_word_t addr, unw_word_t *val, int write,
void *arg)
{
if (unlikely (write))
{
Debug (16, "mem[%lx] <- %lx\n", addr, *val);
memcpy ((void *) addr, val, sizeof(unw_word_t));
}
else
{
const struct cursor *c = (const struct cursor *)arg;
if (likely (c != NULL) && unlikely (c->validate)
&& unlikely (!unw_address_is_valid (addr, sizeof(unw_word_t)))) {
Debug (16, "mem[%016lx] -> invalid\n", addr);
return -1;
}
memcpy (val, (void *) addr, sizeof(unw_word_t));
Debug (16, "mem[%lx] -> %lx\n", addr, *val);
}
return 0;
}
static int
access_reg (unw_addr_space_t as, unw_regnum_t reg, unw_word_t *val, int write,
void *arg)
{
unw_word_t *addr;
unw_context_t *uc = ((struct cursor *)arg)->uc;
if (unw_is_fpreg (reg))
goto badreg;
if (!(addr = uc_addr (uc, reg)))
goto badreg;
if (write)
{
memcpy ((void *) addr, val, sizeof(unw_word_t));
Debug (12, "%s <- %lx\n", unw_regname (reg), *val);
}
else
{
memcpy (val, (void *) addr, sizeof(unw_word_t));
Debug (12, "%s -> %lx\n", unw_regname (reg), *val);
}
return 0;
badreg:
Debug (1, "bad register number %u\n", reg);
return -UNW_EBADREG;
}
static int
access_fpreg (unw_addr_space_t as, unw_regnum_t reg, unw_fpreg_t *val,
int write, void *arg)
{
unw_context_t *uc = ((struct cursor *)arg)->uc;
unw_fpreg_t *addr;
if (!unw_is_fpreg (reg))
goto badreg;
if (!(addr = uc_addr (uc, reg)))
goto badreg;
if (write)
{
Debug (12, "%s <- %08lx.%08lx.%08lx\n", unw_regname (reg),
((long *)val)[0], ((long *)val)[1], ((long *)val)[2]);
*(unw_fpreg_t *) addr = *val;
}
else
{
*val = *(unw_fpreg_t *) addr;
Debug (12, "%s -> %08lx.%08lx.%08lx\n", unw_regname (reg),
((long *)val)[0], ((long *)val)[1], ((long *)val)[2]);
}
return 0;
badreg:
Debug (1, "bad register number %u\n", reg);
return -UNW_EBADREG;
}
static int
get_static_proc_name (unw_addr_space_t as, unw_word_t ip,
char *buf, size_t buf_len, unw_word_t *offp,
void *arg)
{
return _Uelf64_get_proc_name (as, getpid (), ip, buf, buf_len, offp);
}
static unw_word_t empty_ptrauth_mask(unw_addr_space_t addr_space_unused, void *as_arg_unused)
{
return 0;
}
static int
get_static_elf_filename (unw_addr_space_t as, unw_word_t ip, char *buf, size_t buf_len, unw_word_t *offp, void *arg)
{
return _Uelf64_get_elf_filename(as, getpid(), ip, buf, buf_len, offp);
}
HIDDEN void
aarch64_local_addr_space_init (void)
{
memset (&local_addr_space, 0, sizeof (local_addr_space));
#ifndef UNW_REMOTE_ONLY
# if defined(HAVE_DL_ITERATE_PHDR)
local_addr_space.iterate_phdr_function = dl_iterate_phdr;
# endif
#endif
local_addr_space.caching_policy = UNWI_DEFAULT_CACHING_POLICY;
local_addr_space.acc.find_proc_info = dwarf_find_proc_info;
local_addr_space.acc.put_unwind_info = put_unwind_info;
local_addr_space.acc.get_dyn_info_list_addr = get_dyn_info_list_addr;
local_addr_space.acc.access_mem = access_mem;
local_addr_space.acc.access_reg = access_reg;
local_addr_space.acc.access_fpreg = access_fpreg;
local_addr_space.acc.resume = aarch64_local_resume;
local_addr_space.acc.get_proc_name = get_static_proc_name;
local_addr_space.acc.get_elf_filename = get_static_elf_filename;
local_addr_space.acc.ptrauth_insn_mask = empty_ptrauth_mask;
local_addr_space.big_endian = target_is_big_endian();
unw_flush_cache (&local_addr_space, 0, 0);
}
#endif