#include "server.h"
#include "frame.h"
#include "inferior.h"
#include <stdio.h>
#include <sys/param.h>
#include <sys/dir.h>
#define LYNXOS
#include <sys/mem.h>
#include <sys/signal.h>
#include <sys/file.h>
#include <sys/kernel.h>
#ifndef __LYNXOS
#define __LYNXOS
#endif
#include <sys/itimer.h>
#include <sys/time.h>
#include <sys/resource.h>
#include <sys/proc.h>
#include <signal.h>
#include <sys/ioctl.h>
#include <sgtty.h>
#include <fcntl.h>
#include <sys/wait.h>
#include <sys/fpp.h>
static char my_registers[REGISTER_BYTES];
char *registers = my_registers;
#include <sys/ptrace.h>
int
create_inferior (char *program, char **allargs)
{
int pid;
pid = fork ();
if (pid < 0)
perror_with_name ("fork");
if (pid == 0)
{
int pgrp;
pgrp = getpid ();
setpgrp (0, pgrp);
ioctl (0, TIOCSPGRP, &pgrp);
ptrace (PTRACE_TRACEME, 0, (PTRACE_ARG3_TYPE) 0, 0);
execv (program, allargs);
fprintf (stderr, "GDBserver (process %d): Cannot exec %s: %s.\n",
getpid (), program,
errno < sys_nerr ? sys_errlist[errno] : "unknown error");
fflush (stderr);
_exit (0177);
}
return pid;
}
int
myattach (int pid)
{
return -1;
}
void
kill_inferior (void)
{
if (inferior_pid == 0)
return;
ptrace (PTRACE_KILL, inferior_pid, 0, 0);
wait (0);
inferior_pid = 0;
}
int
mythread_alive (int pid)
{
return (ptrace (PTRACE_THREADUSER,
BUILDPID (PIDGET (inferior_pid), pid), 0, 0) != -1);
}
unsigned char
mywait (char *status)
{
int pid;
union wait w;
while (1)
{
enable_async_io ();
pid = wait (&w);
disable_async_io ();
if (pid != PIDGET (inferior_pid))
perror_with_name ("wait");
thread_from_wait = w.w_tid;
inferior_pid = BUILDPID (inferior_pid, w.w_tid);
if (WIFSTOPPED (w)
&& WSTOPSIG (w) == SIGTRAP)
{
int realsig;
realsig = ptrace (PTRACE_GETTRACESIG, inferior_pid,
(PTRACE_ARG3_TYPE) 0, 0);
if (realsig == SIGNEWTHREAD)
{
;
}
}
break;
}
if (WIFEXITED (w))
{
*status = 'W';
return ((unsigned char) WEXITSTATUS (w));
}
else if (!WIFSTOPPED (w))
{
*status = 'X';
return ((unsigned char) WTERMSIG (w));
}
fetch_inferior_registers (0);
*status = 'T';
return ((unsigned char) WSTOPSIG (w));
}
void
myresume (int step, int signal)
{
errno = 0;
ptrace (step ? PTRACE_SINGLESTEP_ONE : PTRACE_CONT,
BUILDPID (inferior_pid, cont_thread == -1 ? 0 : cont_thread),
1, signal);
if (errno)
perror_with_name ("ptrace");
}
#undef offsetof
#define offsetof(TYPE, MEMBER) ((unsigned long) &((TYPE *)0)->MEMBER)
#define X(ENTRY)(offsetof(struct econtext, ENTRY))
#ifdef I386
static int regmap[] =
{
X (eax),
X (ecx),
X (edx),
X (ebx),
X (esp),
X (ebp),
X (esi),
X (edi),
X (eip),
X (flags),
X (cs),
X (ss),
X (ds),
X (es),
X (ecode),
X (fault),
};
#endif
#ifdef M68K
static int regmap[] =
{
X (regs[0]),
X (regs[1]),
X (regs[2]),
X (regs[3]),
X (regs[4]),
X (regs[5]),
X (regs[6]),
X (regs[7]),
X (regs[8]),
X (regs[9]),
X (regs[10]),
X (regs[11]),
X (regs[12]),
X (regs[13]),
X (regs[14]),
0,
X (status),
X (pc),
X (fregs[0 * 3]),
X (fregs[1 * 3]),
X (fregs[2 * 3]),
X (fregs[3 * 3]),
X (fregs[4 * 3]),
X (fregs[5 * 3]),
X (fregs[6 * 3]),
X (fregs[7 * 3]),
X (fcregs[0]),
X (fcregs[1]),
X (fcregs[2]),
X (ssw),
X (fault),
};
#endif
#ifdef SPARC
#define FX(ENTRY)(offsetof(struct fcontext, ENTRY))
static int regmap[] =
{
-1,
X (g1),
X (g2),
X (g3),
X (g4),
-1,
-1,
-1,
X (o[0]),
X (o[1]),
X (o[2]),
X (o[3]),
X (o[4]),
X (o[5]),
X (o[6]),
X (o[7]),
-1, -1, -1, -1, -1, -1, -1, -1,
-1, -1, -1, -1, -1, -1, -1, -1,
FX (f.fregs[0]),
FX (f.fregs[1]),
FX (f.fregs[2]),
FX (f.fregs[3]),
FX (f.fregs[4]),
FX (f.fregs[5]),
FX (f.fregs[6]),
FX (f.fregs[7]),
FX (f.fregs[8]),
FX (f.fregs[9]),
FX (f.fregs[10]),
FX (f.fregs[11]),
FX (f.fregs[12]),
FX (f.fregs[13]),
FX (f.fregs[14]),
FX (f.fregs[15]),
FX (f.fregs[16]),
FX (f.fregs[17]),
FX (f.fregs[18]),
FX (f.fregs[19]),
FX (f.fregs[20]),
FX (f.fregs[21]),
FX (f.fregs[22]),
FX (f.fregs[23]),
FX (f.fregs[24]),
FX (f.fregs[25]),
FX (f.fregs[26]),
FX (f.fregs[27]),
FX (f.fregs[28]),
FX (f.fregs[29]),
FX (f.fregs[30]),
FX (f.fregs[31]),
X (y),
X (psr),
X (wim),
X (tbr),
X (pc),
X (npc),
FX (fsr),
-1,
};
#endif
#ifdef SPARC
void
fetch_inferior_registers (int regno)
{
#if 0
int whatregs = 0;
#define WHATREGS_FLOAT 1
#define WHATREGS_GEN 2
#define WHATREGS_STACK 4
if (regno == -1)
whatregs = WHATREGS_FLOAT | WHATREGS_GEN | WHATREGS_STACK;
else if (regno >= L0_REGNUM && regno <= I7_REGNUM)
whatregs = WHATREGS_STACK;
else if (regno >= FP0_REGNUM && regno < FP0_REGNUM + 32)
whatregs = WHATREGS_FLOAT;
else
whatregs = WHATREGS_GEN;
if (whatregs & WHATREGS_GEN)
{
struct econtext ec;
char buf[MAX_REGISTER_RAW_SIZE];
int retval;
int i;
errno = 0;
retval = ptrace (PTRACE_GETREGS,
BUILDPID (inferior_pid, general_thread),
(PTRACE_ARG3_TYPE) & ec,
0);
if (errno)
perror_with_name ("Sparc fetch_inferior_registers(ptrace)");
memset (buf, 0, REGISTER_RAW_SIZE (G0_REGNUM));
supply_register (G0_REGNUM, buf);
supply_register (TBR_REGNUM, (char *) &ec.tbr);
memcpy (®isters[REGISTER_BYTE (G1_REGNUM)], &ec.g1,
4 * REGISTER_RAW_SIZE (G1_REGNUM));
for (i = G1_REGNUM; i <= G1_REGNUM + 3; i++)
register_valid[i] = 1;
supply_register (PS_REGNUM, (char *) &ec.psr);
supply_register (Y_REGNUM, (char *) &ec.y);
supply_register (PC_REGNUM, (char *) &ec.pc);
supply_register (NPC_REGNUM, (char *) &ec.npc);
supply_register (WIM_REGNUM, (char *) &ec.wim);
memcpy (®isters[REGISTER_BYTE (O0_REGNUM)], ec.o,
8 * REGISTER_RAW_SIZE (O0_REGNUM));
for (i = O0_REGNUM; i <= O0_REGNUM + 7; i++)
register_valid[i] = 1;
}
if (whatregs & WHATREGS_STACK)
{
CORE_ADDR sp;
int i;
sp = read_register (SP_REGNUM);
target_xfer_memory (sp + FRAME_SAVED_I0,
®isters[REGISTER_BYTE (I0_REGNUM)],
8 * REGISTER_RAW_SIZE (I0_REGNUM), 0);
for (i = I0_REGNUM; i <= I7_REGNUM; i++)
register_valid[i] = 1;
target_xfer_memory (sp + FRAME_SAVED_L0,
®isters[REGISTER_BYTE (L0_REGNUM)],
8 * REGISTER_RAW_SIZE (L0_REGNUM), 0);
for (i = L0_REGNUM; i <= L0_REGNUM + 7; i++)
register_valid[i] = 1;
}
if (whatregs & WHATREGS_FLOAT)
{
struct fcontext fc;
int retval;
int i;
errno = 0;
retval = ptrace (PTRACE_GETFPREGS, BUILDPID (inferior_pid, general_thread), (PTRACE_ARG3_TYPE) & fc,
0);
if (errno)
perror_with_name ("Sparc fetch_inferior_registers(ptrace)");
memcpy (®isters[REGISTER_BYTE (FP0_REGNUM)], fc.f.fregs,
32 * REGISTER_RAW_SIZE (FP0_REGNUM));
for (i = FP0_REGNUM; i <= FP0_REGNUM + 31; i++)
register_valid[i] = 1;
supply_register (FPS_REGNUM, (char *) &fc.fsr);
}
#endif
}
void
store_inferior_registers (int regno)
{
#if 0
int whatregs = 0;
if (regno == -1)
whatregs = WHATREGS_FLOAT | WHATREGS_GEN | WHATREGS_STACK;
else if (regno >= L0_REGNUM && regno <= I7_REGNUM)
whatregs = WHATREGS_STACK;
else if (regno >= FP0_REGNUM && regno < FP0_REGNUM + 32)
whatregs = WHATREGS_FLOAT;
else if (regno == SP_REGNUM)
whatregs = WHATREGS_STACK | WHATREGS_GEN;
else
whatregs = WHATREGS_GEN;
if (whatregs & WHATREGS_GEN)
{
struct econtext ec;
int retval;
ec.tbr = read_register (TBR_REGNUM);
memcpy (&ec.g1, ®isters[REGISTER_BYTE (G1_REGNUM)],
4 * REGISTER_RAW_SIZE (G1_REGNUM));
ec.psr = read_register (PS_REGNUM);
ec.y = read_register (Y_REGNUM);
ec.pc = read_register (PC_REGNUM);
ec.npc = read_register (NPC_REGNUM);
ec.wim = read_register (WIM_REGNUM);
memcpy (ec.o, ®isters[REGISTER_BYTE (O0_REGNUM)],
8 * REGISTER_RAW_SIZE (O0_REGNUM));
errno = 0;
retval = ptrace (PTRACE_SETREGS, BUILDPID (inferior_pid, general_thread), (PTRACE_ARG3_TYPE) & ec,
0);
if (errno)
perror_with_name ("Sparc fetch_inferior_registers(ptrace)");
}
if (whatregs & WHATREGS_STACK)
{
int regoffset;
CORE_ADDR sp;
sp = read_register (SP_REGNUM);
if (regno == -1 || regno == SP_REGNUM)
{
if (!register_valid[L0_REGNUM + 5])
abort ();
target_xfer_memory (sp + FRAME_SAVED_I0,
®isters[REGISTER_BYTE (I0_REGNUM)],
8 * REGISTER_RAW_SIZE (I0_REGNUM), 1);
target_xfer_memory (sp + FRAME_SAVED_L0,
®isters[REGISTER_BYTE (L0_REGNUM)],
8 * REGISTER_RAW_SIZE (L0_REGNUM), 1);
}
else if (regno >= L0_REGNUM && regno <= I7_REGNUM)
{
if (!register_valid[regno])
abort ();
if (regno >= L0_REGNUM && regno <= L0_REGNUM + 7)
regoffset = REGISTER_BYTE (regno) - REGISTER_BYTE (L0_REGNUM)
+ FRAME_SAVED_L0;
else
regoffset = REGISTER_BYTE (regno) - REGISTER_BYTE (I0_REGNUM)
+ FRAME_SAVED_I0;
target_xfer_memory (sp + regoffset, ®isters[REGISTER_BYTE (regno)],
REGISTER_RAW_SIZE (regno), 1);
}
}
if (whatregs & WHATREGS_FLOAT)
{
struct fcontext fc;
int retval;
errno = 0;
retval = ptrace (PTRACE_GETFPREGS, BUILDPID (inferior_pid, general_thread), (PTRACE_ARG3_TYPE) & fc,
0);
if (errno)
perror_with_name ("Sparc fetch_inferior_registers(ptrace)");
memcpy (fc.f.fregs, ®isters[REGISTER_BYTE (FP0_REGNUM)],
32 * REGISTER_RAW_SIZE (FP0_REGNUM));
fc.fsr = read_register (FPS_REGNUM);
errno = 0;
retval = ptrace (PTRACE_SETFPREGS, BUILDPID (inferior_pid, general_thread), (PTRACE_ARG3_TYPE) & fc,
0);
if (errno)
perror_with_name ("Sparc fetch_inferior_registers(ptrace)");
}
#endif
}
#endif
#ifndef SPARC
static unsigned long
lynx_registers_addr (void)
{
CORE_ADDR stblock;
int ecpoff = offsetof (st_t, ecp);
CORE_ADDR ecp;
errno = 0;
stblock = (CORE_ADDR) ptrace (PTRACE_THREADUSER, BUILDPID (inferior_pid, general_thread),
(PTRACE_ARG3_TYPE) 0, 0);
if (errno)
perror_with_name ("PTRACE_THREADUSER");
ecp = (CORE_ADDR) ptrace (PTRACE_PEEKTHREAD, BUILDPID (inferior_pid, general_thread),
(PTRACE_ARG3_TYPE) ecpoff, 0);
if (errno)
perror_with_name ("lynx_registers_addr(PTRACE_PEEKTHREAD)");
return ecp - stblock;
}
void
fetch_inferior_registers (int ignored)
{
int regno;
unsigned long reg;
unsigned long ecp;
ecp = lynx_registers_addr ();
for (regno = 0; regno < NUM_REGS; regno++)
{
int ptrace_fun = PTRACE_PEEKTHREAD;
#ifdef PTRACE_PEEKUSP
ptrace_fun = regno == SP_REGNUM ? PTRACE_PEEKUSP : PTRACE_PEEKTHREAD;
#endif
errno = 0;
reg = ptrace (ptrace_fun, BUILDPID (inferior_pid, general_thread),
(PTRACE_ARG3_TYPE) (ecp + regmap[regno]), 0);
if (errno)
perror_with_name ("fetch_inferior_registers(PTRACE_PEEKTHREAD)");
*(unsigned long *) ®isters[REGISTER_BYTE (regno)] = reg;
}
}
void
store_inferior_registers (int ignored)
{
int regno;
unsigned long reg;
unsigned long ecp;
ecp = lynx_registers_addr ();
for (regno = 0; regno < NUM_REGS; regno++)
{
int ptrace_fun = PTRACE_POKEUSER;
#ifdef PTRACE_POKEUSP
ptrace_fun = regno == SP_REGNUM ? PTRACE_POKEUSP : PTRACE_POKEUSER;
#endif
reg = *(unsigned long *) ®isters[REGISTER_BYTE (regno)];
errno = 0;
ptrace (ptrace_fun, BUILDPID (inferior_pid, general_thread),
(PTRACE_ARG3_TYPE) (ecp + regmap[regno]), reg);
if (errno)
perror_with_name ("PTRACE_POKEUSER");
}
}
#endif
void
read_inferior_memory (CORE_ADDR memaddr, char *myaddr, int len)
{
register int i;
register CORE_ADDR addr = memaddr & -(CORE_ADDR) sizeof (int);
register int count
= (((memaddr + len) - addr) + sizeof (int) - 1) / sizeof (int);
register int *buffer = (int *) alloca (count * sizeof (int));
for (i = 0; i < count; i++, addr += sizeof (int))
{
buffer[i] = ptrace (PTRACE_PEEKTEXT, BUILDPID (inferior_pid, general_thread), addr, 0);
}
memcpy (myaddr, (char *) buffer + (memaddr & (sizeof (int) - 1)), len);
}
int
write_inferior_memory (CORE_ADDR memaddr, char *myaddr, int len)
{
register int i;
register CORE_ADDR addr = memaddr & -(CORE_ADDR) sizeof (int);
register int count
= (((memaddr + len) - addr) + sizeof (int) - 1) / sizeof (int);
register int *buffer = (int *) alloca (count * sizeof (int));
extern int errno;
buffer[0] = ptrace (PTRACE_PEEKTEXT, BUILDPID (inferior_pid, general_thread), addr, 0);
if (count > 1)
{
buffer[count - 1]
= ptrace (PTRACE_PEEKTEXT, BUILDPID (inferior_pid, general_thread),
addr + (count - 1) * sizeof (int), 0);
}
memcpy ((char *) buffer + (memaddr & (sizeof (int) - 1)), myaddr, len);
for (i = 0; i < count; i++, addr += sizeof (int))
{
while (1)
{
errno = 0;
ptrace (PTRACE_POKETEXT, BUILDPID (inferior_pid, general_thread), addr, buffer[i]);
if (errno)
{
fprintf (stderr, "\
ptrace (PTRACE_POKETEXT): errno=%d, pid=0x%x, addr=0x%x, buffer[i] = 0x%x\n",
errno, BUILDPID (inferior_pid, general_thread),
addr, buffer[i]);
fprintf (stderr, "Sleeping for 1 second\n");
sleep (1);
}
else
break;
}
}
return 0;
}
void
initialize_low (void)
{
}