x86-64-linux-nat.c [plain text]
#include "defs.h"
#include "inferior.h"
#include "gdbcore.h"
#include "regcache.h"
#include "i387-nat.h"
#include "gdb_assert.h"
#include "x86-64-tdep.h"
#include <sys/ptrace.h>
#include <sys/debugreg.h>
#include <sys/syscall.h>
#include <sys/procfs.h>
#include <sys/reg.h>
static int x86_64_regmap[] = {
RAX, RBX, RCX, RDX,
RSI, RDI, RBP, RSP,
R8, R9, R10, R11,
R12, R13, R14, R15,
RIP, EFLAGS,
DS, ES, FS, GS
};
static unsigned long
x86_64_linux_dr_get (int regnum)
{
int tid;
unsigned long value;
tid = PIDGET (inferior_ptid);
errno = 0;
value = ptrace (PT_READ_U, tid,
offsetof (struct user, u_debugreg[regnum]), 0);
if (errno != 0)
#if 0
perror_with_name ("Couldn't read debug register");
#else
return 0;
#endif
return value;
}
static void
x86_64_linux_dr_set (int regnum, unsigned long value)
{
int tid;
tid = PIDGET (inferior_ptid);
errno = 0;
ptrace (PT_WRITE_U, tid, offsetof (struct user, u_debugreg[regnum]), value);
if (errno != 0)
perror_with_name ("Couldn't write debug register");
}
void
x86_64_linux_dr_set_control (unsigned long control)
{
x86_64_linux_dr_set (DR_CONTROL, control);
}
void
x86_64_linux_dr_set_addr (int regnum, CORE_ADDR addr)
{
gdb_assert (regnum >= 0 && regnum <= DR_LASTADDR - DR_FIRSTADDR);
x86_64_linux_dr_set (DR_FIRSTADDR + regnum, addr);
}
void
x86_64_linux_dr_reset_addr (int regnum)
{
gdb_assert (regnum >= 0 && regnum <= DR_LASTADDR - DR_FIRSTADDR);
x86_64_linux_dr_set (DR_FIRSTADDR + regnum, 0L);
}
unsigned long
x86_64_linux_dr_get_status (void)
{
return x86_64_linux_dr_get (DR_STATUS);
}
#define GETREGS_SUPPLIES(regno) \
(0 <= (regno) && (regno) < x86_64_num_gregs)
#define GETFPREGS_SUPPLIES(regno) \
(FP0_REGNUM <= (regno) && (regno) <= MXCSR_REGNUM)
#define PTRACE_XFER_TYPE unsigned long
void
supply_gregset (elf_gregset_t * gregsetp)
{
elf_greg_t *regp = (elf_greg_t *) gregsetp;
int i;
for (i = 0; i < x86_64_num_gregs; i++)
supply_register (i, (char *) (regp + x86_64_regmap[i]));
}
void
fill_gregset (elf_gregset_t * gregsetp, int regno)
{
elf_greg_t *regp = (elf_greg_t *) gregsetp;
int i;
for (i = 0; i < x86_64_num_gregs; i++)
if ((regno == -1 || regno == i))
read_register_gen (i, regp + x86_64_regmap[i]);
}
static void
fetch_regs (int tid)
{
elf_gregset_t regs;
if (ptrace (PTRACE_GETREGS, tid, 0, (long) ®s) < 0)
perror_with_name ("Couldn't get registers");
supply_gregset (®s);
}
static void
store_regs (int tid, int regno)
{
elf_gregset_t regs;
if (ptrace (PTRACE_GETREGS, tid, 0, (long) ®s) < 0)
perror_with_name ("Couldn't get registers");
fill_gregset (®s, regno);
if (ptrace (PTRACE_SETREGS, tid, 0, (long) ®s) < 0)
perror_with_name ("Couldn't write registers");
}
void
supply_fpregset (elf_fpregset_t * fpregsetp)
{
i387_supply_fxsave ((char *) fpregsetp);
}
void
fill_fpregset (elf_fpregset_t * fpregsetp, int regno)
{
i387_fill_fxsave ((char *) fpregsetp, regno);
}
static void
fetch_fpregs (int tid)
{
elf_fpregset_t fpregs;
if (ptrace (PTRACE_GETFPREGS, tid, 0, (long) &fpregs) < 0)
perror_with_name ("Couldn't get floating point status");
supply_fpregset (&fpregs);
}
static void
store_fpregs (int tid, int regno)
{
elf_fpregset_t fpregs;
if (ptrace (PTRACE_GETFPREGS, tid, 0, (long) &fpregs) < 0)
perror_with_name ("Couldn't get floating point status");
fill_fpregset (&fpregs, regno);
if (ptrace (PTRACE_SETFPREGS, tid, 0, (long) &fpregs) < 0)
perror_with_name ("Couldn't write floating point status");
}
void
fetch_inferior_registers (int regno)
{
int tid;
if ((tid = TIDGET (inferior_ptid)) == 0)
tid = PIDGET (inferior_ptid);
if (regno == -1)
{
fetch_regs (tid);
fetch_fpregs (tid);
return;
}
if (GETREGS_SUPPLIES (regno))
{
fetch_regs (tid);
return;
}
if (GETFPREGS_SUPPLIES (regno))
{
fetch_fpregs (tid);
return;
}
internal_error (__FILE__, __LINE__,
"Got request for bad register number %d.", regno);
}
void
store_inferior_registers (int regno)
{
int tid;
if ((tid = TIDGET (inferior_ptid)) == 0)
tid = PIDGET (inferior_ptid);
if (regno == -1)
{
store_regs (tid, regno);
store_fpregs (tid, regno);
return;
}
if (GETREGS_SUPPLIES (regno))
{
store_regs (tid, regno);
return;
}
if (GETFPREGS_SUPPLIES (regno))
{
store_fpregs (tid, regno);
return;
}
internal_error (__FILE__, __LINE__,
"Got request to store bad register number %d.", regno);
}
static const unsigned char linux_syscall[] = { 0x0f, 0x05 };
#define LINUX_SYSCALL_LEN (sizeof linux_syscall)
#define LINUX_SYSCALL_REGNUM 0
#ifndef SYS_sigreturn
#define SYS_sigreturn __NR_sigreturn
#endif
#ifndef SYS_rt_sigreturn
#define SYS_rt_sigreturn __NR_rt_sigreturn
#endif
#define LINUX_SIGCONTEXT_EFLAGS_OFFSET (152)
#define LINUX_UCONTEXT_SIGCONTEXT_OFFSET (36)
void
child_resume (ptid_t ptid, int step, enum target_signal signal)
{
int pid = PIDGET (ptid);
int request = PTRACE_CONT;
if (pid == -1)
pid = PIDGET (inferior_ptid);
if (step)
{
CORE_ADDR pc = read_pc_pid (pid_to_ptid (pid));
unsigned char buf[LINUX_SYSCALL_LEN];
request = PTRACE_SINGLESTEP;
if (read_memory_nobpt (pc, (char *) buf, LINUX_SYSCALL_LEN) == 0
&& memcmp (buf, linux_syscall, LINUX_SYSCALL_LEN) == 0)
{
int syscall =
read_register_pid (LINUX_SYSCALL_REGNUM, pid_to_ptid (pid));
if (syscall == SYS_rt_sigreturn)
{
CORE_ADDR sp = read_register (SP_REGNUM);
CORE_ADDR addr = sp;
unsigned long int eflags;
addr +=
sizeof (struct siginfo) + LINUX_UCONTEXT_SIGCONTEXT_OFFSET;
addr += LINUX_SIGCONTEXT_EFLAGS_OFFSET;
read_memory (addr, (char *) &eflags, 8);
eflags |= 0x0100;
write_memory (addr, (char *) &eflags, 8);
}
}
}
if (ptrace (request, pid, 0, target_signal_to_host (signal)) == -1)
perror_with_name ("ptrace");
}
int
child_xfer_memory (CORE_ADDR memaddr, char *myaddr, int len, int write,
struct mem_attrib *attrib, struct target_ops *target)
{
register int i;
register CORE_ADDR addr = memaddr & -sizeof (PTRACE_XFER_TYPE);
register int count
= (((memaddr + len) - addr) + sizeof (PTRACE_XFER_TYPE) - 1)
/ sizeof (PTRACE_XFER_TYPE);
register PTRACE_XFER_TYPE *buffer
= (PTRACE_XFER_TYPE *) alloca (count * sizeof (PTRACE_XFER_TYPE));
if (write)
{
if (addr != memaddr || len < (int) sizeof (PTRACE_XFER_TYPE))
{
buffer[0] = ptrace (PT_READ_I, PIDGET (inferior_ptid),
(PTRACE_ARG3_TYPE) addr, 0);
}
if (count > 1)
{
buffer[count - 1] = ptrace (PT_READ_I, PIDGET (inferior_ptid),
((PTRACE_ARG3_TYPE)
(addr +
(count -
1) * sizeof (PTRACE_XFER_TYPE))), 0);
}
memcpy ((char *) buffer + (memaddr & (sizeof (PTRACE_XFER_TYPE) - 1)),
myaddr, len);
for (i = 0; i < count; i++, addr += sizeof (PTRACE_XFER_TYPE))
{
errno = 0;
ptrace (PT_WRITE_D, PIDGET (inferior_ptid),
(PTRACE_ARG3_TYPE) addr, buffer[i]);
if (errno)
{
errno = 0;
ptrace (PT_WRITE_I, PIDGET (inferior_ptid),
(PTRACE_ARG3_TYPE) addr, buffer[i]);
}
if (errno)
return 0;
}
#ifdef CLEAR_INSN_CACHE
CLEAR_INSN_CACHE ();
#endif
}
else
{
for (i = 0; i < count; i++, addr += sizeof (PTRACE_XFER_TYPE))
{
errno = 0;
buffer[i] = ptrace (PT_READ_I, PIDGET (inferior_ptid),
(PTRACE_ARG3_TYPE) addr, 0);
if (errno)
return 0;
}
memcpy (myaddr,
(char *) buffer + (memaddr & (sizeof (PTRACE_XFER_TYPE) - 1)),
len);
}
return len;
}
static void
fetch_core_registers (char *core_reg_sect, unsigned core_reg_size,
int which, CORE_ADDR reg_addr)
{
elf_gregset_t gregset;
elf_fpregset_t fpregset;
switch (which)
{
case 0:
if (core_reg_size != sizeof (gregset))
warning ("Wrong size gregset in core file.");
else
{
memcpy (&gregset, core_reg_sect, sizeof (gregset));
supply_gregset (&gregset);
}
break;
case 2:
if (core_reg_size != sizeof (fpregset))
warning ("Wrong size fpregset in core file.");
else
{
memcpy (&fpregset, core_reg_sect, sizeof (fpregset));
supply_fpregset (&fpregset);
}
break;
default:
break;
}
}
static struct core_fns linux_elf_core_fns = {
bfd_target_elf_flavour,
default_check_format,
default_core_sniffer,
fetch_core_registers,
NULL
};
#if !defined (offsetof)
#define offsetof(TYPE, MEMBER) ((unsigned long) &((TYPE *)0)->MEMBER)
#endif
static long debug_control_mirror;
static CORE_ADDR address_lookup[DR_LASTADDR - DR_FIRSTADDR + 1];
CORE_ADDR
x86_64_register_u_addr (CORE_ADDR blockend, int regnum)
{
struct user u;
CORE_ADDR fpstate;
CORE_ADDR ubase;
ubase = blockend;
if (IS_FP_REGNUM (regnum))
{
fpstate = ubase + ((char *) &u.i387.st_space - (char *) &u);
return (fpstate + 16 * (regnum - FP0_REGNUM));
}
else if (IS_SSE_REGNUM (regnum))
{
fpstate = ubase + ((char *) &u.i387.xmm_space - (char *) &u);
return (fpstate + 16 * (regnum - XMM0_REGNUM));
}
else
return (ubase + 8 * x86_64_regmap[regnum]);
}
void
_initialize_x86_64_linux_nat (void)
{
add_core_fns (&linux_elf_core_fns);
}