#include "defs.h"
#include "gdbcore.h"
#include "target.h"
#include "gdb_string.h"
#include <sys/types.h>
#include "serial.h"
#include "regcache.h"
extern struct target_ops st2000_ops;
static void st2000_close ();
static void st2000_fetch_register ();
static void st2000_store_register ();
#define LOG_FILE "st2000.log"
#if defined (LOG_FILE)
FILE *log_file;
#endif
static int timeout = 24;
static struct serial *st2000_desc;
static void
printf_stdebug (char *pattern,...)
{
va_list args;
char buf[200];
va_start (args, pattern);
vsprintf (buf, pattern, args);
va_end (args);
if (serial_write (st2000_desc, buf, strlen (buf)))
fprintf_unfiltered (gdb_stderr, "serial_write failed: %s\n",
safe_strerror (errno));
}
static int
readchar (int timeout)
{
int c;
c = serial_readchar (st2000_desc, timeout);
#ifdef LOG_FILE
putc (c & 0x7f, log_file);
#endif
if (c >= 0)
return c & 0x7f;
if (c == SERIAL_TIMEOUT)
{
if (timeout == 0)
return c;
error ("Timeout reading from remote system.");
}
perror_with_name ("remote-st2000");
}
static void
expect (char *string, int discard)
{
char *p = string;
int c;
immediate_quit++;
while (1)
{
c = readchar (timeout);
if (c == *p++)
{
if (*p == '\0')
{
immediate_quit--;
return;
}
}
else
{
if (!discard)
{
fwrite (string, 1, (p - 1) - string, stdout);
putchar ((char) c);
fflush (stdout);
}
p = string;
}
}
}
static void
expect_prompt (int discard)
{
#if defined (LOG_FILE)
fflush (log_file);
#endif
expect ("dbug> ", discard);
}
static int
get_hex_digit (int ignore_space)
{
int ch;
while (1)
{
ch = readchar (timeout);
if (ch >= '0' && ch <= '9')
return ch - '0';
else if (ch >= 'A' && ch <= 'F')
return ch - 'A' + 10;
else if (ch >= 'a' && ch <= 'f')
return ch - 'a' + 10;
else if (ch == ' ' && ignore_space)
;
else
{
expect_prompt (1);
error ("Invalid hex digit from remote system.");
}
}
}
static void
get_hex_byte (char *byt)
{
int val;
val = get_hex_digit (1) << 4;
val |= get_hex_digit (0);
*byt = val;
}
static void
get_hex_regs (int n, int regno)
{
long val;
int i;
for (i = 0; i < n; i++)
{
int j;
val = 0;
for (j = 0; j < 8; j++)
val = (val << 4) + get_hex_digit (j == 0);
supply_register (regno++, (char *) &val);
}
}
static void
st2000_create_inferior (char *execfile, char *args, char **env)
{
int entry_pt;
if (args && *args)
error ("Can't pass arguments to remote STDEBUG process");
if (execfile == 0 || exec_bfd == 0)
error ("No executable file specified");
entry_pt = (int) bfd_get_start_address (exec_bfd);
clear_proceed_status ();
init_wait_for_inferior ();
target_terminal_init ();
target_terminal_inferior ();
proceed ((CORE_ADDR) entry_pt, TARGET_SIGNAL_DEFAULT, 0);
}
static int baudrate = 9600;
static char dev_name[100];
static void
st2000_open (char *args, int from_tty)
{
int n;
char junk[100];
target_preopen (from_tty);
n = sscanf (args, " %s %d %s", dev_name, &baudrate, junk);
if (n != 2)
error ("Bad arguments. Usage: target st2000 <device> <speed>\n\
or target st2000 <host> <port>\n");
st2000_close (0);
st2000_desc = serial_open (dev_name);
if (!st2000_desc)
perror_with_name (dev_name);
if (serial_setbaudrate (st2000_desc, baudrate))
{
serial_close (dev_name);
perror_with_name (dev_name);
}
serial_raw (st2000_desc);
push_target (&st2000_ops);
#if defined (LOG_FILE)
log_file = fopen (LOG_FILE, "w");
if (log_file == NULL)
perror_with_name (LOG_FILE);
#endif
printf_stdebug ("\003");
expect_prompt (1);
if (from_tty)
printf ("Remote %s connected to %s\n", target_shortname,
dev_name);
}
static void
st2000_close (int quitting)
{
serial_close (st2000_desc);
#if defined (LOG_FILE)
if (log_file)
{
if (ferror (log_file))
fprintf_unfiltered (gdb_stderr, "Error writing log file.\n");
if (fclose (log_file) != 0)
fprintf_unfiltered (gdb_stderr, "Error closing log file.\n");
}
#endif
}
static void
st2000_detach (int from_tty)
{
pop_target ();
if (from_tty)
printf ("Ending remote %s debugging\n", target_shortname);
}
static void
st2000_resume (ptid_t ptid, int step, enum target_signal sig)
{
if (step)
{
printf_stdebug ("ST\r");
expect ("ST\r", 1);
}
else
{
printf_stdebug ("GO\r");
expect ("GO\r", 1);
}
}
static ptid_t
st2000_wait (ptid_t ptid, struct target_waitstatus *status)
{
int old_timeout = timeout;
status->kind = TARGET_WAITKIND_EXITED;
status->value.integer = 0;
timeout = 0;
expect_prompt (0);
status->kind = TARGET_WAITKIND_STOPPED;
status->value.sig = TARGET_SIGNAL_TRAP;
timeout = old_timeout;
return inferior_ptid;
}
static char *
get_reg_name (int regno)
{
static char buf[50];
const char *p;
char *b;
b = buf;
for (p = REGISTER_NAME (regno); *p; p++)
*b++ = toupper (*p);
*b = '\000';
return buf;
}
static void
st2000_fetch_registers (void)
{
int regno;
for (regno = 0; regno <= PC_REGNUM; regno++)
st2000_fetch_register (regno);
}
static void
st2000_fetch_register (int regno)
{
if (regno == -1)
st2000_fetch_registers ();
else
{
char *name = get_reg_name (regno);
printf_stdebug ("DR %s\r", name);
expect (name, 1);
expect (" : ", 1);
get_hex_regs (1, regno);
expect_prompt (1);
}
return;
}
static void
st2000_store_registers (void)
{
int regno;
for (regno = 0; regno <= PC_REGNUM; regno++)
st2000_store_register (regno);
registers_changed ();
}
static void
st2000_store_register (int regno)
{
if (regno == -1)
st2000_store_registers ();
else
{
printf_stdebug ("PR %s %x\r", get_reg_name (regno),
read_register (regno));
expect_prompt (1);
}
}
static void
st2000_prepare_to_store (void)
{
}
static void
st2000_files_info (void)
{
printf ("\tAttached to %s at %d baud.\n",
dev_name, baudrate);
}
static int
st2000_write_inferior_memory (CORE_ADDR memaddr, unsigned char *myaddr, int len)
{
int i;
for (i = 0; i < len; i++)
{
printf_stdebug ("PM.B %x %x\r", memaddr + i, myaddr[i]);
expect_prompt (1);
}
return len;
}
static int
st2000_read_inferior_memory (CORE_ADDR memaddr, char *myaddr, int len)
{
int i;
int count;
unsigned long startaddr;
int len_this_pass;
if (((memaddr - 1) + len) < memaddr)
{
errno = EIO;
return 0;
}
startaddr = memaddr;
count = 0;
while (count < len)
{
len_this_pass = 16;
if ((startaddr % 16) != 0)
len_this_pass -= startaddr % 16;
if (len_this_pass > (len - count))
len_this_pass = (len - count);
printf_stdebug ("DI.L %x %x\r", startaddr, len_this_pass);
expect (": ", 1);
for (i = 0; i < len_this_pass; i++)
get_hex_byte (&myaddr[count++]);
expect_prompt (1);
startaddr += len_this_pass;
}
return len;
}
static int
st2000_xfer_inferior_memory (CORE_ADDR memaddr, char *myaddr, int len,
int write, struct mem_attrib *attrib,
struct target_ops *target)
{
if (write)
return st2000_write_inferior_memory (memaddr, myaddr, len);
else
return st2000_read_inferior_memory (memaddr, myaddr, len);
}
static void
st2000_kill (char *args, int from_tty)
{
return;
}
static void
st2000_mourn_inferior (void)
{
remove_breakpoints ();
unpush_target (&st2000_ops);
generic_mourn_inferior ();
}
#define MAX_STDEBUG_BREAKPOINTS 16
static CORE_ADDR breakaddr[MAX_STDEBUG_BREAKPOINTS] =
{0};
static int
st2000_insert_breakpoint (CORE_ADDR addr, char *shadow)
{
int i;
CORE_ADDR bp_addr = addr;
int bp_size = 0;
BREAKPOINT_FROM_PC (&bp_addr, &bp_size);
for (i = 0; i <= MAX_STDEBUG_BREAKPOINTS; i++)
if (breakaddr[i] == 0)
{
breakaddr[i] = addr;
st2000_read_inferior_memory (bp_addr, shadow, bp_size);
printf_stdebug ("BR %x H\r", addr);
expect_prompt (1);
return 0;
}
fprintf_unfiltered (gdb_stderr, "Too many breakpoints (> 16) for STDBUG\n");
return 1;
}
static int
st2000_remove_breakpoint (CORE_ADDR addr, char *shadow)
{
int i;
for (i = 0; i < MAX_STDEBUG_BREAKPOINTS; i++)
if (breakaddr[i] == addr)
{
breakaddr[i] = 0;
printf_stdebug ("CB %d\r", i);
expect_prompt (1);
return 0;
}
fprintf_unfiltered (gdb_stderr,
"Can't find breakpoint associated with 0x%x\n", addr);
return 1;
}
static void
st2000_command (char *args, int fromtty)
{
if (!st2000_desc)
error ("st2000 target not open.");
if (!args)
error ("Missing command.");
printf_stdebug ("%s\r", args);
expect_prompt (0);
}
static void
cleanup_tty (void)
{
printf ("\r\n[Exiting connect mode]\r\n");
}
#if 0
static void
connect_command (char *args, int fromtty)
{
fd_set readfds;
int numfds;
int c;
char cur_esc = 0;
dont_repeat ();
if (st2000_desc < 0)
error ("st2000 target not open.");
if (args)
fprintf ("This command takes no args. They have been ignored.\n");
printf ("[Entering connect mode. Use ~. or ~^D to escape]\n");
serial_raw (0, &ttystate);
make_cleanup (cleanup_tty, 0);
FD_ZERO (&readfds);
while (1)
{
do
{
FD_SET (0, &readfds);
FD_SET (deprecated_serial_fd (st2000_desc), &readfds);
numfds = select (sizeof (readfds) * 8, &readfds, 0, 0, 0);
}
while (numfds == 0);
if (numfds < 0)
perror_with_name ("select");
if (FD_ISSET (0, &readfds))
{
c = getchar ();
if (c < 0)
perror_with_name ("connect");
printf_stdebug ("%c", c);
switch (cur_esc)
{
case 0:
if (c == '\r')
cur_esc = c;
break;
case '\r':
if (c == '~')
cur_esc = c;
else
cur_esc = 0;
break;
case '~':
if (c == '.' || c == '\004')
return;
else
cur_esc = 0;
}
}
if (FD_ISSET (deprecated_serial_fd (st2000_desc), &readfds))
{
while (1)
{
c = readchar (0);
if (c < 0)
break;
putchar (c);
}
fflush (stdout);
}
}
}
#endif
struct target_ops st2000_ops;
static void
init_st2000_ops (void)
{
st2000_ops.to_shortname = "st2000";
st2000_ops.to_longname = "Remote serial Tandem ST2000 target";
st2000_ops.to_doc = "Use a remote computer running STDEBUG connected by a serial line;\n\
or a network connection.\n\
Arguments are the name of the device for the serial line,\n\
the speed to connect at in bits per second.";
st2000_ops.to_open = st2000_open;
st2000_ops.to_close = st2000_close;
st2000_ops.to_detach = st2000_detach;
st2000_ops.to_resume = st2000_resume;
st2000_ops.to_wait = st2000_wait;
st2000_ops.to_fetch_registers = st2000_fetch_register;
st2000_ops.to_store_registers = st2000_store_register;
st2000_ops.to_prepare_to_store = st2000_prepare_to_store;
st2000_ops.to_xfer_memory = st2000_xfer_inferior_memory;
st2000_ops.to_files_info = st2000_files_info;
st2000_ops.to_insert_breakpoint = st2000_insert_breakpoint;
st2000_ops.to_remove_breakpoint = st2000_remove_breakpoint;
st2000_ops.to_kill = st2000_kill;
st2000_ops.to_create_inferior = st2000_create_inferior;
st2000_ops.to_mourn_inferior = st2000_mourn_inferior;
st2000_ops.to_stratum = process_stratum;
st2000_ops.to_has_all_memory = 1;
st2000_ops.to_has_memory = 1;
st2000_ops.to_has_stack = 1;
st2000_ops.to_has_registers = 1;
st2000_ops.to_has_execution = 1;
st2000_ops.to_magic = OPS_MAGIC;
};
void
_initialize_remote_st2000 (void)
{
init_st2000_ops ();
add_target (&st2000_ops);
add_com ("st2000 <command>", class_obscure, st2000_command,
"Send a command to the STDBUG monitor.");
add_com ("connect", class_obscure, connect_command,
"Connect the terminal directly up to the STDBUG command monitor.\n\
Use <CR>~. or <CR>~^D to break out.");
}