old-cross-binutils/sim/arm/armrdi.c

1247 lines
33 KiB
C
Raw Normal View History

/* armrdi.c -- ARMulator RDI interface: ARM6 Instruction Emulator.
Copyright (C) 1994 Advanced RISC Machines Ltd.
This program is free software; you can redistribute it and/or modify
it under the terms of the GNU General Public License as published by
the Free Software Foundation; either version 2 of the License, or
(at your option) any later version.
This program is distributed in the hope that it will be useful,
but WITHOUT ANY WARRANTY; without even the implied warranty of
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
GNU General Public License for more details.
You should have received a copy of the GNU General Public License
along with this program; if not, write to the Free Software
Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. */
#include <string.h>
#include <ctype.h>
#include "armdefs.h"
#include "armemu.h"
#include "armos.h"
#include "dbg_cp.h"
#include "dbg_conf.h"
#include "dbg_rdi.h"
#include "dbg_hif.h"
#include "communicate.h"
/***************************************************************************\
* Declarations *
\***************************************************************************/
#define Watch_AnyRead (RDIWatch_ByteRead+RDIWatch_HalfRead+RDIWatch_WordRead)
#define Watch_AnyWrite (RDIWatch_ByteWrite+RDIWatch_HalfWrite+RDIWatch_WordWrite)
2000-02-05 07:30:26 +00:00
static unsigned FPRegsAddr; /* last known address of FPE regs */
#define FPESTART 0x2000L
#define FPEEND 0x8000L
#define IGNORE(d) (d = d)
#ifdef RDI_VERBOSE
#define TracePrint(s) \
if (rdi_log & 1) ARMul_DebugPrint s
#else
#define TracePrint(s)
#endif
2000-02-05 07:30:26 +00:00
static ARMul_State *state = NULL;
static unsigned BreaksSet; /* The number of breakpoints set */
2000-02-05 07:30:26 +00:00
static int rdi_log = 0; /* debugging ? */
#define LOWEST_RDI_LEVEL 0
#define HIGHEST_RDI_LEVEL 1
static int MYrdi_level = LOWEST_RDI_LEVEL;
typedef struct BreakNode BreakNode;
typedef struct WatchNode WatchNode;
2000-02-05 07:30:26 +00:00
struct BreakNode
{ /* A breakpoint list node */
BreakNode *next;
ARMword address; /* The address of this breakpoint */
unsigned type; /* The type of comparison */
ARMword bound; /* The other address for a range */
ARMword inst;
};
struct WatchNode
{ /* A watchpoint list node */
WatchNode *next;
ARMword address; /* The address of this watchpoint */
unsigned type; /* The type of comparison */
unsigned datatype; /* The type of access to watch for */
ARMword bound; /* The other address for a range */
};
BreakNode *BreakList = NULL;
WatchNode *WatchList = NULL;
void
ARMul_DebugPrint_i (const Dbg_HostosInterface * hostif, const char *format,
...)
{
va_list ap;
va_start (ap, format);
hostif->dbgprint (hostif->dbgarg, format, ap);
va_end (ap);
}
2000-02-05 07:30:26 +00:00
void
ARMul_DebugPrint (ARMul_State * state, const char *format, ...)
{
va_list ap;
va_start (ap, format);
if (!(rdi_log & 8))
state->hostif->dbgprint (state->hostif->dbgarg, format, ap);
va_end (ap);
}
#define CONSOLE_PRINT_MAX_LEN 128
2000-02-05 07:30:26 +00:00
void
ARMul_ConsolePrint (ARMul_State * state, const char *format, ...)
{
va_list ap;
int ch;
char *str, buf[CONSOLE_PRINT_MAX_LEN];
int i, j;
ARMword junk;
2000-02-05 07:30:26 +00:00
va_start (ap, format);
vsprintf (buf, format, ap);
for (i = 0; buf[i]; i++); /* The string is i chars long */
str = buf;
2000-02-05 07:30:26 +00:00
while (i >= 32)
{
MYwrite_char (kidmum[1], RDP_OSOp);
MYwrite_word (kidmum[1], SWI_Write0);
MYwrite_char (kidmum[1], OS_SendString);
MYwrite_char (kidmum[1], 32); /* Send string 32bytes at a time */
for (j = 0; j < 32; j++, str++)
MYwrite_char (kidmum[1], *str);
wait_for_osreply (&junk);
i -= 32;
}
if (i > 0)
{
MYwrite_char (kidmum[1], RDP_OSOp);
MYwrite_word (kidmum[1], SWI_Write0);
MYwrite_char (kidmum[1], OS_SendString);
MYwrite_char (kidmum[1], (unsigned char) i); /* Send remainder of string */
for (j = 0; j < i; j++, str++)
MYwrite_char (kidmum[1], *str);
wait_for_osreply (&junk);
}
va_end (ap);
return;
/* str = buf; */
/* while ((ch=*str++) != 0) */
/* state->hostif->writec(state->hostif->hostosarg, ch); */
}
2000-02-05 07:30:26 +00:00
void
ARMul_DebugPause (ARMul_State * state)
{
2000-02-05 07:30:26 +00:00
if (!(rdi_log & 8))
state->hostif->dbgpause (state->hostif->dbgarg);
}
/***************************************************************************\
* RDI_open *
\***************************************************************************/
2000-02-05 07:30:26 +00:00
static void
InitFail (int exitcode, char const *which)
{
ARMul_ConsolePrint (state, "%s interface failed to initialise. Exiting\n",
which);
exit (exitcode);
}
2000-02-05 07:30:26 +00:00
static void
RDIInit (unsigned type)
{
if (type == 0)
{ /* cold start */
state->CallDebug = state->MemReadDebug = state->MemWriteDebug = 0;
BreaksSet = 0;
}
2000-02-05 07:30:26 +00:00
}
#define UNKNOWNPROC 0
2000-02-05 07:30:26 +00:00
typedef struct
{
char name[16];
unsigned val;
}
Processor;
Processor const p_arm2 = { "ARM2", ARM2 };
Processor const p_arm2as = { "ARM2AS", ARM2as };
Processor const p_arm61 = { "ARM61", ARM61 };
Processor const p_arm3 = { "ARM3", ARM3 };
Processor const p_arm6 = { "ARM6", ARM6 };
Processor const p_arm60 = { "ARM60", ARM60 };
Processor const p_arm600 = { "ARM600", ARM600 };
Processor const p_arm610 = { "ARM610", ARM610 };
Processor const p_arm620 = { "ARM620", ARM620 };
Processor const p_unknown = { "", UNKNOWNPROC };
Processor const *const processors[] = {
2000-02-05 07:30:26 +00:00
&p_arm6, /* default: must come first */
&p_arm2,
&p_arm2as,
&p_arm61,
&p_arm3,
&p_arm60,
&p_arm600,
&p_arm610,
&p_arm620,
&p_unknown
};
typedef struct ProcessorConfig ProcessorConfig;
2000-02-05 07:30:26 +00:00
struct ProcessorConfig
{
long id[2];
ProcessorConfig const *self;
long count;
2000-02-05 07:30:26 +00:00
Processor const *const *processors;
};
ProcessorConfig const processorconfig = {
2000-02-05 07:30:26 +00:00
{((((((long) 'x' << 8) | ' ') << 8) | 'c') << 8) | 'p',
((((((long) 'u' << 8) | 's') << 8) | ' ') << 8) | 'x'},
&processorconfig,
16,
processors
};
2000-02-05 07:30:26 +00:00
static int
RDI_open (unsigned type, const Dbg_ConfigBlock * config,
const Dbg_HostosInterface * hostif, struct Dbg_MCState *dbg_state)
/* Initialise everything */
2000-02-05 07:30:26 +00:00
{
int virgin = (state == NULL);
IGNORE (dbg_state);
#ifdef RDI_VERBOSE
2000-02-05 07:30:26 +00:00
if (rdi_log & 1)
{
if (virgin)
ARMul_DebugPrint_i (hostif, "RDI_open: type = %d\n", type);
else
ARMul_DebugPrint (state, "RDI_open: type = %d\n", type);
}
#endif
2000-02-05 07:30:26 +00:00
if (type & 1)
{ /* Warm start */
ARMul_Reset (state);
RDIInit (1);
}
2000-02-05 07:30:26 +00:00
else
{
if (virgin)
{
ARMul_EmulateInit ();
state = ARMul_NewState ();
state->hostif = hostif;
{
int req = config->processor;
unsigned processor = processors[req]->val;
ARMul_SelectProcessor (state, processor);
ARMul_Reset (state);
ARMul_ConsolePrint (state, "ARMulator V1.50, %s",
processors[req]->name);
}
if (ARMul_MemoryInit (state, config->memorysize) == FALSE)
InitFail (1, "Memory");
if (config->bytesex != RDISex_DontCare)
state->bigendSig = config->bytesex;
if (ARMul_CoProInit (state) == FALSE)
InitFail (2, "Co-Processor");
if (ARMul_OSInit (state) == FALSE)
InitFail (3, "Operating System");
}
ARMul_Reset (state);
RDIInit (0);
}
if (type & 2)
{ /* Reset the comms link */
/* what comms link ? */
}
if (virgin && (type & 1) == 0) /* Cold start */
ARMul_ConsolePrint (state, ", %s endian.\n",
state->bigendSig ? "Big" : "Little");
if (config->bytesex == RDISex_DontCare)
2000-02-05 07:30:26 +00:00
return (state->bigendSig ? RDIError_BigEndian : RDIError_LittleEndian);
else
2000-02-05 07:30:26 +00:00
return (RDIError_NoError);
}
/***************************************************************************\
* RDI_close *
\***************************************************************************/
2000-02-05 07:30:26 +00:00
static int
RDI_close (void)
{
2000-02-05 07:30:26 +00:00
TracePrint ((state, "RDI_close\n"));
ARMul_OSExit (state);
ARMul_CoProExit (state);
ARMul_MemoryExit (state);
return (RDIError_NoError);
}
/***************************************************************************\
* RDI_read *
\***************************************************************************/
2000-02-05 07:30:26 +00:00
static int
RDI_read (ARMword source, void *dest, unsigned *nbytes)
{
unsigned i;
char *memptr = (char *) dest;
TracePrint ((state, "RDI_read: source=%.8lx dest=%p nbytes=%.8x\n",
source, dest, *nbytes));
for (i = 0; i < *nbytes; i++)
*memptr++ = (char) ARMul_ReadByte (state, source++);
if (state->abortSig)
{
state->abortSig = LOW;
return (RDIError_DataAbort);
}
2000-02-05 07:30:26 +00:00
return (RDIError_NoError);
}
/***************************************************************************\
* RDI_write *
\***************************************************************************/
2000-02-05 07:30:26 +00:00
static int
RDI_write (const void *source, ARMword dest, unsigned *nbytes)
{
unsigned i;
char *memptr = (char *) source;
2000-02-05 07:30:26 +00:00
TracePrint ((state, "RDI_write: source=%p dest=%.8lx nbytes=%.8x\n",
source, dest, *nbytes));
2000-02-05 07:30:26 +00:00
for (i = 0; i < *nbytes; i++)
ARMul_WriteByte (state, (ARMword) dest++, (ARMword) * memptr++);
2000-02-05 07:30:26 +00:00
if (state->abortSig)
{
state->abortSig = LOW;
return (RDIError_DataAbort);
}
2000-02-05 07:30:26 +00:00
return (RDIError_NoError);
}
/***************************************************************************\
* RDI_CPUread *
\***************************************************************************/
2000-02-05 07:30:26 +00:00
static int
RDI_CPUread (unsigned mode, unsigned long mask, ARMword buffer[])
{
unsigned i, upto;
2000-02-05 07:30:26 +00:00
if (mode == RDIMode_Curr)
mode = (unsigned) (ARMul_GetCPSR (state) & MODEBITS);
2000-02-05 07:30:26 +00:00
for (upto = 0, i = 0; i < 15; i++)
if (mask & (1L << i))
{
buffer[upto++] = ARMul_GetReg (state, mode, i);
}
2000-02-05 07:30:26 +00:00
if (mask & RDIReg_R15)
{
buffer[upto++] = ARMul_GetR15 (state);
}
2000-02-05 07:30:26 +00:00
if (mask & RDIReg_PC)
{
buffer[upto++] = ARMul_GetPC (state);
}
2000-02-05 07:30:26 +00:00
if (mask & RDIReg_CPSR)
buffer[upto++] = ARMul_GetCPSR (state);
2000-02-05 07:30:26 +00:00
if (mask & RDIReg_SPSR)
buffer[upto++] = ARMul_GetSPSR (state, mode);
2000-02-05 07:30:26 +00:00
TracePrint ((state, "RDI_CPUread: mode=%.8x mask=%.8lx", mode, mask));
#ifdef RDI_VERBOSE
2000-02-05 07:30:26 +00:00
if (rdi_log & 1)
{
for (upto = 0, i = 0; i <= 20; i++)
if (mask & (1L << i))
{
ARMul_DebugPrint (state, "%c%.8lx", upto % 4 == 0 ? '\n' : ' ',
buffer[upto]);
upto++;
}
ARMul_DebugPrint (state, "\n");
}
#endif
2000-02-05 07:30:26 +00:00
return (RDIError_NoError);
}
/***************************************************************************\
* RDI_CPUwrite *
\***************************************************************************/
2000-02-05 07:30:26 +00:00
static int
RDI_CPUwrite (unsigned mode, unsigned long mask, ARMword const buffer[])
{
int i, upto;
2000-02-05 07:30:26 +00:00
TracePrint ((state, "RDI_CPUwrite: mode=%.8x mask=%.8lx", mode, mask));
#ifdef RDI_VERBOSE
2000-02-05 07:30:26 +00:00
if (rdi_log & 1)
{
for (upto = 0, i = 0; i <= 20; i++)
if (mask & (1L << i))
{
ARMul_DebugPrint (state, "%c%.8lx", upto % 4 == 0 ? '\n' : ' ',
buffer[upto]);
upto++;
}
ARMul_DebugPrint (state, "\n");
}
#endif
2000-02-05 07:30:26 +00:00
if (mode == RDIMode_Curr)
mode = (unsigned) (ARMul_GetCPSR (state) & MODEBITS);
2000-02-05 07:30:26 +00:00
for (upto = 0, i = 0; i < 15; i++)
if (mask & (1L << i))
2000-02-05 07:30:26 +00:00
ARMul_SetReg (state, mode, i, buffer[upto++]);
2000-02-05 07:30:26 +00:00
if (mask & RDIReg_R15)
ARMul_SetR15 (state, buffer[upto++]);
2000-02-05 07:30:26 +00:00
if (mask & RDIReg_PC)
{
2000-02-05 07:30:26 +00:00
ARMul_SetPC (state, buffer[upto++]);
}
if (mask & RDIReg_CPSR)
ARMul_SetCPSR (state, buffer[upto++]);
2000-02-05 07:30:26 +00:00
if (mask & RDIReg_SPSR)
ARMul_SetSPSR (state, mode, buffer[upto++]);
2000-02-05 07:30:26 +00:00
return (RDIError_NoError);
}
/***************************************************************************\
* RDI_CPread *
\***************************************************************************/
2000-02-05 07:30:26 +00:00
static int
RDI_CPread (unsigned CPnum, unsigned long mask, ARMword buffer[])
{
ARMword fpregsaddr, word[4];
unsigned r, w;
unsigned upto;
if (CPnum != 1 && CPnum != 2)
{
unsigned char const *rmap = state->CPRegWords[CPnum];
if (rmap == NULL)
return (RDIError_UnknownCoPro);
for (upto = 0, r = 0; r < rmap[-1]; r++)
if (mask & (1L << r))
{
(void) state->CPRead[CPnum] (state, r, &buffer[upto]);
upto += rmap[r];
}
TracePrint ((state, "RDI_CPread: CPnum=%d mask=%.8lx", CPnum, mask));
#ifdef RDI_VERBOSE
2000-02-05 07:30:26 +00:00
if (rdi_log & 1)
{
w = 0;
for (upto = 0, r = 0; r < rmap[-1]; r++)
if (mask & (1L << r))
{
int words = rmap[r];
ARMul_DebugPrint (state, "%c%2d",
(w >= 4 ? (w = 0, '\n') : ' '), r);
while (--words >= 0)
{
ARMul_DebugPrint (state, " %.8lx", buffer[upto++]);
w++;
}
}
ARMul_DebugPrint (state, "\n");
}
#endif
2000-02-05 07:30:26 +00:00
return RDIError_NoError;
}
#ifdef NOFPE
2000-02-05 07:30:26 +00:00
return RDIError_UnknownCoPro;
#else
2000-02-05 07:30:26 +00:00
if (FPRegsAddr == 0)
{
fpregsaddr = ARMul_ReadWord (state, 4L);
if ((fpregsaddr & 0xff800000) != 0xea000000) /* Must be a forward branch */
return RDIError_UnknownCoPro;
fpregsaddr = ((fpregsaddr & 0xffffff) << 2) + 8; /* address in __fp_decode - 4 */
if ((fpregsaddr < FPESTART) || (fpregsaddr >= FPEEND))
return RDIError_UnknownCoPro;
fpregsaddr = ARMul_ReadWord (state, fpregsaddr); /* pointer to fp registers */
FPRegsAddr = fpregsaddr;
}
2000-02-05 07:30:26 +00:00
else
fpregsaddr = FPRegsAddr;
if (fpregsaddr == 0)
return RDIError_UnknownCoPro;
for (upto = 0, r = 0; r < 8; r++)
if (mask & (1L << r))
{
for (w = 0; w < 4; w++)
word[w] =
ARMul_ReadWord (state,
fpregsaddr + (ARMword) r * 16 + (ARMword) w * 4);
switch ((int) (word[3] >> 29))
{
case 0:
case 2:
case 4:
case 6: /* its unpacked, convert to extended */
buffer[upto++] = 2; /* mark as extended */
buffer[upto++] = (word[3] & 0x7fff) | (word[0] & 0x80000000); /* exp and sign */
buffer[upto++] = word[1]; /* mantissa 1 */
buffer[upto++] = word[2]; /* mantissa 2 */
break;
case 1: /* packed single */
buffer[upto++] = 0; /* mark as single */
buffer[upto++] = word[0]; /* sign, exp and mantissa */
buffer[upto++] = word[1]; /* padding */
buffer[upto++] = word[2]; /* padding */
break;
case 3: /* packed double */
buffer[upto++] = 1; /* mark as double */
buffer[upto++] = word[0]; /* sign, exp and mantissa1 */
buffer[upto++] = word[1]; /* mantissa 2 */
buffer[upto++] = word[2]; /* padding */
break;
case 5: /* packed extended */
buffer[upto++] = 2; /* mark as extended */
buffer[upto++] = word[0]; /* sign and exp */
buffer[upto++] = word[1]; /* mantissa 1 */
buffer[upto++] = word[2]; /* mantissa 2 */
break;
case 7: /* packed decimal */
buffer[upto++] = 3; /* mark as packed decimal */
buffer[upto++] = word[0]; /* sign, exp and mantissa1 */
buffer[upto++] = word[1]; /* mantissa 2 */
buffer[upto++] = word[2]; /* mantissa 3 */
break;
}
}
if (mask & (1L << r))
buffer[upto++] = ARMul_ReadWord (state, fpregsaddr + 128); /* fpsr */
if (mask & (1L << (r + 1)))
buffer[upto++] = 0; /* fpcr */
2000-02-05 07:30:26 +00:00
TracePrint ((state, "RDI_CPread: CPnum=%d mask=%.8lx\n", CPnum, mask));
#ifdef RDI_VERBOSE
2000-02-05 07:30:26 +00:00
if (rdi_log & 1)
{
for (upto = 0, r = 0; r < 9; r++)
if (mask & (1L << r))
{
if (r != 8)
{
ARMul_DebugPrint (state, "%08lx ", buffer[upto++]);
ARMul_DebugPrint (state, "%08lx ", buffer[upto++]);
ARMul_DebugPrint (state, "%08lx ", buffer[upto++]);
}
ARMul_DebugPrint (state, "%08lx\n", buffer[upto++]);
}
ARMul_DebugPrint (state, "\n");
}
#endif
2000-02-05 07:30:26 +00:00
return (RDIError_NoError);
#endif /* NOFPE */
2000-02-05 07:30:26 +00:00
}
/***************************************************************************\
* RDI_CPwrite *
\***************************************************************************/
2000-02-05 07:30:26 +00:00
static int
RDI_CPwrite (unsigned CPnum, unsigned long mask, ARMword const buffer[])
{
unsigned r;
unsigned upto;
ARMword fpregsaddr;
if (CPnum != 1 && CPnum != 2)
{
unsigned char const *rmap = state->CPRegWords[CPnum];
if (rmap == NULL)
return (RDIError_UnknownCoPro);
TracePrint ((state, "RDI_CPwrite: CPnum=%d mask=%.8lx", CPnum, mask));
#ifdef RDI_VERBOSE
2000-02-05 07:30:26 +00:00
if (rdi_log & 1)
{
int w = 0;
for (upto = 0, r = 0; r < rmap[-1]; r++)
if (mask & (1L << r))
{
int words = rmap[r];
ARMul_DebugPrint (state, "%c%2d",
(w >= 4 ? (w = 0, '\n') : ' '), r);
while (--words >= 0)
{
ARMul_DebugPrint (state, " %.8lx", buffer[upto++]);
w++;
}
}
ARMul_DebugPrint (state, "\n");
}
#endif
2000-02-05 07:30:26 +00:00
for (upto = 0, r = 0; r < rmap[-1]; r++)
if (mask & (1L << r))
{
(void) state->CPWrite[CPnum] (state, r, &buffer[upto]);
upto += rmap[r];
}
return RDIError_NoError;
}
#ifdef NOFPE
2000-02-05 07:30:26 +00:00
return RDIError_UnknownCoPro;
#else
2000-02-05 07:30:26 +00:00
TracePrint ((state, "RDI_CPwrite: CPnum=%d mask=%.8lx", CPnum, mask));
#ifdef RDI_VERBOSE
2000-02-05 07:30:26 +00:00
if (rdi_log & 1)
{
for (upto = 0, r = 0; r < 9; r++)
if (mask & (1L << r))
{
if (r != 8)
{
ARMul_DebugPrint (state, "%08lx ", buffer[upto++]);
ARMul_DebugPrint (state, "%08lx ", buffer[upto++]);
ARMul_DebugPrint (state, "%08lx ", buffer[upto++]);
}
ARMul_DebugPrint (state, "%08lx\n", buffer[upto++]);
}
ARMul_DebugPrint (state, "\n");
}
#endif
2000-02-05 07:30:26 +00:00
if (FPRegsAddr == 0)
{
fpregsaddr = ARMul_ReadWord (state, 4L);
if ((fpregsaddr & 0xff800000) != 0xea000000) /* Must be a forward branch */
return RDIError_UnknownCoPro;
fpregsaddr = ((fpregsaddr & 0xffffff) << 2) + 8; /* address in __fp_decode - 4 */
if ((fpregsaddr < FPESTART) || (fpregsaddr >= FPEEND))
return RDIError_UnknownCoPro;
fpregsaddr = ARMul_ReadWord (state, fpregsaddr); /* pointer to fp registers */
FPRegsAddr = fpregsaddr;
}
2000-02-05 07:30:26 +00:00
else
fpregsaddr = FPRegsAddr;
if (fpregsaddr == 0)
return RDIError_UnknownCoPro;
for (upto = 0, r = 0; r < 8; r++)
if (mask & (1L << r))
{
ARMul_WriteWord (state, fpregsaddr + (ARMword) r * 16,
buffer[upto + 1]);
ARMul_WriteWord (state, fpregsaddr + (ARMword) r * 16 + 4,
buffer[upto + 2]);
ARMul_WriteWord (state, fpregsaddr + (ARMword) r * 16 + 8,
buffer[upto + 3]);
ARMul_WriteWord (state, fpregsaddr + (ARMword) r * 16 + 12,
(buffer[upto] * 2 + 1) << 29); /* mark type */
upto += 4;
}
if (mask & (1L << r))
ARMul_WriteWord (state, fpregsaddr + 128, buffer[upto++]); /* fpsr */
return (RDIError_NoError);
#endif /* NOFPE */
}
2000-02-05 07:30:26 +00:00
static void
deletebreaknode (BreakNode ** prevp)
{
BreakNode *p = *prevp;
*prevp = p->next;
2000-02-05 07:30:26 +00:00
ARMul_WriteWord (state, p->address, p->inst);
free ((char *) p);
BreaksSet--;
state->CallDebug--;
}
2000-02-05 07:30:26 +00:00
static int
removebreak (ARMword address, unsigned type)
{
BreakNode *p, **prevp = &BreakList;
for (; (p = *prevp) != NULL; prevp = &p->next)
if (p->address == address && p->type == type)
{
deletebreaknode (prevp);
return TRUE;
}
return FALSE;
}
/* This routine installs a breakpoint into the breakpoint table */
2000-02-05 07:30:26 +00:00
static BreakNode *
installbreak (ARMword address, unsigned type, ARMword bound)
{
BreakNode *p = (BreakNode *) malloc (sizeof (BreakNode));
p->next = BreakList;
BreakList = p;
p->address = address;
p->type = type;
p->bound = bound;
2000-02-05 07:30:26 +00:00
p->inst = ARMul_ReadWord (state, address);
ARMul_WriteWord (state, address, 0xee000000L);
return p;
}
/***************************************************************************\
* RDI_setbreak *
\***************************************************************************/
2000-02-05 07:30:26 +00:00
static int
RDI_setbreak (ARMword address, unsigned type, ARMword bound,
PointHandle * handle)
{
BreakNode *p;
TracePrint ((state, "RDI_setbreak: address=%.8lx type=%d bound=%.8lx\n",
address, type, bound));
removebreak (address, type);
p = installbreak (address, type, bound);
BreaksSet++;
state->CallDebug++;
*handle = (PointHandle) p;
TracePrint ((state, " returns %.8lx\n", *handle));
return RDIError_NoError;
}
/***************************************************************************\
* RDI_clearbreak *
\***************************************************************************/
2000-02-05 07:30:26 +00:00
static int
RDI_clearbreak (PointHandle handle)
{
TracePrint ((state, "RDI_clearbreak: address=%.8lx\n", handle));
{
BreakNode *p, **prevp = &BreakList;
for (; (p = *prevp) != NULL; prevp = &p->next)
2000-02-05 07:30:26 +00:00
if (p == (BreakNode *) handle)
break;
if (p == NULL)
return RDIError_NoSuchPoint;
deletebreaknode (prevp);
return RDIError_NoError;
}
}
/***************************************************************************\
* Internal functions for breakpoint table manipulation *
\***************************************************************************/
2000-02-05 07:30:26 +00:00
static void
deletewatchnode (WatchNode ** prevp)
{
WatchNode *p = *prevp;
if (p->datatype & Watch_AnyRead)
state->MemReadDebug--;
if (p->datatype & Watch_AnyWrite)
state->MemWriteDebug--;
*prevp = p->next;
2000-02-05 07:30:26 +00:00
free ((char *) p);
}
2000-02-05 07:30:26 +00:00
int
removewatch (ARMword address, unsigned type)
{
WatchNode *p, **prevp = &WatchList;
for (; (p = *prevp) != NULL; prevp = &p->next)
if (p->address == address && p->type == type)
{ /* found a match */
deletewatchnode (prevp);
return TRUE;
}
return FALSE; /* never found a match */
}
2000-02-05 07:30:26 +00:00
static WatchNode *
installwatch (ARMword address, unsigned type, unsigned datatype,
ARMword bound)
{
WatchNode *p = (WatchNode *) malloc (sizeof (WatchNode));
p->next = WatchList;
WatchList = p;
p->address = address;
p->type = type;
p->datatype = datatype;
p->bound = bound;
return p;
}
/***************************************************************************\
* RDI_setwatch *
\***************************************************************************/
2000-02-05 07:30:26 +00:00
static int
RDI_setwatch (ARMword address, unsigned type, unsigned datatype,
ARMword bound, PointHandle * handle)
{
WatchNode *p;
TracePrint (
(state,
"RDI_setwatch: address=%.8lx type=%d datatype=%d bound=%.8lx",
address, type, datatype, bound));
2000-02-05 07:30:26 +00:00
if (!state->CanWatch)
return RDIError_UnimplementedMessage;
2000-02-05 07:30:26 +00:00
removewatch (address, type);
p = installwatch (address, type, datatype, bound);
if (datatype & Watch_AnyRead)
state->MemReadDebug++;
if (datatype & Watch_AnyWrite)
state->MemWriteDebug++;
*handle = (PointHandle) p;
TracePrint ((state, " returns %.8lx\n", *handle));
return RDIError_NoError;
}
/***************************************************************************\
* RDI_clearwatch *
\***************************************************************************/
2000-02-05 07:30:26 +00:00
static int
RDI_clearwatch (PointHandle handle)
{
TracePrint ((state, "RDI_clearwatch: address=%.8lx\n", handle));
{
WatchNode *p, **prevp = &WatchList;
for (; (p = *prevp) != NULL; prevp = &p->next)
2000-02-05 07:30:26 +00:00
if (p == (WatchNode *) handle)
break;
if (p == NULL)
return RDIError_NoSuchPoint;
deletewatchnode (prevp);
return RDIError_NoError;
}
}
/***************************************************************************\
* RDI_execute *
\***************************************************************************/
2000-02-05 07:30:26 +00:00
static int
RDI_execute (PointHandle * handle)
{
2000-02-05 07:30:26 +00:00
TracePrint ((state, "RDI_execute\n"));
if (rdi_log & 4)
{
state->CallDebug++;
state->Debug = TRUE;
}
state->EndCondition = RDIError_NoError;
state->StopHandle = 0;
2000-02-05 07:30:26 +00:00
ARMul_DoProg (state);
*handle = state->StopHandle;
2000-02-05 07:30:26 +00:00
state->Reg[15] -= 8; /* undo the pipeline */
if (rdi_log & 4)
{
state->CallDebug--;
state->Debug = FALSE;
}
return (state->EndCondition);
}
/***************************************************************************\
* RDI_step *
\***************************************************************************/
2000-02-05 07:30:26 +00:00
static int
RDI_step (unsigned ninstr, PointHandle * handle)
{
2000-02-05 07:30:26 +00:00
TracePrint ((state, "RDI_step\n"));
if (ninstr != 1)
return RDIError_UnimplementedMessage;
if (rdi_log & 4)
{
state->CallDebug++;
state->Debug = TRUE;
}
state->EndCondition = RDIError_NoError;
state->StopHandle = 0;
2000-02-05 07:30:26 +00:00
ARMul_DoInstr (state);
*handle = state->StopHandle;
2000-02-05 07:30:26 +00:00
state->Reg[15] -= 8; /* undo the pipeline */
if (rdi_log & 4)
{
state->CallDebug--;
state->Debug = FALSE;
}
return (state->EndCondition);
}
/***************************************************************************\
* RDI_info *
\***************************************************************************/
2000-02-05 07:30:26 +00:00
static int
RDI_info (unsigned type, ARMword * arg1, ARMword * arg2)
{
2000-02-05 07:30:26 +00:00
switch (type)
{
case RDIInfo_Target:
TracePrint ((state, "RDI_Info_Target\n"));
/* Emulator, speed 10**5 IPS */
*arg1 = 5 | HIGHEST_RDI_LEVEL << 5 | LOWEST_RDI_LEVEL << 8;
*arg2 = 1298224434;
return RDIError_NoError;
case RDIInfo_Points:
{
ARMword n = RDIPointCapability_Comparison | RDIPointCapability_Range |
RDIPointCapability_Mask | RDIPointCapability_Status;
TracePrint ((state, "RDI_Info_Points\n"));
if (state->CanWatch)
n |= (Watch_AnyRead + Watch_AnyWrite) << 2;
*arg1 = n;
return RDIError_NoError;
}
2000-02-05 07:30:26 +00:00
case RDIInfo_Step:
TracePrint ((state, "RDI_Info_Step\n"));
*arg1 = RDIStep_Single;
return RDIError_NoError;
case RDIInfo_MMU:
TracePrint ((state, "RDI_Info_MMU\n"));
*arg1 = 1313820229;
return RDIError_NoError;
case RDISignal_Stop:
TracePrint ((state, "RDISignal_Stop\n"));
state->CallDebug++;
state->EndCondition = RDIError_UserInterrupt;
return RDIError_NoError;
case RDIVector_Catch:
TracePrint ((state, "RDIVector_Catch %.8lx\n", *arg1));
state->VectorCatch = (unsigned) *arg1;
return RDIError_NoError;
case RDISet_Cmdline:
TracePrint ((state, "RDI_Set_Cmdline %s\n", (char *) arg1));
state->CommandLine =
(char *) malloc ((unsigned) strlen ((char *) arg1) + 1);
(void) strcpy (state->CommandLine, (char *) arg1);
return RDIError_NoError;
case RDICycles:
TracePrint ((state, "RDI_Info_Cycles\n"));
arg1[0] = 0;
arg1[1] = state->NumInstrs;
arg1[2] = 0;
arg1[3] = state->NumScycles;
arg1[4] = 0;
arg1[5] = state->NumNcycles;
arg1[6] = 0;
arg1[7] = state->NumIcycles;
arg1[8] = 0;
arg1[9] = state->NumCcycles;
arg1[10] = 0;
arg1[11] = state->NumFcycles;
return RDIError_NoError;
case RDIErrorP:
*arg1 = ARMul_OSLastErrorP (state);
TracePrint ((state, "RDI_ErrorP returns %ld\n", *arg1));
return RDIError_NoError;
case RDIInfo_DescribeCoPro:
{
int cpnum = *(int *) arg1;
struct Dbg_CoProDesc *cpd = (struct Dbg_CoProDesc *) arg2;
int i;
unsigned char const *map = state->CPRegWords[cpnum];
if (map == NULL)
return RDIError_UnknownCoPro;
for (i = 0; i < cpd->entries; i++)
{
unsigned r, w = cpd->regdesc[i].nbytes / sizeof (ARMword);
for (r = cpd->regdesc[i].rmin; r <= cpd->regdesc[i].rmax; r++)
if (map[r] != w)
return RDIError_BadCoProState;
}
return RDIError_NoError;
}
2000-02-05 07:30:26 +00:00
case RDIInfo_RequestCoProDesc:
{
int cpnum = *(int *) arg1;
struct Dbg_CoProDesc *cpd = (struct Dbg_CoProDesc *) arg2;
int i = -1, lastw = -1, r;
unsigned char const *map;
if ((unsigned) cpnum >= 16)
return RDIError_UnknownCoPro;
map = state->CPRegWords[cpnum];
if (map == NULL)
return RDIError_UnknownCoPro;
for (r = 0; r < map[-1]; r++)
{
int words = map[r];
if (words == lastw)
cpd->regdesc[i].rmax = r;
else
{
if (++i >= cpd->entries)
return RDIError_BufferFull;
cpd->regdesc[i].rmax = cpd->regdesc[i].rmin = r;
cpd->regdesc[i].nbytes = words * sizeof (ARMword);
cpd->regdesc[i].access =
Dbg_Access_Readable + Dbg_Access_Writable;
}
}
cpd->entries = i + 1;
return RDIError_NoError;
}
2000-02-05 07:30:26 +00:00
case RDIInfo_Log:
*arg1 = (ARMword) rdi_log;
return RDIError_NoError;
case RDIInfo_SetLog:
rdi_log = (int) *arg1;
return RDIError_NoError;
case RDIInfo_CoPro:
return RDIError_NoError;
case RDIPointStatus_Watch:
{
WatchNode *p, *handle = (WatchNode *) * arg1;
for (p = WatchList; p != NULL; p = p->next)
if (p == handle)
{
*arg1 = -1;
*arg2 = 1;
return RDIError_NoError;
}
return RDIError_NoSuchPoint;
}
2000-02-05 07:30:26 +00:00
case RDIPointStatus_Break:
{
BreakNode *p, *handle = (BreakNode *) * arg1;
for (p = BreakList; p != NULL; p = p->next)
if (p == handle)
{
*arg1 = -1;
*arg2 = 1;
return RDIError_NoError;
}
return RDIError_NoSuchPoint;
}
2000-02-05 07:30:26 +00:00
case RDISet_RDILevel:
if (*arg1 < LOWEST_RDI_LEVEL || *arg1 > HIGHEST_RDI_LEVEL)
return RDIError_IncompatibleRDILevels;
MYrdi_level = *arg1;
return RDIError_NoError;
2000-02-05 07:30:26 +00:00
default:
return RDIError_UnimplementedMessage;
}
}
/***************************************************************************\
* The emulator calls this routine at the beginning of every cycle when the *
* CallDebug flag is set. The second parameter passed is the address of the *
* currently executing instruction (i.e Program Counter - 8), the third *
* parameter is the instruction being executed. *
\***************************************************************************/
2000-02-05 07:30:26 +00:00
ARMword
ARMul_Debug (ARMul_State * state, ARMword pc, ARMword instr)
{
2000-02-05 07:30:26 +00:00
if (state->EndCondition == RDIError_UserInterrupt)
{
TracePrint ((state, "User interrupt at %.8lx\n", pc));
state->CallDebug--;
state->Emulate = STOP;
}
2000-02-05 07:30:26 +00:00
else
{
BreakNode *p = BreakList;
for (; p != NULL; p = p->next)
{
switch (p->type)
{
case RDIPoint_EQ:
if (pc == p->address)
break;
continue;
case RDIPoint_GT:
if (pc > p->address)
break;
continue;
case RDIPoint_GE:
if (pc >= p->address)
break;
continue;
case RDIPoint_LT:
if (pc < p->address)
break;
continue;
case RDIPoint_LE:
if (pc <= p->address)
break;
continue;
case RDIPoint_IN:
if (p->address <= pc && pc < p->address + p->bound)
break;
continue;
case RDIPoint_OUT:
if (p->address > pc || pc >= p->address + p->bound)
break;
continue;
case RDIPoint_MASK:
if ((pc & p->bound) == p->address)
break;
continue;
}
/* found a match */
TracePrint ((state, "Breakpoint reached at %.8lx\n", pc));
state->EndCondition = RDIError_BreakpointReached;
state->Emulate = STOP;
state->StopHandle = (ARMword) p;
break;
}
}
return instr;
}
2000-02-05 07:30:26 +00:00
void
ARMul_CheckWatch (ARMul_State * state, ARMword addr, int access)
{
WatchNode *p;
for (p = WatchList; p != NULL; p = p->next)
2000-02-05 07:30:26 +00:00
if (p->datatype & access)
{
switch (p->type)
{
case RDIPoint_EQ:
if (addr == p->address)
break;
continue;
case RDIPoint_GT:
if (addr > p->address)
break;
continue;
case RDIPoint_GE:
if (addr >= p->address)
break;
continue;
case RDIPoint_LT:
if (addr < p->address)
break;
continue;
case RDIPoint_LE:
if (addr <= p->address)
break;
continue;
case RDIPoint_IN:
if (p->address <= addr && addr < p->address + p->bound)
break;
continue;
case RDIPoint_OUT:
if (p->address > addr || addr >= p->address + p->bound)
break;
continue;
case RDIPoint_MASK:
if ((addr & p->bound) == p->address)
break;
continue;
}
/* found a match */
TracePrint ((state, "Watchpoint at %.8lx accessed\n", addr));
state->EndCondition = RDIError_WatchpointAccessed;
state->Emulate = STOP;
state->StopHandle = (ARMword) p;
return;
}
}
2000-02-05 07:30:26 +00:00
static RDI_NameList const *
RDI_cpunames ()
{
return (RDI_NameList const *) &processorconfig.count;
}
const struct RDIProcVec armul_rdi = {
2000-02-05 07:30:26 +00:00
"ARMUL",
RDI_open,
RDI_close,
RDI_read,
RDI_write,
RDI_CPUread,
RDI_CPUwrite,
RDI_CPread,
RDI_CPwrite,
RDI_setbreak,
RDI_clearbreak,
RDI_setwatch,
RDI_clearwatch,
RDI_execute,
RDI_step,
RDI_info,
0, /*pointinq */
0, /*addconfig */
0, /*loadconfigdata */
0, /*selectconfig */
0, /*drivernames */
RDI_cpunames
};