diff options
Diffstat (limited to 'sim/arm/armrdi.c')
| -rw-r--r-- | sim/arm/armrdi.c | 1596 |
1 files changed, 899 insertions, 697 deletions
diff --git a/sim/arm/armrdi.c b/sim/arm/armrdi.c index 348c7be0f31..a42b310a77b 100644 --- a/sim/arm/armrdi.c +++ b/sim/arm/armrdi.c @@ -33,7 +33,7 @@ #define Watch_AnyRead (RDIWatch_ByteRead+RDIWatch_HalfRead+RDIWatch_WordRead) #define Watch_AnyWrite (RDIWatch_ByteWrite+RDIWatch_HalfWrite+RDIWatch_WordWrite) -static unsigned FPRegsAddr ; /* last known address of FPE regs */ +static unsigned FPRegsAddr; /* last known address of FPE regs */ #define FPESTART 0x2000L #define FPEEND 0x8000L @@ -45,10 +45,10 @@ static unsigned FPRegsAddr ; /* last known address of FPE regs */ #define TracePrint(s) #endif -static ARMul_State *state = NULL ; -static unsigned BreaksSet ; /* The number of breakpoints set */ +static ARMul_State *state = NULL; +static unsigned BreaksSet; /* The number of breakpoints set */ -static int rdi_log = 0 ; /* debugging ? */ +static int rdi_log = 0; /* debugging ? */ #define LOWEST_RDI_LEVEL 0 #define HIGHEST_RDI_LEVEL 1 @@ -57,43 +57,51 @@ static int MYrdi_level = LOWEST_RDI_LEVEL; typedef struct BreakNode BreakNode; typedef struct WatchNode WatchNode; -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); +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); } -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); +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 -void ARMul_ConsolePrint(ARMul_State *state, const char *format, ...) +void +ARMul_ConsolePrint (ARMul_State * state, const char *format, ...) { va_list ap; int ch; @@ -101,32 +109,34 @@ void ARMul_ConsolePrint(ARMul_State *state, const char *format, ...) int i, j; ARMword junk; - va_start(ap, format); - vsprintf(buf, format, ap); + va_start (ap, format); + vsprintf (buf, format, ap); + + for (i = 0; buf[i]; i++); /* The string is i chars long */ - for (i = 0; buf[i] ;i++); /* The string is i chars long */ - str = buf; - 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); - } + 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; @@ -136,46 +146,57 @@ void ARMul_ConsolePrint(ARMul_State *state, const char *format, ...) /* state->hostif->writec(state->hostif->hostosarg, ch); */ } -void ARMul_DebugPause(ARMul_State *state) +void +ARMul_DebugPause (ARMul_State * state) { - if(!(rdi_log & 8)) - state->hostif->dbgpause(state->hostif->dbgarg); + if (!(rdi_log & 8)) + state->hostif->dbgpause (state->hostif->dbgarg); } /***************************************************************************\ * RDI_open * \***************************************************************************/ -static void InitFail(int exitcode, char const *which) { - ARMul_ConsolePrint(state, "%s interface failed to initialise. Exiting\n", - which); - exit(exitcode); +static void +InitFail (int exitcode, char const *which) +{ + ARMul_ConsolePrint (state, "%s interface failed to initialise. Exiting\n", + which); + exit (exitcode); } -static void RDIInit(unsigned type) -{if (type == 0) { /* cold start */ - state->CallDebug = state->MemReadDebug = state->MemWriteDebug = 0 ; - BreaksSet = 0 ; +static void +RDIInit (unsigned type) +{ + if (type == 0) + { /* cold start */ + state->CallDebug = state->MemReadDebug = state->MemWriteDebug = 0; + BreaksSet = 0; } - } +} #define UNKNOWNPROC 0 -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}; +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[] = { - &p_arm6, /* default: must come first */ + &p_arm6, /* default: must come first */ &p_arm2, &p_arm2as, &p_arm61, @@ -188,454 +209,525 @@ Processor const *const processors[] = { }; typedef struct ProcessorConfig ProcessorConfig; -struct ProcessorConfig { +struct ProcessorConfig +{ long id[2]; ProcessorConfig const *self; long count; - Processor const * const *processors; + Processor const *const *processors; }; ProcessorConfig const processorconfig = { - { ((((((long)'x' << 8) | ' ') << 8) | 'c') << 8) | 'p', - ((((((long)'u' << 8) | 's') << 8) | ' ') << 8) | 'x' - }, + {((((((long) 'x' << 8) | ' ') << 8) | 'c') << 8) | 'p', + ((((((long) 'u' << 8) | 's') << 8) | ' ') << 8) | 'x'}, &processorconfig, 16, processors }; -static int RDI_open(unsigned type, const Dbg_ConfigBlock *config, - const Dbg_HostosInterface *hostif, - struct Dbg_MCState *dbg_state) +static int +RDI_open (unsigned type, const Dbg_ConfigBlock * config, + const Dbg_HostosInterface * hostif, struct Dbg_MCState *dbg_state) /* Initialise everything */ -{int virgin = (state == NULL); - IGNORE(dbg_state); +{ + int virgin = (state == NULL); + IGNORE (dbg_state); #ifdef RDI_VERBOSE - 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) ; - } + 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 - if (type & 1) { /* Warm start */ - ARMul_Reset(state) ; - RDIInit(1) ; + if (type & 1) + { /* Warm start */ + ARMul_Reset (state); + RDIInit (1); } - 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"); + 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) - return(state->bigendSig ? RDIError_BigEndian : RDIError_LittleEndian); + return (state->bigendSig ? RDIError_BigEndian : RDIError_LittleEndian); else - return(RDIError_NoError) ; + return (RDIError_NoError); } /***************************************************************************\ * RDI_close * \***************************************************************************/ -static int RDI_close(void) +static int +RDI_close (void) { - TracePrint((state, "RDI_close\n")); - ARMul_OSExit(state) ; - ARMul_CoProExit(state) ; - ARMul_MemoryExit(state) ; - return(RDIError_NoError) ; - } + TracePrint ((state, "RDI_close\n")); + ARMul_OSExit (state); + ARMul_CoProExit (state); + ARMul_MemoryExit (state); + return (RDIError_NoError); +} /***************************************************************************\ * RDI_read * \***************************************************************************/ -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) ; +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); } - return(RDIError_NoError) ; - } + return (RDIError_NoError); +} /***************************************************************************\ * RDI_write * \***************************************************************************/ -static int RDI_write(const void *source, ARMword dest, unsigned *nbytes) -{unsigned i ; - char *memptr = (char *)source ; +static int +RDI_write (const void *source, ARMword dest, unsigned *nbytes) +{ + unsigned i; + char *memptr = (char *) source; - TracePrint((state, "RDI_write: source=%p dest=%.8lx nbytes=%.8x\n", - source, dest, *nbytes)); + TracePrint ((state, "RDI_write: source=%p dest=%.8lx nbytes=%.8x\n", + source, dest, *nbytes)); - for (i=0 ; i < *nbytes ; i++) - ARMul_WriteByte(state,(ARMword)dest++,(ARMword)*memptr++) ; + for (i = 0; i < *nbytes; i++) + ARMul_WriteByte (state, (ARMword) dest++, (ARMword) * memptr++); - if (state->abortSig) { - state->abortSig = LOW ; - return(RDIError_DataAbort) ; + if (state->abortSig) + { + state->abortSig = LOW; + return (RDIError_DataAbort); } - return(RDIError_NoError) ; - } + return (RDIError_NoError); +} /***************************************************************************\ * RDI_CPUread * \***************************************************************************/ -static int RDI_CPUread(unsigned mode, unsigned long mask, ARMword buffer[]) -{unsigned i , upto ; +static int +RDI_CPUread (unsigned mode, unsigned long mask, ARMword buffer[]) +{ + unsigned i, upto; - if (mode == RDIMode_Curr) - mode = (unsigned)(ARMul_GetCPSR(state) & MODEBITS) ; + if (mode == RDIMode_Curr) + mode = (unsigned) (ARMul_GetCPSR (state) & MODEBITS); - for (upto = 0, i = 0 ; i < 15 ; i++) - if (mask & (1L << i)){ - buffer[upto++] = ARMul_GetReg(state,mode,i) ; - } + for (upto = 0, i = 0; i < 15; i++) + if (mask & (1L << i)) + { + buffer[upto++] = ARMul_GetReg (state, mode, i); + } - if (mask & RDIReg_R15) { - buffer[upto++] = ARMul_GetR15(state) ; - } + if (mask & RDIReg_R15) + { + buffer[upto++] = ARMul_GetR15 (state); + } - if (mask & RDIReg_PC) { - buffer[upto++] = ARMul_GetPC(state) ; - } + if (mask & RDIReg_PC) + { + buffer[upto++] = ARMul_GetPC (state); + } - if (mask & RDIReg_CPSR) - buffer[upto++] = ARMul_GetCPSR(state) ; + if (mask & RDIReg_CPSR) + buffer[upto++] = ARMul_GetCPSR (state); - if (mask & RDIReg_SPSR) - buffer[upto++] = ARMul_GetSPSR(state,mode) ; + if (mask & RDIReg_SPSR) + buffer[upto++] = ARMul_GetSPSR (state, mode); - TracePrint((state, "RDI_CPUread: mode=%.8x mask=%.8lx", mode, mask)); + TracePrint ((state, "RDI_CPUread: mode=%.8x mask=%.8lx", mode, mask)); #ifdef RDI_VERBOSE - 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") ; + 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 - return(RDIError_NoError) ; + return (RDIError_NoError); } /***************************************************************************\ * RDI_CPUwrite * \***************************************************************************/ -static int RDI_CPUwrite(unsigned mode, unsigned long mask, ARMword const buffer[]) -{int i, upto; +static int +RDI_CPUwrite (unsigned mode, unsigned long mask, ARMword const buffer[]) +{ + int i, upto; - TracePrint((state, "RDI_CPUwrite: mode=%.8x mask=%.8lx", mode, mask)); + TracePrint ((state, "RDI_CPUwrite: mode=%.8x mask=%.8lx", mode, mask)); #ifdef RDI_VERBOSE - 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") ; + 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 - if (mode == RDIMode_Curr) - mode = (unsigned)(ARMul_GetCPSR(state) & MODEBITS) ; + if (mode == RDIMode_Curr) + mode = (unsigned) (ARMul_GetCPSR (state) & MODEBITS); - for (upto = 0, i = 0 ; i < 15 ; i++) + for (upto = 0, i = 0; i < 15; i++) if (mask & (1L << i)) - ARMul_SetReg(state,mode,i,buffer[upto++]) ; + ARMul_SetReg (state, mode, i, buffer[upto++]); - if (mask & RDIReg_R15) - ARMul_SetR15(state,buffer[upto++]) ; + if (mask & RDIReg_R15) + ARMul_SetR15 (state, buffer[upto++]); - if (mask & RDIReg_PC) { + if (mask & RDIReg_PC) + { - ARMul_SetPC(state,buffer[upto++]) ; - } - if (mask & RDIReg_CPSR) - ARMul_SetCPSR(state,buffer[upto++]) ; + ARMul_SetPC (state, buffer[upto++]); + } + if (mask & RDIReg_CPSR) + ARMul_SetCPSR (state, buffer[upto++]); - if (mask & RDIReg_SPSR) - ARMul_SetSPSR(state,mode,buffer[upto++]) ; + if (mask & RDIReg_SPSR) + ARMul_SetSPSR (state, mode, buffer[upto++]); - return(RDIError_NoError) ; + return (RDIError_NoError); } /***************************************************************************\ * RDI_CPread * \***************************************************************************/ -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)); +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 - 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") ; - } + 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 - return RDIError_NoError; - } + return RDIError_NoError; + } #ifdef NOFPE - return RDIError_UnknownCoPro; + return RDIError_UnknownCoPro; #else - 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 ; - } - 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 (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; } - if (mask & (1L << r)) - buffer[upto++] = ARMul_ReadWord(state,fpregsaddr + 128) ; /* fpsr */ - if (mask & (1L << (r+1) )) - buffer[upto++] = 0 ; /* fpcr */ + 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 */ - TracePrint((state, "RDI_CPread: CPnum=%d mask=%.8lx\n", CPnum, mask)); + TracePrint ((state, "RDI_CPread: CPnum=%d mask=%.8lx\n", CPnum, mask)); #ifdef RDI_VERBOSE - 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") ; + 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 - return(RDIError_NoError) ; + return (RDIError_NoError); #endif /* NOFPE */ - } +} /***************************************************************************\ * RDI_CPwrite * \***************************************************************************/ -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)); +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 - 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") ; - } + 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 - 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; - } + 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 - return RDIError_UnknownCoPro; + return RDIError_UnknownCoPro; #else - TracePrint((state, "RDI_CPwrite: CPnum=%d mask=%.8lx", CPnum, mask)); + TracePrint ((state, "RDI_CPwrite: CPnum=%d mask=%.8lx", CPnum, mask)); #ifdef RDI_VERBOSE - 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") ; - } + 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 - 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 ; - } - 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 (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; } - if (mask & (1L << r)) - ARMul_WriteWord(state,fpregsaddr + 128,buffer[upto++]) ; /* fpsr */ - return(RDIError_NoError) ; + 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 */ } -static void deletebreaknode(BreakNode **prevp) { +static void +deletebreaknode (BreakNode ** prevp) +{ BreakNode *p = *prevp; *prevp = p->next; - ARMul_WriteWord(state, p->address, p->inst); - free((char *)p); - BreaksSet-- ; - state->CallDebug-- ; + ARMul_WriteWord (state, p->address, p->inst); + free ((char *) p); + BreaksSet--; + state->CallDebug--; } -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; - } +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 */ -static BreakNode *installbreak(ARMword address, unsigned type, ARMword bound) -{ BreakNode *p = (BreakNode *)malloc(sizeof(BreakNode)); +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; - p->inst = ARMul_ReadWord(state, address); - ARMul_WriteWord(state, address, 0xee000000L); + p->inst = ARMul_ReadWord (state, address); + ARMul_WriteWord (state, address, 0xee000000L); return p; } @@ -643,18 +735,20 @@ static BreakNode *installbreak(ARMword address, unsigned type, ARMword bound) * RDI_setbreak * \***************************************************************************/ -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)); +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; } @@ -662,13 +756,18 @@ static int RDI_setbreak(ARMword address, unsigned type, ARMword bound, * RDI_clearbreak * \***************************************************************************/ -static int RDI_clearbreak(PointHandle handle) -{ TracePrint((state, "RDI_clearbreak: address=%.8lx\n", handle)); - { BreakNode *p, **prevp = &BreakList; +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) - if (p == (BreakNode *)handle) break; - if (p == NULL) return RDIError_NoSuchPoint; - deletebreaknode(prevp); + if (p == (BreakNode *) handle) + break; + if (p == NULL) + return RDIError_NoSuchPoint; + deletebreaknode (prevp); return RDIError_NoError; } } @@ -677,27 +776,36 @@ static int RDI_clearbreak(PointHandle handle) * Internal functions for breakpoint table manipulation * \***************************************************************************/ -static void deletewatchnode(WatchNode **prevp) -{ WatchNode *p = *prevp; - if (p->datatype & Watch_AnyRead) state->MemReadDebug--; - if (p->datatype & Watch_AnyWrite) state->MemWriteDebug--; +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; - free((char *)p); + free ((char *) p); } -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 */ +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 */ } -static WatchNode *installwatch(ARMword address, unsigned type, unsigned datatype, - ARMword bound) -{ WatchNode *p = (WatchNode *)malloc(sizeof(WatchNode)); +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; @@ -711,20 +819,27 @@ static WatchNode *installwatch(ARMword address, unsigned type, unsigned datatype * RDI_setwatch * \***************************************************************************/ -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)); +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)); - if (!state->CanWatch) return RDIError_UnimplementedMessage; + if (!state->CanWatch) + return RDIError_UnimplementedMessage; - 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)); + 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; } @@ -732,13 +847,18 @@ static int RDI_setwatch(ARMword address, unsigned type, unsigned datatype, * RDI_clearwatch * \***************************************************************************/ -static int RDI_clearwatch(PointHandle handle) -{ TracePrint((state, "RDI_clearwatch: address=%.8lx\n", handle)); - { WatchNode *p, **prevp = &WatchList; +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) - if (p == (WatchNode *)handle) break; - if (p == NULL) return RDIError_NoSuchPoint; - deletewatchnode(prevp); + if (p == (WatchNode *) handle) + break; + if (p == NULL) + return RDIError_NoSuchPoint; + deletewatchnode (prevp); return RDIError_NoError; } } @@ -747,203 +867,230 @@ static int RDI_clearwatch(PointHandle handle) * RDI_execute * \***************************************************************************/ -static int RDI_execute(PointHandle *handle) +static int +RDI_execute (PointHandle * handle) { - TracePrint((state, "RDI_execute\n")); - if (rdi_log & 4) { - state->CallDebug++ ; - state->Debug = TRUE ; - } - state->EndCondition = RDIError_NoError ; + TracePrint ((state, "RDI_execute\n")); + if (rdi_log & 4) + { + state->CallDebug++; + state->Debug = TRUE; + } + state->EndCondition = RDIError_NoError; state->StopHandle = 0; - ARMul_DoProg(state); + ARMul_DoProg (state); *handle = state->StopHandle; - state->Reg[15] -= 8 ; /* undo the pipeline */ - if (rdi_log & 4) { - state->CallDebug-- ; - state->Debug = FALSE ; - } - return(state->EndCondition) ; + state->Reg[15] -= 8; /* undo the pipeline */ + if (rdi_log & 4) + { + state->CallDebug--; + state->Debug = FALSE; + } + return (state->EndCondition); } /***************************************************************************\ * RDI_step * \***************************************************************************/ -static int RDI_step(unsigned ninstr, PointHandle *handle) +static int +RDI_step (unsigned ninstr, PointHandle * handle) { - TracePrint((state, "RDI_step\n")); - if (ninstr != 1) return RDIError_UnimplementedMessage; - if (rdi_log & 4) { - state->CallDebug++ ; - state->Debug = TRUE ; - } - state->EndCondition = RDIError_NoError ; + 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; - ARMul_DoInstr(state) ; + ARMul_DoInstr (state); *handle = state->StopHandle; - state->Reg[15] -= 8 ; /* undo the pipeline */ - if (rdi_log & 4) { - state->CallDebug-- ; - state->Debug = FALSE ; - } - return(state->EndCondition) ; + state->Reg[15] -= 8; /* undo the pipeline */ + if (rdi_log & 4) + { + state->CallDebug--; + state->Debug = FALSE; + } + return (state->EndCondition); } /***************************************************************************\ * RDI_info * \***************************************************************************/ -static int RDI_info(unsigned type, ARMword *arg1, ARMword *arg2) +static int +RDI_info (unsigned type, ARMword * arg1, ARMword * arg2) { - 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; - } - - 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; + 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; + } - case RDIErrorP: - *arg1 = ARMul_OSLastErrorP(state); - TracePrint((state, "RDI_ErrorP returns %ld\n", *arg1)); - return RDIError_NoError; + 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; + } - 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; - } + 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; + } - 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; + 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; } - } - cpd->entries = i+1; - return RDIError_NoError; - } - case RDIInfo_Log: - *arg1 = (ARMword)rdi_log; - return RDIError_NoError; + 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; + } - case RDIInfo_SetLog: - rdi_log = (int)*arg1; - return RDIError_NoError; + case RDISet_RDILevel: + if (*arg1 < LOWEST_RDI_LEVEL || *arg1 > HIGHEST_RDI_LEVEL) + return RDIError_IncompatibleRDILevels; + MYrdi_level = *arg1; + return RDIError_NoError; - case RDIInfo_CoPro: - return RDIError_NoError; + default: + return RDIError_UnimplementedMessage; - 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; } - - 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; - } - - case RDISet_RDILevel: - if (*arg1 < LOWEST_RDI_LEVEL || *arg1 > HIGHEST_RDI_LEVEL) - return RDIError_IncompatibleRDILevels; - MYrdi_level = *arg1; - return RDIError_NoError; - - default: - return RDIError_UnimplementedMessage; - - } } /***************************************************************************\ @@ -953,92 +1100,147 @@ static int RDI_info(unsigned type, ARMword *arg1, ARMword *arg2) * parameter is the instruction being executed. * \***************************************************************************/ -ARMword ARMul_Debug(ARMul_State *state, ARMword pc, ARMword instr) +ARMword +ARMul_Debug (ARMul_State * state, ARMword pc, ARMword instr) { - if (state->EndCondition == RDIError_UserInterrupt) { - TracePrint((state, "User interrupt at %.8lx\n", pc)); - state->CallDebug--; - state->Emulate = STOP; - } 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 ; + if (state->EndCondition == RDIError_UserInterrupt) + { + TracePrint ((state, "User interrupt at %.8lx\n", pc)); + state->CallDebug--; state->Emulate = STOP; - state->StopHandle = (ARMword)p; - break; } - } + 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; } -void ARMul_CheckWatch(ARMul_State *state, ARMword addr, int access) -{ WatchNode *p; +void +ARMul_CheckWatch (ARMul_State * state, ARMword addr, int access) +{ + WatchNode *p; for (p = WatchList; p != NULL; p = p->next) - 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; + 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; } - /* found a match */ - TracePrint((state, "Watchpoint at %.8lx accessed\n", addr)); - state->EndCondition = RDIError_WatchpointAccessed; - state->Emulate = STOP; - state->StopHandle = (ARMword)p; - return; - } } -static RDI_NameList const *RDI_cpunames() { - return (RDI_NameList const *)&processorconfig.count; +static RDI_NameList const * +RDI_cpunames () +{ + return (RDI_NameList const *) &processorconfig.count; } const struct RDIProcVec armul_rdi = { - "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 + "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 }; - |