#include "defs.h"
#include "gdb_string.h"
#include <fcntl.h>
#include "frame.h"
#include "inferior.h"
#include "exceptions.h"
#include "bfd.h"
#include "symfile.h"
#include "target.h"
#include "gdbcmd.h"
#include "objfiles.h"
#include "gdb-stabs.h"
#include "gdbthread.h"
#include "gdbcore.h"
#include "regcache.h"
#include <signal.h>
#include "serial.h"
extern void _initialize_remote_sds (void);
static int sds_write_bytes (CORE_ADDR, char *, int);
static int sds_read_bytes (CORE_ADDR, char *, int);
static void sds_files_info (struct target_ops *ignore);
static int sds_xfer_memory (CORE_ADDR, char *, int, int,
struct mem_attrib *, struct target_ops *);
static void sds_prepare_to_store (void);
static void sds_fetch_registers (int);
static void sds_resume (ptid_t, int, enum target_signal);
static int sds_start_remote (void *);
static void sds_open (char *, int);
static void sds_close (int);
static void sds_store_registers (int);
static void sds_mourn (void);
static void sds_load (char *, int);
static int getmessage (unsigned char *, int);
static int putmessage (unsigned char *, int);
static int sds_send (unsigned char *, int);
static int readchar (int);
static ptid_t sds_wait (ptid_t, struct target_waitstatus *);
static void sds_kill (void);
static int fromhex (int);
static void sds_detach (char *, int);
static void sds_interrupt (int);
static void sds_interrupt_twice (int);
static void interrupt_query (void);
static int read_frame (char *);
static int sds_insert_breakpoint (CORE_ADDR, char *);
static int sds_remove_breakpoint (CORE_ADDR, char *);
static void init_sds_ops (void);
static void sds_command (char *args, int from_tty);
static struct target_ops sds_ops;
static int sds_timeout = 2;
static struct serial *sds_desc = NULL;
#define PBUFSIZ 250
#define MAXBUFBYTES ((PBUFSIZ-32)/2)
static int next_msg_id;
static int just_started;
static int message_pending;
static void
sds_close (int quitting)
{
if (sds_desc)
serial_close (sds_desc);
sds_desc = NULL;
}
static int
sds_start_remote (void *dummy)
{
int c;
unsigned char buf[200];
immediate_quit++;
serial_write (sds_desc, "{#*\r\n", 5);
serial_write (sds_desc, "{#}\r\n", 5);
while ((c = readchar (1)) >= 0)
printf_unfiltered ("%c", c);
printf_unfiltered ("\n");
next_msg_id = 251;
buf[0] = 26;
sds_send (buf, 1);
buf[0] = 0;
sds_send (buf, 1);
immediate_quit--;
start_remote ();
return 1;
}
static void
sds_open (char *name, int from_tty)
{
if (name == 0)
error ("To open a remote debug connection, you need to specify what serial\n\
device is attached to the remote system (e.g. /dev/ttya).");
target_preopen (from_tty);
unpush_target (&sds_ops);
sds_desc = serial_open (name);
if (!sds_desc)
perror_with_name (name);
if (baud_rate != -1)
{
if (serial_setbaudrate (sds_desc, baud_rate))
{
serial_close (sds_desc);
perror_with_name (name);
}
}
serial_raw (sds_desc);
serial_flush_input (sds_desc);
if (from_tty)
{
puts_filtered ("Remote debugging using ");
puts_filtered (name);
puts_filtered ("\n");
}
push_target (&sds_ops);
just_started = 1;
if (!catch_errors (sds_start_remote, NULL,
"Couldn't establish connection to remote target\n",
RETURN_MASK_ALL))
pop_target ();
}
static void
sds_detach (char *args, int from_tty)
{
char buf[PBUFSIZ];
if (args)
error ("Argument given to \"detach\" when remotely debugging.");
#if 0
strcpy (buf, "D");
sds_send (buf, 1);
#endif
pop_target ();
if (from_tty)
puts_filtered ("Ending remote debugging.\n");
}
static int
fromhex (int a)
{
if (a >= '0' && a <= '9')
return a - '0';
else if (a >= 'a' && a <= 'f')
return a - 'a' + 10;
else
error ("Reply contains invalid hex digit %d", a);
}
static int
tob64 (unsigned char *inbuf, char *outbuf, int len)
{
int i, sum;
char *p;
if (len % 3 != 0)
error ("bad length");
p = outbuf;
for (i = 0; i < len; i += 3)
{
sum = ((long) *inbuf++) << 16;
sum |= ((long) *inbuf++) << 8;
sum |= ((long) *inbuf++);
*p++ = ((sum >> 18) & 0x3f) + '0';
*p++ = ((sum >> 12) & 0x3f) + '0';
*p++ = ((sum >> 6) & 0x3f) + '0';
*p++ = (sum & 0x3f) + '0';
}
return (p - outbuf);
}
static int
fromb64 (char *inbuf, char *outbuf, int len)
{
int i, sum;
if (len % 4 != 0)
error ("bad length");
for (i = 0; i < len; i += 4)
{
sum = (*inbuf++ - '0') << 18;
sum |= (*inbuf++ - '0') << 12;
sum |= (*inbuf++ - '0') << 6;
sum |= (*inbuf++ - '0');
*outbuf++ = (sum >> 16) & 0xff;
*outbuf++ = (sum >> 8) & 0xff;
*outbuf++ = sum & 0xff;
}
return (len / 4) * 3;
}
static enum target_signal last_sent_signal = TARGET_SIGNAL_0;
int last_sent_step;
static void
sds_resume (ptid_t ptid, int step, enum target_signal siggnal)
{
unsigned char buf[PBUFSIZ];
last_sent_signal = siggnal;
last_sent_step = step;
buf[0] = (step ? 21 : 20);
buf[1] = 0;
sds_send (buf, 2);
}
static void
sds_interrupt (int signo)
{
unsigned char buf[PBUFSIZ];
signal (signo, sds_interrupt_twice);
if (remote_debug)
fprintf_unfiltered (gdb_stdlog, "sds_interrupt called\n");
buf[0] = 25;
sds_send (buf, 1);
}
static void (*ofunc) ();
static void
sds_interrupt_twice (int signo)
{
signal (signo, ofunc);
interrupt_query ();
signal (signo, sds_interrupt);
}
static void
interrupt_query (void)
{
target_terminal_ours ();
if (query ("Interrupted while waiting for the program.\n\
Give up (and stop debugging it)? "))
{
target_mourn_inferior ();
deprecated_throw_reason (RETURN_QUIT);
}
target_terminal_inferior ();
}
int kill_kludge;
static ptid_t
sds_wait (ptid_t ptid, struct target_waitstatus *status)
{
unsigned char buf[PBUFSIZ];
int retlen;
status->kind = TARGET_WAITKIND_EXITED;
status->value.integer = 0;
ofunc = (void (*)()) signal (SIGINT, sds_interrupt);
signal (SIGINT, ofunc);
if (just_started)
{
just_started = 0;
status->kind = TARGET_WAITKIND_STOPPED;
return inferior_ptid;
}
while (1)
{
getmessage (buf, 1);
if (message_pending)
{
buf[0] = 26;
retlen = sds_send (buf, 1);
if (remote_debug)
{
fprintf_unfiltered (gdb_stdlog, "Signals: %02x%02x %02x %02x\n",
buf[0], buf[1],
buf[2], buf[3]);
}
message_pending = 0;
status->kind = TARGET_WAITKIND_STOPPED;
status->value.sig = TARGET_SIGNAL_TRAP;
goto got_status;
}
}
got_status:
return inferior_ptid;
}
static unsigned char sprs[16];
static void
sds_fetch_registers (int regno)
{
unsigned char buf[PBUFSIZ];
int i, retlen;
char *regs = alloca (deprecated_register_bytes ());
memset (regs, 0, deprecated_register_bytes ());
buf[0] = 18;
buf[1] = 1;
buf[2] = 0;
retlen = sds_send (buf, 3);
for (i = 0; i < 4 * 6; ++i)
regs[i + 4 * 32 + 8 * 32] = buf[i];
for (i = 0; i < 4 * 4; ++i)
sprs[i] = buf[i + 4 * 7];
buf[0] = 18;
buf[1] = 2;
buf[2] = 0;
retlen = sds_send (buf, 3);
for (i = 0; i < retlen; i++)
regs[i] = buf[i];
for (i = 0; i < NUM_REGS; i++)
regcache_raw_supply (current_regcache, i,
®s[DEPRECATED_REGISTER_BYTE (i)]);
}
static void
sds_prepare_to_store (void)
{
deprecated_read_register_bytes (0, (char *) NULL, deprecated_register_bytes ());
}
static void
sds_store_registers (int regno)
{
unsigned char *p, buf[PBUFSIZ];
int i;
p = buf;
*p++ = 19;
*p++ = 1;
*p++ = 0;
*p++ = 0;
for (i = 0; i < 4 * 6; i++)
*p++ = deprecated_registers[i + 4 * 32 + 8 * 32];
for (i = 0; i < 4 * 1; i++)
*p++ = 0;
for (i = 0; i < 4 * 4; i++)
*p++ = sprs[i];
sds_send (buf, p - buf);
p = buf;
*p++ = 19;
*p++ = 2;
*p++ = 0;
*p++ = 0;
for (i = 0; i < 4 * 32; i++)
*p++ = deprecated_registers[i];
sds_send (buf, p - buf);
}
static int
sds_write_bytes (CORE_ADDR memaddr, char *myaddr, int len)
{
int max_buf_size;
int origlen;
unsigned char buf[PBUFSIZ];
int todo;
int i;
max_buf_size = 150;
origlen = len;
while (len > 0)
{
todo = min (len, max_buf_size);
buf[0] = 13;
buf[1] = 0;
buf[2] = (int) (memaddr >> 24) & 0xff;
buf[3] = (int) (memaddr >> 16) & 0xff;
buf[4] = (int) (memaddr >> 8) & 0xff;
buf[5] = (int) (memaddr) & 0xff;
buf[6] = 1;
buf[7] = 0;
for (i = 0; i < todo; i++)
buf[i + 8] = myaddr[i];
sds_send (buf, 8 + todo);
myaddr += todo;
memaddr += todo;
len -= todo;
}
return origlen;
}
static int
sds_read_bytes (CORE_ADDR memaddr, char *myaddr, int len)
{
int max_buf_size;
int origlen, retlen;
unsigned char buf[PBUFSIZ];
int todo;
int i;
max_buf_size = 150;
origlen = len;
while (len > 0)
{
todo = min (len, max_buf_size);
buf[0] = 12;
buf[1] = 0;
buf[2] = (int) (memaddr >> 24) & 0xff;
buf[3] = (int) (memaddr >> 16) & 0xff;
buf[4] = (int) (memaddr >> 8) & 0xff;
buf[5] = (int) (memaddr) & 0xff;
buf[6] = (int) (todo >> 8) & 0xff;
buf[7] = (int) (todo) & 0xff;
buf[8] = 1;
retlen = sds_send (buf, 9);
if (retlen - 2 != todo)
{
return 0;
}
for (i = 0; i < todo; i++)
myaddr[i] = buf[i + 2];
myaddr += todo;
memaddr += todo;
len -= todo;
}
return origlen;
}
static int
sds_xfer_memory (CORE_ADDR memaddr, char *myaddr, int len, int should_write,
struct mem_attrib *attrib, struct target_ops *target)
{
int res;
if (should_write)
res = sds_write_bytes (memaddr, myaddr, len);
else
res = sds_read_bytes (memaddr, myaddr, len);
return res;
}
static void
sds_files_info (struct target_ops *ignore)
{
puts_filtered ("Debugging over a serial connection, using SDS protocol.\n");
}
static int
readchar (int timeout)
{
int ch;
ch = serial_readchar (sds_desc, timeout);
if (remote_debug > 1 && ch >= 0)
fprintf_unfiltered (gdb_stdlog, "%c(%x)", ch, ch);
switch (ch)
{
case SERIAL_EOF:
error ("Remote connection closed");
case SERIAL_ERROR:
perror_with_name ("Remote communication error");
case SERIAL_TIMEOUT:
return ch;
default:
return ch & 0x7f;
}
}
static int
compute_checksum (int csum, char *buf, int len)
{
int i;
for (i = 0; i < len; ++i)
csum += (unsigned char) buf[i];
csum %= 253;
return csum;
}
static int
sds_send (unsigned char *buf, int len)
{
putmessage (buf, len);
return getmessage (buf, 0);
}
static int
putmessage (unsigned char *buf, int len)
{
int i, enclen;
unsigned char csum = 0;
char buf2[PBUFSIZ], buf3[PBUFSIZ];
unsigned char header[3];
char *p;
if (len > 170)
internal_error (__FILE__, __LINE__, _("failed internal consistency check"));
if (remote_debug)
{
fprintf_unfiltered (gdb_stdlog, "Message to send: \"");
for (i = 0; i < len; ++i)
fprintf_unfiltered (gdb_stdlog, "%02x", buf[i]);
fprintf_unfiltered (gdb_stdlog, "\"\n");
}
p = buf2;
*p++ = '$';
if (len % 3 != 0)
{
buf[len] = '\0';
buf[len + 1] = '\0';
}
header[1] = next_msg_id;
header[2] = len;
csum = compute_checksum (csum, buf, len);
csum = compute_checksum (csum, header + 1, 2);
header[0] = csum;
tob64 (header, p, 3);
p += 4;
enclen = tob64 (buf, buf3, ((len + 2) / 3) * 3);
for (i = 0; i < enclen; ++i)
*p++ = buf3[i];
*p++ = '\r';
*p++ = '\n';
next_msg_id = (next_msg_id + 3) % 245;
while (1)
{
if (remote_debug)
{
*p = '\0';
fprintf_unfiltered (gdb_stdlog, "Sending encoded: \"%s\"", buf2);
fprintf_unfiltered (gdb_stdlog,
" (Checksum %d, id %d, length %d)\n",
header[0], header[1], header[2]);
gdb_flush (gdb_stdlog);
}
if (serial_write (sds_desc, buf2, p - buf2))
perror_with_name ("putmessage: write failed");
return 1;
}
}
static int
read_frame (char *buf)
{
char *bp;
int c;
bp = buf;
while (1)
{
c = readchar (sds_timeout);
switch (c)
{
case SERIAL_TIMEOUT:
if (remote_debug)
fputs_filtered ("Timeout in mid-message, retrying\n", gdb_stdlog);
return 0;
case '$':
if (remote_debug)
fputs_filtered ("Saw new packet start in middle of old one\n",
gdb_stdlog);
return 0;
case '\r':
break;
case '\n':
{
*bp = '\000';
if (remote_debug)
fprintf_unfiltered (gdb_stdlog, "Received encoded: \"%s\"\n",
buf);
return 1;
}
default:
if (bp < buf + PBUFSIZ - 1)
{
*bp++ = c;
continue;
}
*bp = '\0';
puts_filtered ("Message too long: ");
puts_filtered (buf);
puts_filtered ("\n");
return 0;
}
}
}
static int
getmessage (unsigned char *buf, int forever)
{
int c, c2, c3;
int tries;
int timeout;
int val, i, len, csum;
unsigned char header[3];
unsigned char inbuf[500];
strcpy (buf, "timeout");
if (forever)
{
timeout = watchdog > 0 ? watchdog : -1;
}
else
timeout = sds_timeout;
#define MAX_TRIES 3
for (tries = 1; tries <= MAX_TRIES; tries++)
{
do
{
c = readchar (timeout);
if (c == SERIAL_TIMEOUT)
{
if (forever)
{
target_mourn_inferior ();
error ("Watchdog has expired. Target detached.\n");
}
if (remote_debug)
fputs_filtered ("Timed out.\n", gdb_stdlog);
goto retry;
}
}
while (c != '$' && c != '{');
if (c == '{')
{
c2 = readchar (timeout);
c3 = readchar (timeout);
if (remote_debug)
fprintf_unfiltered (gdb_stdlog, "Trigraph %c%c%c received\n",
c, c2, c3);
if (c3 == '+')
{
message_pending = 1;
return 0;
}
continue;
}
val = read_frame (inbuf);
if (val == 1)
{
fromb64 (inbuf, header, 4);
fromb64 (inbuf + 4, buf, strlen (inbuf) - 4);
len = header[2];
csum = 0;
csum = compute_checksum (csum, buf, len);
csum = compute_checksum (csum, header + 1, 2);
if (csum != header[0])
fprintf_unfiltered (gdb_stderr,
"Checksum mismatch: computed %d, received %d\n",
csum, header[0]);
if (header[2] == 0xff)
fprintf_unfiltered (gdb_stderr, "Requesting resend...\n");
if (remote_debug)
{
fprintf_unfiltered (gdb_stdlog,
"... (Got checksum %d, id %d, length %d)\n",
header[0], header[1], header[2]);
fprintf_unfiltered (gdb_stdlog, "Message received: \"");
for (i = 0; i < len; ++i)
{
fprintf_unfiltered (gdb_stdlog, "%02x", (unsigned char) buf[i]);
}
fprintf_unfiltered (gdb_stdlog, "\"\n");
}
return len;
}
retry:
;
}
printf_unfiltered ("Ignoring packet error, continuing...\n");
return 0;
}
static void
sds_kill (void)
{
}
static void
sds_mourn (void)
{
unpush_target (&sds_ops);
generic_mourn_inferior ();
}
static void
sds_create_inferior (char *exec_file, char *args, char **env, int from_tty)
{
inferior_ptid = pid_to_ptid (42000);
clear_proceed_status ();
proceed (bfd_get_start_address (exec_bfd), TARGET_SIGNAL_0, 0);
}
static void
sds_load (char *filename, int from_tty)
{
generic_load (filename, from_tty);
inferior_ptid = null_ptid;
}
static int
sds_insert_breakpoint (CORE_ADDR addr, char *contents_cache)
{
int i, retlen;
unsigned char *p, buf[PBUFSIZ];
p = buf;
*p++ = 16;
*p++ = 0;
*p++ = (int) (addr >> 24) & 0xff;
*p++ = (int) (addr >> 16) & 0xff;
*p++ = (int) (addr >> 8) & 0xff;
*p++ = (int) (addr) & 0xff;
retlen = sds_send (buf, p - buf);
for (i = 0; i < 4; ++i)
contents_cache[i] = buf[i + 2];
return 0;
}
static int
sds_remove_breakpoint (CORE_ADDR addr, char *contents_cache)
{
int i, retlen;
unsigned char *p, buf[PBUFSIZ];
p = buf;
*p++ = 17;
*p++ = 0;
*p++ = (int) (addr >> 24) & 0xff;
*p++ = (int) (addr >> 16) & 0xff;
*p++ = (int) (addr >> 8) & 0xff;
*p++ = (int) (addr) & 0xff;
for (i = 0; i < 4; ++i)
*p++ = contents_cache[i];
retlen = sds_send (buf, p - buf);
return 0;
}
static void
init_sds_ops (void)
{
sds_ops.to_shortname = "sds";
sds_ops.to_longname = "Remote serial target with SDS protocol";
sds_ops.to_doc = "Use a remote computer via a serial line; using the SDS protocol.\n\
Specify the serial device it is connected to (e.g. /dev/ttya).";
sds_ops.to_open = sds_open;
sds_ops.to_close = sds_close;
sds_ops.to_detach = sds_detach;
sds_ops.to_resume = sds_resume;
sds_ops.to_wait = sds_wait;
sds_ops.to_fetch_registers = sds_fetch_registers;
sds_ops.to_store_registers = sds_store_registers;
sds_ops.to_prepare_to_store = sds_prepare_to_store;
sds_ops.deprecated_xfer_memory = sds_xfer_memory;
sds_ops.to_files_info = sds_files_info;
sds_ops.to_insert_breakpoint = sds_insert_breakpoint;
sds_ops.to_remove_breakpoint = sds_remove_breakpoint;
sds_ops.to_kill = sds_kill;
sds_ops.to_load = sds_load;
sds_ops.to_create_inferior = sds_create_inferior;
sds_ops.to_mourn_inferior = sds_mourn;
sds_ops.to_stratum = process_stratum;
sds_ops.to_has_all_memory = 1;
sds_ops.to_has_memory = 1;
sds_ops.to_has_stack = 1;
sds_ops.to_has_registers = 1;
sds_ops.to_has_execution = 1;
sds_ops.to_magic = OPS_MAGIC;
}
static void
sds_command (char *args, int from_tty)
{
char *p;
int i, len, retlen;
unsigned char buf[1000];
p = args;
len = 0;
while (*p != '\0')
{
buf[len++] = fromhex (p[0]) * 16 + fromhex (p[1]);
if (p[1] == '\0')
break;
p += 2;
}
retlen = sds_send (buf, len);
printf_filtered ("Reply is ");
for (i = 0; i < retlen; ++i)
{
printf_filtered ("%02x", buf[i]);
}
printf_filtered ("\n");
}
void
_initialize_remote_sds (void)
{
init_sds_ops ();
add_target (&sds_ops);
add_setshow_integer_cmd ("sdstimeout", no_class, &sds_timeout, _("\
Set timeout value for sds read."), _("\
Show timeout value for sds read."), NULL,
NULL,
NULL,
&setlist, &showlist);
add_com ("sds", class_obscure, sds_command,
_("Send a command to the SDS monitor."));
}