picodrive/cpu/debug.c
notaz 5686d93123 32x: drc: new debug facility (pdb). Few fixes thanks to it.
git-svn-id: file:///home/notaz/opt/svn/PicoDrive@863 be3aeb3a-fb24-0410-a615-afba39da0efa
2010-01-19 22:17:47 +00:00

407 lines
8.5 KiB
C

/*
* vim:shiftwidth=2:expandtab
* PDB, the PicoDrive debugger
*/
#define _GNU_SOURCE
#include <stdio.h>
#include "../pico/pico_int.h"
#include "debug.h"
static char pdb_pending_cmds[128];
static char pdb_event_cmds[128];
static struct pdb_cpu {
void *context;
int type;
int id;
const char *name;
unsigned int bpts[16];
int bpt_count;
int icount;
} pdb_cpus[5];
static int pdb_cpu_count;
static int pdb_global_icount;
#ifdef PDB_NET
#include <stddef.h>
#include <sys/types.h>
#include <sys/socket.h>
#include <netinet/in.h>
#include <arpa/inet.h>
#include <unistd.h>
#include "debug_net.h"
static int pdb_net_sock = -1;
int pdb_net_connect(const char *host, const char *port)
{
struct sockaddr_in sockadr;
int sock = -1;
int ret;
sock = socket(PF_INET, SOCK_STREAM, 0);
if (sock == -1) {
perror("socket");
return -1;
}
sockadr.sin_addr.s_addr = inet_addr(host);
sockadr.sin_family = AF_INET;
sockadr.sin_port = htons(atoi(port));
ret = connect(sock, (struct sockaddr *)&sockadr, sizeof(sockadr));
if (ret != 0) {
perror("pdb_net: connect");
close(sock);
return -1;
}
printf("pdb_net: connected to %s:%s\n", host, port);
pdb_net_sock = sock;
return 0;
}
static int pdb_net_send(struct pdb_cpu *cpu, unsigned int pc)
{
packet_t packet;
int ret;
if (pdb_net_sock < 0)
return 0; // not connected
if (cpu->type == PDBCT_SH2) {
SH2 *sh2 = cpu->context;
int rl = offsetof(SH2, macl) + sizeof(sh2->macl);
packet.header.type = PDBCT_SH2;
packet.header.cpuid = cpu->id;
packet.regs[0] = pc;
memcpy(&packet.regs[1], sh2->r, rl);
packet.regs[1+24+0] = sh2->pdb_io_csum[0];
packet.regs[1+24+1] = sh2->pdb_io_csum[1];
packet.header.len = 4 + rl + 4*2;
sh2->pdb_io_csum[0] = sh2->pdb_io_csum[1] = 0;
}
ret = send(pdb_net_sock, &packet, sizeof(packet.header) + packet.header.len, MSG_NOSIGNAL);
if (ret != sizeof(packet.header) + packet.header.len) {
if (ret < 0)
perror("send");
else
printf("send: %d/%d\n", ret, sizeof(packet.header) + packet.header.len);
close(pdb_net_sock);
pdb_net_sock = -1;
ret = -1;
}
return ret;
}
#else
#define pdb_net_send(a,b) 0
#endif // PDB_NET
#ifdef HAVE_READLINE
#include <readline/readline.h>
#include <readline/history.h>
#endif
static char *my_readline(const char *prompt)
{
char *line = NULL;
#ifdef HAVE_READLINE
line = readline("(pdb) ");
if (line == NULL)
return NULL;
if (line[0] != 0)
add_history(line);
#else
size_t size = 0;
ssize_t ret;
printf("(pdb) ");
fflush(stdout);
ret = getline(&line, &size, stdin);
if (ret < 0)
return NULL;
if (ret > 0 && line[ret - 1] == '\n')
line[ret - 1] = 0;
#endif
return line;
}
static struct pdb_cpu *context2cpu(const void *context)
{
int i;
for (i = 0; i < pdb_cpu_count; i++)
if (pdb_cpus[i].context == context)
return &pdb_cpus[i];
return NULL;
}
static const char *get_token(char *buf, int blen, const char *str)
{
const char *p, *s, *e;
int len;
p = str;
while (isspace_(*p))
p++;
if (*p == 0)
return NULL;
if (*p == ';') {
strcpy(buf, ";");
return p + 1;
}
s = p;
while (*p != 0 && *p != ';' && !isspace_(*p))
p++;
e = p;
while (isspace_(*e))
e++;
len = p - s;
if (len > blen - 1)
len = blen - 1;
memcpy(buf, s, len);
buf[len] = 0;
return e;
}
static const char *get_arg(char *buf, int blen, const char *str)
{
if (*str == ';')
return NULL;
return get_token(buf, blen, str);
}
enum cmd_ret_e {
CMDRET_DONE, // ..and back to prompt
// CMDRET_PROMPT, // go to prompt
CMDRET_CONT_DO_NEXT, // continue and do remaining cmds on next event
CMDRET_CONT_REDO, // continue and redo all cmds on next event
};
static int do_print(struct pdb_cpu *cpu, const char *args)
{
int i;
elprintf(EL_STATUS, "cpu %d (%s)", cpu->id, cpu->name);
if (cpu->type == PDBCT_SH2) {
SH2 *sh2 = cpu->context;
printf("PC,SR %08x, %03x\n", sh2->pc, sh2->sr & 0x3ff);
for (i = 0; i < 16/2; i++)
printf("R%d,%2d %08x,%08x\n", i, i + 8, sh2->r[i], sh2->r[i + 8]);
printf("gb,vb %08x,%08x\n", sh2->gbr, sh2->vbr);
printf("IRQs/mask: %02x/%02x\n", Pico32x.sh2irqi[sh2->is_slave],
Pico32x.sh2irq_mask[sh2->is_slave]);
printf("cycles %d/%d (%d)\n", sh2->cycles_done, sh2->cycles_aim, (signed int)sh2->sr >> 12);
}
return CMDRET_DONE;
}
static int do_step_all(struct pdb_cpu *cpu, const char *args)
{
char tmp[32];
if (!get_arg(tmp, sizeof(tmp), args)) {
printf("step_all: missing arg\n");
return CMDRET_DONE;
}
pdb_global_icount = atoi(tmp);
return CMDRET_CONT_DO_NEXT;
}
static int do_continue(struct pdb_cpu *cpu, const char *args)
{
char tmp[32];
if (get_arg(tmp, sizeof(tmp), args))
cpu->icount = atoi(tmp);
return CMDRET_CONT_DO_NEXT;
}
static int do_step(struct pdb_cpu *cpu, const char *args)
{
cpu->icount = 1;
return do_continue(cpu, args);
}
static int do_waitcpu(struct pdb_cpu *cpu, const char *args)
{
char tmp[32];
if (!get_arg(tmp, sizeof(tmp), args)) {
printf("waitcpu: missing arg\n");
return CMDRET_DONE;
}
if (strcmp(tmp, cpu->name) == 0)
return CMDRET_DONE;
return CMDRET_CONT_REDO;
}
static int do_help(struct pdb_cpu *cpu, const char *args);
static struct {
const char *cmd;
const char *help;
int (*handler)(struct pdb_cpu *cpu, const char *args);
} pdb_cmds[] = {
{ "help", "", do_help },
{ "continue", "[insns]", do_continue },
{ "step", "[insns]", do_step },
{ "step_all", "<insns>", do_step_all },
{ "waitcpu", "<cpuname>", do_waitcpu },
{ "print", "", do_print },
};
static int do_help(struct pdb_cpu *cpu, const char *args)
{
int i;
for (i = 0; i < ARRAY_SIZE(pdb_cmds); i++)
printf("%s %s\n", pdb_cmds[i].cmd, pdb_cmds[i].help);
return CMDRET_DONE;
}
static int do_comands(struct pdb_cpu *cpu, const char *cmds)
{
const char *p = cmds;
while (p != NULL)
{
const char *pcmd;
char cmd[32];
int i, len;
int ret = 0;
pcmd = p;
p = get_token(cmd, sizeof(cmd), p);
if (p == NULL)
break;
if (cmd[0] == ';')
continue;
len = strlen(cmd);
for (i = 0; i < ARRAY_SIZE(pdb_cmds); i++)
if (strncmp(pdb_cmds[i].cmd, cmd, len) == 0) {
ret = pdb_cmds[i].handler(cpu, p);
break;
}
if (i == ARRAY_SIZE(pdb_cmds)) {
printf("bad cmd: %s\n", cmd);
break;
}
// skip until next command
while (1) {
p = get_token(cmd, sizeof(cmd), p);
if (p == NULL || cmd[0] == ';')
break;
}
pdb_event_cmds[0] = 0;
if (ret == CMDRET_CONT_DO_NEXT) {
pdb_pending_cmds[0] = 0;
if (p != NULL)
strcpy(pdb_event_cmds, p);
return 0;
}
if (ret == CMDRET_CONT_REDO) {
if (pcmd != pdb_pending_cmds)
strncpy(pdb_pending_cmds, pcmd, sizeof(pdb_pending_cmds));
return 0;
}
pdb_pending_cmds[0] = 0;
}
return 1;
}
static void do_prompt(struct pdb_cpu *cpu)
{
static char prev[128];
int ret;
while (1) {
char *line, *cline;
line = my_readline("(pdb) ");
if (line == NULL)
break;
if (line[0] == 0)
cline = prev;
else {
cline = line;
strncpy(prev, line, sizeof(prev));
}
ret = do_comands(cpu, cline);
free(line);
if (ret == 0)
break;
}
}
void pdb_register_cpu(void *context, int type, const char *name)
{
int i = pdb_cpu_count;
memset(&pdb_cpus[i], 0, sizeof(pdb_cpus[i]));
pdb_cpus[i].context = context;
pdb_cpus[i].type = type;
pdb_cpus[i].id = pdb_cpu_count;
pdb_cpus[i].name = name;
pdb_cpus[i].icount = -1;
pdb_cpu_count++;
}
void pdb_step(void *context, unsigned int pc)
{
struct pdb_cpu *cpu = context2cpu(context);
int i;
if (pdb_net_send(cpu, pc) < 0)
goto prompt;
if (pdb_pending_cmds[0] != 0)
if (do_comands(cpu, pdb_pending_cmds))
goto prompt;
// breakpoint?
for (i = 0; i < cpu->bpt_count; i++)
if (cpu->bpts[i] == pc)
goto prompt;
// hit num of insns?
if (pdb_global_icount > 0)
if (--pdb_global_icount == 0)
goto prompt;
if (cpu->icount > 0)
if (--(cpu->icount) == 0)
goto prompt;
return;
prompt:
if (pdb_event_cmds[0] != 0)
if (!do_comands(cpu, pdb_event_cmds))
return;
printf("%s @%08x\n", cpu->name, pc);
do_prompt(cpu);
}
void pdb_command(const char *cmd)
{
strncpy(pdb_pending_cmds, cmd, sizeof(pdb_pending_cmds));
pdb_pending_cmds[sizeof(pdb_pending_cmds) - 1] = 0;
}
void pdb_cleanup(void)
{
pdb_cpu_count = 0;
}