gdb/m68klinux-nat.c - gdb
Global variables defined
Functions defined
Macros defined
Source code
- #include "defs.h"
- #include "frame.h"
- #include "inferior.h"
- #include "language.h"
- #include "gdbcore.h"
- #include "regcache.h"
- #include "target.h"
- #include "linux-nat.h"
- #include "m68k-tdep.h"
- #include <sys/dir.h>
- #include <signal.h>
- #include <sys/ptrace.h>
- #include <sys/user.h>
- #include <sys/ioctl.h>
- #include <fcntl.h>
- #include <sys/procfs.h>
- #ifdef HAVE_SYS_REG_H
- #include <sys/reg.h>
- #endif
- #include <sys/file.h>
- #include <sys/stat.h>
- #include "floatformat.h"
- #include "gregset.h"
- #include "gdb_proc_service.h"
- #ifndef PTRACE_GET_THREAD_AREA
- #define PTRACE_GET_THREAD_AREA 25
- #endif
- static const int regmap[] =
- {
- PT_D0, PT_D1, PT_D2, PT_D3, PT_D4, PT_D5, PT_D6, PT_D7,
- PT_A0, PT_A1, PT_A2, PT_A3, PT_A4, PT_A5, PT_A6, PT_USP,
- PT_SR, PT_PC,
-
- 21, 24, 27, 30, 33, 36, 39, 42,
-
- 45, 46, 47
- };
- #define NUM_GREGS (18)
- #define MAX_NUM_REGS (NUM_GREGS + 11)
- static int
- getregs_supplies (int regno)
- {
- return 0 <= regno && regno < NUM_GREGS;
- }
- static int
- getfpregs_supplies (int regno)
- {
- return M68K_FP0_REGNUM <= regno && regno <= M68K_FPI_REGNUM;
- }
- static int have_ptrace_getregs =
- #ifdef HAVE_PTRACE_GETREGS
- 1
- #else
- 0
- #endif
- ;
- static void
- fetch_register (struct regcache *regcache, int regno)
- {
- struct gdbarch *gdbarch = get_regcache_arch (regcache);
- long regaddr, val;
- int i;
- gdb_byte buf[MAX_REGISTER_SIZE];
- int tid;
-
- tid = ptid_get_lwp (inferior_ptid);
- if (tid == 0)
- tid = ptid_get_pid (inferior_ptid);
- regaddr = 4 * regmap[regno];
- for (i = 0; i < register_size (gdbarch, regno); i += sizeof (long))
- {
- errno = 0;
- val = ptrace (PTRACE_PEEKUSER, tid, regaddr, 0);
- memcpy (&buf[i], &val, sizeof (long));
- regaddr += sizeof (long);
- if (errno != 0)
- error (_("Couldn't read register %s (#%d): %s."),
- gdbarch_register_name (gdbarch, regno),
- regno, safe_strerror (errno));
- }
- regcache_raw_supply (regcache, regno, buf);
- }
- static void
- old_fetch_inferior_registers (struct regcache *regcache, int regno)
- {
- if (regno >= 0)
- {
- fetch_register (regcache, regno);
- }
- else
- {
- for (regno = 0;
- regno < gdbarch_num_regs (get_regcache_arch (regcache));
- regno++)
- {
- fetch_register (regcache, regno);
- }
- }
- }
- static void
- store_register (const struct regcache *regcache, int regno)
- {
- struct gdbarch *gdbarch = get_regcache_arch (regcache);
- long regaddr, val;
- int i;
- int tid;
- gdb_byte buf[MAX_REGISTER_SIZE];
-
- tid = ptid_get_lwp (inferior_ptid);
- if (tid == 0)
- tid = ptid_get_pid (inferior_ptid);
- regaddr = 4 * regmap[regno];
-
- regcache_raw_collect (regcache, regno, buf);
-
- for (i = 0; i < register_size (gdbarch, regno); i += sizeof (long))
- {
- errno = 0;
- memcpy (&val, &buf[i], sizeof (long));
- ptrace (PTRACE_POKEUSER, tid, regaddr, val);
- regaddr += sizeof (long);
- if (errno != 0)
- error (_("Couldn't write register %s (#%d): %s."),
- gdbarch_register_name (gdbarch, regno),
- regno, safe_strerror (errno));
- }
- }
- static void
- old_store_inferior_registers (const struct regcache *regcache, int regno)
- {
- if (regno >= 0)
- {
- store_register (regcache, regno);
- }
- else
- {
- for (regno = 0;
- regno < gdbarch_num_regs (get_regcache_arch (regcache));
- regno++)
- {
- store_register (regcache, regno);
- }
- }
- }
- void
- supply_gregset (struct regcache *regcache, const elf_gregset_t *gregsetp)
- {
- struct gdbarch *gdbarch = get_regcache_arch (regcache);
- const elf_greg_t *regp = (const elf_greg_t *) gregsetp;
- int regi;
- for (regi = M68K_D0_REGNUM;
- regi <= gdbarch_sp_regnum (gdbarch);
- regi++)
- regcache_raw_supply (regcache, regi, ®p[regmap[regi]]);
- regcache_raw_supply (regcache, gdbarch_ps_regnum (gdbarch),
- ®p[PT_SR]);
- regcache_raw_supply (regcache,
- gdbarch_pc_regnum (gdbarch), ®p[PT_PC]);
- }
- void
- fill_gregset (const struct regcache *regcache,
- elf_gregset_t *gregsetp, int regno)
- {
- elf_greg_t *regp = (elf_greg_t *) gregsetp;
- int i;
- for (i = 0; i < NUM_GREGS; i++)
- if (regno == -1 || regno == i)
- regcache_raw_collect (regcache, i, regp + regmap[i]);
- }
- #ifdef HAVE_PTRACE_GETREGS
- static void
- fetch_regs (struct regcache *regcache, int tid)
- {
- elf_gregset_t regs;
- if (ptrace (PTRACE_GETREGS, tid, 0, (int) ®s) < 0)
- {
- if (errno == EIO)
- {
-
- have_ptrace_getregs = 0;
- return;
- }
- perror_with_name (_("Couldn't get registers"));
- }
- supply_gregset (regcache, (const elf_gregset_t *) ®s);
- }
- static void
- store_regs (const struct regcache *regcache, int tid, int regno)
- {
- elf_gregset_t regs;
- if (ptrace (PTRACE_GETREGS, tid, 0, (int) ®s) < 0)
- perror_with_name (_("Couldn't get registers"));
- fill_gregset (regcache, ®s, regno);
- if (ptrace (PTRACE_SETREGS, tid, 0, (int) ®s) < 0)
- perror_with_name (_("Couldn't write registers"));
- }
- #else
- static void fetch_regs (struct regcache *regcache, int tid)
- {
- }
- static void store_regs (const struct regcache *regcache, int tid, int regno)
- {
- }
- #endif
- #define FPREG_ADDR(f, n) (&(f)->fpregs[(n) * 3])
- void
- supply_fpregset (struct regcache *regcache, const elf_fpregset_t *fpregsetp)
- {
- struct gdbarch *gdbarch = get_regcache_arch (regcache);
- int regi;
- for (regi = gdbarch_fp0_regnum (gdbarch);
- regi < gdbarch_fp0_regnum (gdbarch) + 8; regi++)
- regcache_raw_supply (regcache, regi,
- FPREG_ADDR (fpregsetp,
- regi - gdbarch_fp0_regnum (gdbarch)));
- regcache_raw_supply (regcache, M68K_FPC_REGNUM, &fpregsetp->fpcntl[0]);
- regcache_raw_supply (regcache, M68K_FPS_REGNUM, &fpregsetp->fpcntl[1]);
- regcache_raw_supply (regcache, M68K_FPI_REGNUM, &fpregsetp->fpcntl[2]);
- }
- void
- fill_fpregset (const struct regcache *regcache,
- elf_fpregset_t *fpregsetp, int regno)
- {
- struct gdbarch *gdbarch = get_regcache_arch (regcache);
- int i;
-
- for (i = gdbarch_fp0_regnum (gdbarch);
- i < gdbarch_fp0_regnum (gdbarch) + 8; i++)
- if (regno == -1 || regno == i)
- regcache_raw_collect (regcache, i,
- FPREG_ADDR (fpregsetp,
- i - gdbarch_fp0_regnum (gdbarch)));
-
- for (i = M68K_FPC_REGNUM; i <= M68K_FPI_REGNUM; i++)
- if (regno == -1 || regno == i)
- regcache_raw_collect (regcache, i,
- &fpregsetp->fpcntl[i - M68K_FPC_REGNUM]);
- }
- #ifdef HAVE_PTRACE_GETREGS
- static void
- fetch_fpregs (struct regcache *regcache, int tid)
- {
- elf_fpregset_t fpregs;
- if (ptrace (PTRACE_GETFPREGS, tid, 0, (int) &fpregs) < 0)
- perror_with_name (_("Couldn't get floating point status"));
- supply_fpregset (regcache, (const elf_fpregset_t *) &fpregs);
- }
- static void
- store_fpregs (const struct regcache *regcache, int tid, int regno)
- {
- elf_fpregset_t fpregs;
- if (ptrace (PTRACE_GETFPREGS, tid, 0, (int) &fpregs) < 0)
- perror_with_name (_("Couldn't get floating point status"));
- fill_fpregset (regcache, &fpregs, regno);
- if (ptrace (PTRACE_SETFPREGS, tid, 0, (int) &fpregs) < 0)
- perror_with_name (_("Couldn't write floating point status"));
- }
- #else
- static void fetch_fpregs (struct regcache *regcache, int tid)
- {
- }
- static void store_fpregs (const struct regcache *regcache, int tid, int regno)
- {
- }
- #endif
- static void
- m68k_linux_fetch_inferior_registers (struct target_ops *ops,
- struct regcache *regcache, int regno)
- {
- int tid;
-
- if (! have_ptrace_getregs)
- {
- old_fetch_inferior_registers (regcache, regno);
- return;
- }
-
- tid = ptid_get_lwp (inferior_ptid);
- if (tid == 0)
- tid = ptid_get_pid (inferior_ptid);
-
- if (regno == -1)
- {
- fetch_regs (regcache, tid);
-
- if (! have_ptrace_getregs)
- {
- old_fetch_inferior_registers (regcache, -1);
- return;
- }
- fetch_fpregs (regcache, tid);
- return;
- }
- if (getregs_supplies (regno))
- {
- fetch_regs (regcache, tid);
- return;
- }
- if (getfpregs_supplies (regno))
- {
- fetch_fpregs (regcache, tid);
- return;
- }
- internal_error (__FILE__, __LINE__,
- _("Got request for bad register number %d."), regno);
- }
- static void
- m68k_linux_store_inferior_registers (struct target_ops *ops,
- struct regcache *regcache, int regno)
- {
- int tid;
-
- if (! have_ptrace_getregs)
- {
- old_store_inferior_registers (regcache, regno);
- return;
- }
-
- tid = ptid_get_lwp (inferior_ptid);
- if (tid == 0)
- tid = ptid_get_pid (inferior_ptid);
-
- if (regno == -1)
- {
- store_regs (regcache, tid, regno);
- store_fpregs (regcache, tid, regno);
- return;
- }
- if (getregs_supplies (regno))
- {
- store_regs (regcache, tid, regno);
- return;
- }
- if (getfpregs_supplies (regno))
- {
- store_fpregs (regcache, tid, regno);
- return;
- }
- internal_error (__FILE__, __LINE__,
- _("Got request to store bad register number %d."), regno);
- }
- ps_err_e
- ps_get_thread_area (const struct ps_prochandle *ph,
- lwpid_t lwpid, int idx, void **base)
- {
- if (ptrace (PTRACE_GET_THREAD_AREA, lwpid, NULL, base) < 0)
- return PS_ERR;
-
- *base = (char *) *base - idx;
- return PS_OK;
- }
- void _initialize_m68k_linux_nat (void);
- void
- _initialize_m68k_linux_nat (void)
- {
- struct target_ops *t;
-
- t = linux_target ();
-
- t->to_fetch_registers = m68k_linux_fetch_inferior_registers;
- t->to_store_registers = m68k_linux_store_inferior_registers;
-
- linux_nat_add_target (t);
- }