diff options
Diffstat (limited to 'sim/arm/armos.c')
| -rw-r--r-- | sim/arm/armos.c | 1453 |
1 files changed, 757 insertions, 696 deletions
diff --git a/sim/arm/armos.c b/sim/arm/armos.c index be4cbaf1c1d..3095f57a5a0 100644 --- a/sim/arm/armos.c +++ b/sim/arm/armos.c @@ -47,11 +47,11 @@ fun, and definign VAILDATE will define SWI 1 to enter SVC mode, and SWI #endif #ifdef HAVE_UNISTD_H -#include <unistd.h> /* For SEEK_SET etc */ +#include <unistd.h> /* For SEEK_SET etc */ #endif #ifdef __riscos -extern int _fisatty(FILE *); +extern int _fisatty (FILE *); #define isatty_(f) _fisatty(f) #else #ifdef __ZTC__ @@ -80,12 +80,13 @@ extern int _fisatty(FILE *); /* For RDIError_BreakpointReached. */ #include "dbg_rdi.h" -extern unsigned ARMul_OSInit(ARMul_State *state) ; -extern void ARMul_OSExit(ARMul_State *state) ; -extern unsigned ARMul_OSHandleSWI(ARMul_State *state,ARMword number) ; -extern unsigned ARMul_OSException(ARMul_State *state, ARMword vector, ARMword pc) ; -extern ARMword ARMul_OSLastErrorP(ARMul_State *state) ; -extern ARMword ARMul_Debug(ARMul_State *state, ARMword pc, ARMword instr) ; +extern unsigned ARMul_OSInit (ARMul_State * state); +extern void ARMul_OSExit (ARMul_State * state); +extern unsigned ARMul_OSHandleSWI (ARMul_State * state, ARMword number); +extern unsigned ARMul_OSException (ARMul_State * state, ARMword vector, + ARMword pc); +extern ARMword ARMul_OSLastErrorP (ARMul_State * state); +extern ARMword ARMul_Debug (ARMul_State * state, ARMword pc, ARMword instr); #define BUFFERSIZE 4096 #ifndef FOPEN_MAX @@ -94,22 +95,23 @@ extern ARMword ARMul_Debug(ARMul_State *state, ARMword pc, ARMword instr) ; #define UNIQUETEMPS 256 #ifndef NOOS -static void UnwindDataAbort(ARMul_State *state, ARMword addr); -static void getstring(ARMul_State *state, ARMword from, char *to) ; +static void UnwindDataAbort (ARMul_State * state, ARMword addr); +static void getstring (ARMul_State * state, ARMword from, char *to); #endif /***************************************************************************\ * OS private Information * \***************************************************************************/ -struct OSblock { - ARMword Time0 ; - ARMword ErrorP ; - ARMword ErrorNo ; - FILE *FileTable[FOPEN_MAX] ; - char FileFlags[FOPEN_MAX] ; - char *tempnames[UNIQUETEMPS] ; - } ; +struct OSblock +{ + ARMword Time0; + ARMword ErrorP; + ARMword ErrorNo; + FILE *FileTable[FOPEN_MAX]; + char FileFlags[FOPEN_MAX]; + char *tempnames[UNIQUETEMPS]; +}; #define NOOP 0 #define BINARY 1 @@ -121,97 +123,101 @@ struct OSblock { c : \ ((c == '\n' || c == '\r' ) ? (c ^ 7) : c) \ ) -#else -#define FIXCRLF(t,c) c +#else +#define FIXCRLF(t,c) c #endif -static ARMword softvectorcode[] = -{ /* basic: swi tidyexception + event; mov pc, lr; - ldmia r11,{r11,pc}; swi generateexception + event - */ - 0xef000090, 0xe1a0e00f, 0xe89b8800, 0xef000080, /*Reset*/ - 0xef000091, 0xe1a0e00f, 0xe89b8800, 0xef000081, /*Undef*/ - 0xef000092, 0xe1a0e00f, 0xe89b8800, 0xef000082, /*SWI */ - 0xef000093, 0xe1a0e00f, 0xe89b8800, 0xef000083, /*Prefetch abort*/ - 0xef000094, 0xe1a0e00f, 0xe89b8800, 0xef000084, /*Data abort*/ - 0xef000095, 0xe1a0e00f, 0xe89b8800, 0xef000085, /*Address exception*/ +static ARMword softvectorcode[] = { /* basic: swi tidyexception + event; mov pc, lr; + ldmia r11,{r11,pc}; swi generateexception + event + */ + 0xef000090, 0xe1a0e00f, 0xe89b8800, 0xef000080, /*Reset */ + 0xef000091, 0xe1a0e00f, 0xe89b8800, 0xef000081, /*Undef */ + 0xef000092, 0xe1a0e00f, 0xe89b8800, 0xef000082, /*SWI */ + 0xef000093, 0xe1a0e00f, 0xe89b8800, 0xef000083, /*Prefetch abort */ + 0xef000094, 0xe1a0e00f, 0xe89b8800, 0xef000084, /*Data abort */ + 0xef000095, 0xe1a0e00f, 0xe89b8800, 0xef000085, /*Address exception */ 0xef000096, 0xe1a0e00f, 0xe89b8800, 0xef000086, /*IRQ*/ - 0xef000097, 0xe1a0e00f, 0xe89b8800, 0xef000087, /*FIQ*/ - 0xef000098, 0xe1a0e00f, 0xe89b8800, 0xef000088, /*Error*/ - 0xe1a0f00e /* default handler */ + 0xef000097, 0xe1a0e00f, 0xe89b8800, 0xef000087, /*FIQ*/ + 0xef000098, 0xe1a0e00f, 0xe89b8800, 0xef000088, /*Error */ + 0xe1a0f00e /* default handler */ }; /***************************************************************************\ * Time for the Operating System to initialise itself. * \***************************************************************************/ -unsigned -ARMul_OSInit (ARMul_State *state) +unsigned +ARMul_OSInit (ARMul_State * state) { #ifndef NOOS #ifndef VALIDATE - ARMword instr, i , j ; - struct OSblock* OSptr = (struct OSblock*)state->OSptr; - - if (state->OSptr == NULL) { - state->OSptr = (unsigned char *)malloc(sizeof(struct OSblock)); - if (state->OSptr == NULL) { - perror("OS Memory"); - exit(15); - } + ARMword instr, i, j; + struct OSblock *OSptr = (struct OSblock *) state->OSptr; + + if (state->OSptr == NULL) + { + state->OSptr = (unsigned char *) malloc (sizeof (struct OSblock)); + if (state->OSptr == NULL) + { + perror ("OS Memory"); + exit (15); + } } - OSptr = (struct OSblock*)state->OSptr; - OSptr->ErrorP = 0; - state->Reg[13] = ADDRSUPERSTACK; /* set up a stack for the current mode */ - ARMul_SetReg(state,SVC32MODE,13,ADDRSUPERSTACK); /* and for supervisor mode */ - ARMul_SetReg(state,ABORT32MODE,13,ADDRSUPERSTACK); /* and for abort 32 mode */ - ARMul_SetReg(state,UNDEF32MODE,13,ADDRSUPERSTACK); /* and for undef 32 mode */ - instr = 0xe59ff000 | (ADDRSOFTVECTORS - 8); /* load pc from soft vector */ - for (i = ARMul_ResetV ; i <= ARMFIQV ; i += 4) - ARMul_WriteWord(state, i, instr); /* write hardware vectors */ - for (i = ARMul_ResetV ; i <= ARMFIQV + 4 ; i += 4) { - ARMul_WriteWord(state, ADDRSOFTVECTORS + i, SOFTVECTORCODE + i * 4); - ARMul_WriteWord(state, ADDRSOFHANDLERS + 2*i + 4L, SOFTVECTORCODE + sizeof(softvectorcode) - 4L); + OSptr = (struct OSblock *) state->OSptr; + OSptr->ErrorP = 0; + state->Reg[13] = ADDRSUPERSTACK; /* set up a stack for the current mode */ + ARMul_SetReg (state, SVC32MODE, 13, ADDRSUPERSTACK); /* and for supervisor mode */ + ARMul_SetReg (state, ABORT32MODE, 13, ADDRSUPERSTACK); /* and for abort 32 mode */ + ARMul_SetReg (state, UNDEF32MODE, 13, ADDRSUPERSTACK); /* and for undef 32 mode */ + instr = 0xe59ff000 | (ADDRSOFTVECTORS - 8); /* load pc from soft vector */ + for (i = ARMul_ResetV; i <= ARMFIQV; i += 4) + ARMul_WriteWord (state, i, instr); /* write hardware vectors */ + for (i = ARMul_ResetV; i <= ARMFIQV + 4; i += 4) + { + ARMul_WriteWord (state, ADDRSOFTVECTORS + i, SOFTVECTORCODE + i * 4); + ARMul_WriteWord (state, ADDRSOFHANDLERS + 2 * i + 4L, + SOFTVECTORCODE + sizeof (softvectorcode) - 4L); } - for (i = 0 ; i < sizeof(softvectorcode) ; i += 4) - ARMul_WriteWord(state, SOFTVECTORCODE + i, softvectorcode[i/4]); - for (i = 0 ; i < FOPEN_MAX ; i++) - OSptr->FileTable[i] = NULL ; - for (i = 0 ; i < UNIQUETEMPS ; i++) - OSptr->tempnames[i] = NULL ; - ARMul_ConsolePrint (state, ", Demon 1.01"); + for (i = 0; i < sizeof (softvectorcode); i += 4) + ARMul_WriteWord (state, SOFTVECTORCODE + i, softvectorcode[i / 4]); + for (i = 0; i < FOPEN_MAX; i++) + OSptr->FileTable[i] = NULL; + for (i = 0; i < UNIQUETEMPS; i++) + OSptr->tempnames[i] = NULL; + ARMul_ConsolePrint (state, ", Demon 1.01"); /* #ifndef ASIM */ - /* install fpe */ - for (i = 0 ; i < fpesize ; i+=4) /* copy the code */ - ARMul_WriteWord(state,FPESTART + i,fpecode[i >> 2]) ; - for (i = FPESTART + fpesize ; ; i-=4) { /* reverse the error strings */ - if ((j = ARMul_ReadWord(state,i)) == 0xffffffff) - break ; - if (state->bigendSig && j < 0x80000000) { /* it's part of the string so swap it */ - j = ((j >> 0x18) & 0x000000ff) | - ((j >> 0x08) & 0x0000ff00) | - ((j << 0x08) & 0x00ff0000) | - ((j << 0x18) & 0xff000000) ; - ARMul_WriteWord(state,i,j) ; - } + /* install fpe */ + for (i = 0; i < fpesize; i += 4) /* copy the code */ + ARMul_WriteWord (state, FPESTART + i, fpecode[i >> 2]); + for (i = FPESTART + fpesize;; i -= 4) + { /* reverse the error strings */ + if ((j = ARMul_ReadWord (state, i)) == 0xffffffff) + break; + if (state->bigendSig && j < 0x80000000) + { /* it's part of the string so swap it */ + j = ((j >> 0x18) & 0x000000ff) | + ((j >> 0x08) & 0x0000ff00) | + ((j << 0x08) & 0x00ff0000) | ((j << 0x18) & 0xff000000); + ARMul_WriteWord (state, i, j); + } } - ARMul_WriteWord(state,FPEOLDVECT,ARMul_ReadWord(state,4)) ; /* copy old illegal instr vector */ - ARMul_WriteWord(state,4,FPENEWVECT(ARMul_ReadWord(state,i-4))) ; /* install new vector */ - ARMul_ConsolePrint (state, ", FPE") ; + ARMul_WriteWord (state, FPEOLDVECT, ARMul_ReadWord (state, 4)); /* copy old illegal instr vector */ + ARMul_WriteWord (state, 4, FPENEWVECT (ARMul_ReadWord (state, i - 4))); /* install new vector */ + ARMul_ConsolePrint (state, ", FPE"); /* #endif /* ASIM */ #endif /* VALIDATE */ #endif /* NOOS */ - return(TRUE) ; + return (TRUE); } -void -ARMul_OSExit (ARMul_State *state) +void +ARMul_OSExit (ARMul_State * state) { - free((char *)state->OSptr); + free ((char *) state->OSptr); } @@ -219,36 +225,34 @@ ARMul_OSExit (ARMul_State *state) * Return the last Operating System Error. * \***************************************************************************/ -ARMword -ARMul_OSLastErrorP (ARMul_State *state) +ARMword ARMul_OSLastErrorP (ARMul_State * state) { - return ((struct OSblock *)state->OSptr)->ErrorP; + return ((struct OSblock *) state->OSptr)->ErrorP; } -#if 1 /* CYGNUS LOCAL */ +#if 1 /* CYGNUS LOCAL */ /* This is the cygnus way of doing it, which makes it simple to do our tests */ -static int translate_open_mode[] = -{ - O_RDONLY, /* "r" */ - O_RDONLY+O_BINARY, /* "rb" */ - O_RDWR, /* "r+" */ - O_RDWR +O_BINARY, /* "r+b" */ - O_WRONLY +O_CREAT+O_TRUNC, /* "w" */ - O_WRONLY+O_BINARY+O_CREAT+O_TRUNC, /* "wb" */ - O_RDWR +O_CREAT+O_TRUNC, /* "w+" */ - O_RDWR +O_BINARY+O_CREAT+O_TRUNC, /* "w+b" */ - O_WRONLY +O_APPEND+O_CREAT,/* "a" */ - O_WRONLY+O_BINARY+O_APPEND+O_CREAT,/* "ab" */ - O_RDWR +O_APPEND+O_CREAT,/* "a+" */ - O_RDWR +O_BINARY+O_APPEND+O_CREAT /* "a+b" */ +static int translate_open_mode[] = { + O_RDONLY, /* "r" */ + O_RDONLY + O_BINARY, /* "rb" */ + O_RDWR, /* "r+" */ + O_RDWR + O_BINARY, /* "r+b" */ + O_WRONLY + O_CREAT + O_TRUNC, /* "w" */ + O_WRONLY + O_BINARY + O_CREAT + O_TRUNC, /* "wb" */ + O_RDWR + O_CREAT + O_TRUNC, /* "w+" */ + O_RDWR + O_BINARY + O_CREAT + O_TRUNC, /* "w+b" */ + O_WRONLY + O_APPEND + O_CREAT, /* "a" */ + O_WRONLY + O_BINARY + O_APPEND + O_CREAT, /* "ab" */ + O_RDWR + O_APPEND + O_CREAT, /* "a+" */ + O_RDWR + O_BINARY + O_APPEND + O_CREAT /* "a+b" */ }; -static void -SWIWrite0 (ARMul_State *state, ARMword addr) +static void +SWIWrite0 (ARMul_State * state, ARMword addr) { ARMword temp; - struct OSblock* OSptr = (struct OSblock*) state->OSptr; + struct OSblock *OSptr = (struct OSblock *) state->OSptr; while ((temp = ARMul_ReadByte (state, addr++)) != 0) (void) fputc ((char) temp, stdout); @@ -256,30 +260,30 @@ SWIWrite0 (ARMul_State *state, ARMword addr) OSptr->ErrorNo = errno; } -static void -WriteCommandLineTo (ARMul_State *state, ARMword addr) +static void +WriteCommandLineTo (ARMul_State * state, ARMword addr) { ARMword temp; char *cptr = state->CommandLine; if (cptr == NULL) cptr = "\0"; - do { - temp = (ARMword) *cptr++; - ARMul_WriteByte (state, addr++, temp); - } while (temp != 0); + do + { + temp = (ARMword) * cptr++; + ARMul_WriteByte (state, addr++, temp); + } + while (temp != 0); } -static void -SWIopen (ARMul_State *state, ARMword name, ARMword SWIflags) +static void +SWIopen (ARMul_State * state, ARMword name, ARMword SWIflags) { - struct OSblock* OSptr = (struct OSblock*)state->OSptr; + struct OSblock *OSptr = (struct OSblock *) state->OSptr; char dummy[2000]; int flags; int i; - for (i = 0; - dummy[i] = ARMul_ReadByte (state, name + i); - i++) + for (i = 0; dummy[i] = ARMul_ReadByte (state, name + i); i++) ; /* Now we need to decode the Demon open mode */ @@ -288,10 +292,10 @@ SWIopen (ARMul_State *state, ARMword name, ARMword SWIflags) /* Filename ":tt" is special: it denotes stdin/out */ if (strcmp (dummy, ":tt") == 0) { - if (flags == O_RDONLY) /* opening tty "r" */ - state->Reg[0] = 0; /* stdin */ - else - state->Reg[0] = 1; /* stdout */ + if (flags == O_RDONLY) /* opening tty "r" */ + state->Reg[0] = 0; /* stdin */ + else + state->Reg[0] = 1; /* stdout */ } else { @@ -300,44 +304,46 @@ SWIopen (ARMul_State *state, ARMword name, ARMword SWIflags) } } -static void -SWIread (ARMul_State *state, ARMword f, ARMword ptr, ARMword len) +static void +SWIread (ARMul_State * state, ARMword f, ARMword ptr, ARMword len) { - struct OSblock* OSptr = (struct OSblock*) state->OSptr; + struct OSblock *OSptr = (struct OSblock *) state->OSptr; int res; int i; char *local = malloc (len); if (local == NULL) { - fprintf (stderr, "sim: Unable to read 0x%x bytes - out of memory\n", len); + fprintf (stderr, "sim: Unable to read 0x%x bytes - out of memory\n", + len); return; } - + res = read (f, local, len); if (res > 0) - for (i = 0; i < res; i++) + for (i = 0; i < res; i++) ARMul_WriteByte (state, ptr + i, local[i]); free (local); state->Reg[0] = res == -1 ? -1 : len - res; OSptr->ErrorNo = errno; } -static void -SWIwrite (ARMul_State *state, ARMword f, ARMword ptr, ARMword len) +static void +SWIwrite (ARMul_State * state, ARMword f, ARMword ptr, ARMword len) { - struct OSblock* OSptr = (struct OSblock*) state->OSptr; + struct OSblock *OSptr = (struct OSblock *) state->OSptr; int res; int i; char *local = malloc (len); if (local == NULL) { - fprintf (stderr, "sim: Unable to write 0x%x bytes - out of memory\n", len); + fprintf (stderr, "sim: Unable to write 0x%x bytes - out of memory\n", + len); return; } - - for (i = 0; i < len; i++) + + for (i = 0; i < len; i++) local[i] = ARMul_ReadByte (state, ptr + i); res = write (f, local, len); @@ -346,10 +352,10 @@ SWIwrite (ARMul_State *state, ARMword f, ARMword ptr, ARMword len) OSptr->ErrorNo = errno; } -static void -SWIflen (ARMul_State *state, ARMword fh) +static void +SWIflen (ARMul_State * state, ARMword fh) { - struct OSblock* OSptr = (struct OSblock*) state->OSptr; + struct OSblock *OSptr = (struct OSblock *) state->OSptr; ARMword addr; if (fh == 0 || fh > FOPEN_MAX) @@ -376,99 +382,97 @@ SWIflen (ARMul_State *state, ARMword fh) * parameter passed is the SWI number (lower 24 bits of the instruction). * \***************************************************************************/ -unsigned -ARMul_OSHandleSWI (ARMul_State *state, ARMword number) +unsigned +ARMul_OSHandleSWI (ARMul_State * state, ARMword number) { ARMword addr, temp, fildes; char buffer[BUFFERSIZE], *cptr; FILE *fptr; - struct OSblock* OSptr = (struct OSblock*)state->OSptr; + struct OSblock *OSptr = (struct OSblock *) state->OSptr; switch (number) { case SWI_Read: - SWIread (state, state->Reg[0], state->Reg[1], state->Reg[2]); - return TRUE; + SWIread (state, state->Reg[0], state->Reg[1], state->Reg[2]); + return TRUE; case SWI_Write: - SWIwrite (state, state->Reg[0], state->Reg[1], state->Reg[2]); - return TRUE; + SWIwrite (state, state->Reg[0], state->Reg[1], state->Reg[2]); + return TRUE; case SWI_Open: - SWIopen (state, state->Reg[0],state->Reg[1]); - return TRUE; + SWIopen (state, state->Reg[0], state->Reg[1]); + return TRUE; - case SWI_Clock : - /* return number of centi-seconds... */ - state->Reg[0] = + case SWI_Clock: + /* return number of centi-seconds... */ + state->Reg[0] = #ifdef CLOCKS_PER_SEC - (CLOCKS_PER_SEC >= 100) - ? (ARMword) (clock() / (CLOCKS_PER_SEC / 100)) - : (ARMword) ((clock() * 100) / CLOCKS_PER_SEC) ; + (CLOCKS_PER_SEC >= 100) + ? (ARMword) (clock () / (CLOCKS_PER_SEC / 100)) + : (ARMword) ((clock () * 100) / CLOCKS_PER_SEC); #else - /* presume unix... clock() returns microseconds */ - (ARMword) (clock() / 10000) ; + /* presume unix... clock() returns microseconds */ + (ARMword) (clock () / 10000); #endif - OSptr->ErrorNo = errno ; - return(TRUE) ; - - case SWI_Time : - state->Reg[0] = (ARMword)time(NULL) ; - OSptr->ErrorNo = errno ; - return(TRUE) ; - + OSptr->ErrorNo = errno; + return (TRUE); + + case SWI_Time: + state->Reg[0] = (ARMword) time (NULL); + OSptr->ErrorNo = errno; + return (TRUE); + case SWI_Close: state->Reg[0] = close (state->Reg[0]); OSptr->ErrorNo = errno; return TRUE; - case SWI_Flen : + case SWI_Flen: SWIflen (state, state->Reg[0]); - return(TRUE) ; + return (TRUE); case SWI_Exit: - state->Emulate = FALSE ; + state->Emulate = FALSE; return TRUE; case SWI_Seek: { /* We must return non-zero for failure */ - state->Reg[0] = -1 >= lseek (state->Reg[0], - state->Reg[1], - SEEK_SET); + state->Reg[0] = -1 >= lseek (state->Reg[0], state->Reg[1], SEEK_SET); OSptr->ErrorNo = errno; return TRUE; } - case SWI_WriteC : - (void)fputc((int)state->Reg[0],stdout) ; - OSptr->ErrorNo = errno ; - return(TRUE) ; + case SWI_WriteC: + (void) fputc ((int) state->Reg[0], stdout); + OSptr->ErrorNo = errno; + return (TRUE); - case SWI_Write0 : + case SWI_Write0: SWIWrite0 (state, state->Reg[0]); - return(TRUE) ; + return (TRUE); - case SWI_GetErrno : - state->Reg[0] = OSptr->ErrorNo ; - return(TRUE) ; + case SWI_GetErrno: + state->Reg[0] = OSptr->ErrorNo; + return (TRUE); - case SWI_Breakpoint : - state->EndCondition = RDIError_BreakpointReached ; - state->Emulate = FALSE ; - return(TRUE) ; + case SWI_Breakpoint: + state->EndCondition = RDIError_BreakpointReached; + state->Emulate = FALSE; + return (TRUE); - case SWI_GetEnv : - state->Reg[0] = ADDRCMDLINE ; - if (state->MemSize) - state->Reg[1] = state->MemSize ; - else - state->Reg[1] = ADDRUSERSTACK ; + case SWI_GetEnv: + state->Reg[0] = ADDRCMDLINE; + if (state->MemSize) + state->Reg[1] = state->MemSize; + else + state->Reg[1] = ADDRUSERSTACK; - WriteCommandLineTo (state, state->Reg[0]); - return(TRUE) ; + WriteCommandLineTo (state, state->Reg[0]); + return (TRUE); - /* Handle Angel SWIs as well as Demon ones */ + /* Handle Angel SWIs as well as Demon ones */ case AngelSWI_ARM: case AngelSWI_Thumb: /* R1 is almost always a parameter block */ @@ -486,18 +490,18 @@ ARMul_OSHandleSWI (ARMul_State *state, ARMword number) case AngelSWI_Reason_EnterSVC: default: state->Emulate = FALSE; - return(FALSE); + return (FALSE); case AngelSWI_Reason_Clock: - /* return number of centi-seconds... */ + /* return number of centi-seconds... */ state->Reg[0] = #ifdef CLOCKS_PER_SEC (CLOCKS_PER_SEC >= 100) - ? (ARMword) (clock() / (CLOCKS_PER_SEC / 100)) - : (ARMword) ((clock() * 100) / CLOCKS_PER_SEC) ; + ? (ARMword) (clock () / (CLOCKS_PER_SEC / 100)) + : (ARMword) ((clock () * 100) / CLOCKS_PER_SEC); #else - /* presume unix... clock() returns microseconds */ - (ARMword) (clock() / 10000) ; + /* presume unix... clock() returns microseconds */ + (ARMword) (clock () / 10000); #endif OSptr->ErrorNo = errno; return (TRUE); @@ -508,7 +512,7 @@ ARMul_OSHandleSWI (ARMul_State *state, ARMword number) return (TRUE); case AngelSWI_Reason_WriteC: - (void) fputc ((int) ARMul_ReadByte (state,addr), stdout); + (void) fputc ((int) ARMul_ReadByte (state, addr), stdout); OSptr->ErrorNo = errno; return (TRUE); @@ -522,8 +526,8 @@ ARMul_OSHandleSWI (ARMul_State *state, ARMword number) return (TRUE); case AngelSWI_Reason_Seek: - state->Reg[0] = -1 >= lseek (ARMul_ReadWord(state,addr), - ARMul_ReadWord(state,addr+4), + state->Reg[0] = -1 >= lseek (ARMul_ReadWord (state, addr), + ARMul_ReadWord (state, addr + 4), SEEK_SET); OSptr->ErrorNo = errno; return (TRUE); @@ -532,7 +536,7 @@ ARMul_OSHandleSWI (ARMul_State *state, ARMword number) SWIflen (state, ARMul_ReadWord (state, addr)); return (TRUE); - case AngelSWI_Reason_GetCmdLine: + case AngelSWI_Reason_GetCmdLine: WriteCommandLineTo (state, ARMul_ReadWord (state, addr)); return (TRUE); @@ -546,10 +550,10 @@ ARMul_OSHandleSWI (ARMul_State *state, ARMword number) else temp = ADDRUSERSTACK; - ARMul_WriteWord (state, addr, 0); /* Heap base */ - ARMul_WriteWord (state, addr+4, temp); /* Heap limit */ - ARMul_WriteWord (state, addr+8, temp); /* Stack base */ - ARMul_WriteWord (state, addr+12, temp); /* Stack limit */ + ARMul_WriteWord (state, addr, 0); /* Heap base */ + ARMul_WriteWord (state, addr + 4, temp); /* Heap limit */ + ARMul_WriteWord (state, addr + 8, temp); /* Stack base */ + ARMul_WriteWord (state, addr + 12, temp); /* Stack limit */ return (TRUE); case AngelSWI_Reason_ReportException: @@ -557,17 +561,17 @@ ARMul_OSHandleSWI (ARMul_State *state, ARMword number) state->Reg[0] = 0; else state->Reg[0] = -1; - state->Emulate = FALSE ; + state->Emulate = FALSE; return (TRUE); case ADP_Stopped_ApplicationExit: state->Reg[0] = 0; - state->Emulate = FALSE ; + state->Emulate = FALSE; return (TRUE); - + case ADP_Stopped_RunTimeError: state->Reg[0] = -1; - state->Emulate = FALSE ; + state->Emulate = FALSE; return (TRUE); case AngelSWI_Reason_Errno: @@ -575,511 +579,560 @@ ARMul_OSHandleSWI (ARMul_State *state, ARMword number) return (TRUE); case AngelSWI_Reason_Open: - SWIopen(state, - ARMul_ReadWord(state, addr), - ARMul_ReadWord(state, addr+4)); + SWIopen (state, + ARMul_ReadWord (state, addr), + ARMul_ReadWord (state, addr + 4)); return TRUE; case AngelSWI_Reason_Read: - SWIread(state, - ARMul_ReadWord(state, addr), - ARMul_ReadWord(state, addr+4), - ARMul_ReadWord(state, addr+8)); + SWIread (state, + ARMul_ReadWord (state, addr), + ARMul_ReadWord (state, addr + 4), + ARMul_ReadWord (state, addr + 8)); return TRUE; case AngelSWI_Reason_Write: - SWIwrite(state, - ARMul_ReadWord(state, addr), - ARMul_ReadWord(state, addr+4), - ARMul_ReadWord(state, addr+8)); + SWIwrite (state, + ARMul_ReadWord (state, addr), + ARMul_ReadWord (state, addr + 4), + ARMul_ReadWord (state, addr + 8)); return TRUE; } - default : - state->Emulate = FALSE ; - return(FALSE) ; + default: + state->Emulate = FALSE; + return (FALSE); } } -#else /* CYGNUS LOCAL: #if 1 */ +#else /* CYGNUS LOCAL: #if 1 */ -unsigned -ARMul_OSHandleSWI (ARMul_State *state, ARMword number) +unsigned +ARMul_OSHandleSWI (ARMul_State * state, ARMword number) { #ifdef NOOS - return(FALSE) ; + return (FALSE); #else #ifdef VALIDATE - switch (number) { - case 0x11 : - state->Emulate = FALSE ; - return(TRUE) ; - case 0x01 : - if (ARM32BITMODE) - ARMul_SetCPSR(state, (ARMul_GetCPSR(state) & 0xffffffc0) | 0x13) ; - else - ARMul_SetCPSR(state, (ARMul_GetCPSR(state) & 0xffffffc0) | 0x3) ; - return(TRUE) ; - default : - return(FALSE) ; + switch (number) + { + case 0x11: + state->Emulate = FALSE; + return (TRUE); + case 0x01: + if (ARM32BITMODE) + ARMul_SetCPSR (state, (ARMul_GetCPSR (state) & 0xffffffc0) | 0x13); + else + ARMul_SetCPSR (state, (ARMul_GetCPSR (state) & 0xffffffc0) | 0x3); + return (TRUE); + default: + return (FALSE); } #else - ARMword addr, temp ; - char buffer[BUFFERSIZE], *cptr ; - FILE *fptr ; - struct OSblock* OSptr = (struct OSblock*)state->OSptr ; - - switch (number) { - case SWI_WriteC : - (void)fputc((int)state->Reg[0],stderr) ; - OSptr->ErrorNo = errno ; - return(TRUE) ; - - case SWI_Write0 : - addr = state->Reg[0] ; - while ((temp = ARMul_ReadByte(state,addr++)) != 0) - fputc((char)temp,stderr) ; - OSptr->ErrorNo = errno ; - return(TRUE) ; - - case SWI_ReadC : - state->Reg[0] = (ARMword)fgetc(stdin) ; - OSptr->ErrorNo = errno ; - return(TRUE) ; - - case SWI_CLI : - addr = state->Reg[0] ; - getstring(state,state->Reg[0],buffer) ; - state->Reg[0] = (ARMword)system(buffer) ; - OSptr->ErrorNo = errno ; - return(TRUE) ; - - case SWI_GetEnv : - state->Reg[0] = ADDRCMDLINE ; - if (state->MemSize) - state->Reg[1] = state->MemSize ; - else - state->Reg[1] = ADDRUSERSTACK ; - - addr = state->Reg[0] ; - cptr = state->CommandLine ; - if (cptr == NULL) - cptr = "\0" ; - do { - temp = (ARMword)*cptr++ ; - ARMul_WriteByte(state,addr++,temp) ; - } while (temp != 0) ; - return(TRUE) ; - - case SWI_Exit : + ARMword addr, temp; + char buffer[BUFFERSIZE], *cptr; + FILE *fptr; + struct OSblock *OSptr = (struct OSblock *) state->OSptr; + + switch (number) + { + case SWI_WriteC: + (void) fputc ((int) state->Reg[0], stderr); + OSptr->ErrorNo = errno; + return (TRUE); + + case SWI_Write0: + addr = state->Reg[0]; + while ((temp = ARMul_ReadByte (state, addr++)) != 0) + fputc ((char) temp, stderr); + OSptr->ErrorNo = errno; + return (TRUE); + + case SWI_ReadC: + state->Reg[0] = (ARMword) fgetc (stdin); + OSptr->ErrorNo = errno; + return (TRUE); + + case SWI_CLI: + addr = state->Reg[0]; + getstring (state, state->Reg[0], buffer); + state->Reg[0] = (ARMword) system (buffer); + OSptr->ErrorNo = errno; + return (TRUE); + + case SWI_GetEnv: + state->Reg[0] = ADDRCMDLINE; + if (state->MemSize) + state->Reg[1] = state->MemSize; + else + state->Reg[1] = ADDRUSERSTACK; + + addr = state->Reg[0]; + cptr = state->CommandLine; + if (cptr == NULL) + cptr = "\0"; + do + { + temp = (ARMword) * cptr++; + ARMul_WriteByte (state, addr++, temp); + } + while (temp != 0); + return (TRUE); + + case SWI_Exit: #ifdef ASIM - simkernel1_abort_run() ; + simkernel1_abort_run (); #else - state->Emulate = FALSE ; + state->Emulate = FALSE; #endif - return(TRUE) ; - - case SWI_EnterOS : - if (ARM32BITMODE) - ARMul_SetCPSR(state, (ARMul_GetCPSR(state) & 0xffffffc0) | 0x13) ; - else - ARMul_SetCPSR(state, (ARMul_GetCPSR(state) & 0xffffffc0) | 0x3) ; - return(TRUE) ; - - case SWI_GetErrno : - state->Reg[0] = OSptr->ErrorNo ; - return(TRUE) ; - - case SWI_Clock : - /* return muber of centi-seconds... */ - state->Reg[0] = + return (TRUE); + + case SWI_EnterOS: + if (ARM32BITMODE) + ARMul_SetCPSR (state, (ARMul_GetCPSR (state) & 0xffffffc0) | 0x13); + else + ARMul_SetCPSR (state, (ARMul_GetCPSR (state) & 0xffffffc0) | 0x3); + return (TRUE); + + case SWI_GetErrno: + state->Reg[0] = OSptr->ErrorNo; + return (TRUE); + + case SWI_Clock: + /* return muber of centi-seconds... */ + state->Reg[0] = #ifdef CLOCKS_PER_SEC - (CLOCKS_PER_SEC >= 100) - ? (ARMword) (clock() / (CLOCKS_PER_SEC / 100)) - : (ARMword) ((clock() * 100) / CLOCKS_PER_SEC) ; + (CLOCKS_PER_SEC >= 100) + ? (ARMword) (clock () / (CLOCKS_PER_SEC / 100)) + : (ARMword) ((clock () * 100) / CLOCKS_PER_SEC); #else - /* presume unix... clock() returns microseconds */ - (ARMword) (clock() / 10000) ; + /* presume unix... clock() returns microseconds */ + (ARMword) (clock () / 10000); #endif - OSptr->ErrorNo = errno ; - return(TRUE) ; - - case SWI_Time : - state->Reg[0] = (ARMword)time(NULL) ; - OSptr->ErrorNo = errno ; - return(TRUE) ; - - case SWI_Remove : - getstring(state,state->Reg[0],buffer) ; - state->Reg[0] = unlink(buffer) ; - OSptr->ErrorNo = errno ; - return(TRUE) ; - - case SWI_Rename : { - char buffer2[BUFFERSIZE] ; - - getstring(state,state->Reg[0],buffer) ; - getstring(state,state->Reg[1],buffer2) ; - state->Reg[0] = rename(buffer,buffer2) ; - OSptr->ErrorNo = errno ; - return(TRUE) ; - } - - case SWI_Open : { + OSptr->ErrorNo = errno; + return (TRUE); + + case SWI_Time: + state->Reg[0] = (ARMword) time (NULL); + OSptr->ErrorNo = errno; + return (TRUE); + + case SWI_Remove: + getstring (state, state->Reg[0], buffer); + state->Reg[0] = unlink (buffer); + OSptr->ErrorNo = errno; + return (TRUE); + + case SWI_Rename: + { + char buffer2[BUFFERSIZE]; + + getstring (state, state->Reg[0], buffer); + getstring (state, state->Reg[1], buffer2); + state->Reg[0] = rename (buffer, buffer2); + OSptr->ErrorNo = errno; + return (TRUE); + } + + case SWI_Open: + { #if 0 - /* It seems to me that these are in the wrong order - sac@cygnus.com, so I've redone it to use the - flags instead, with the functionality which was already - there -- ahh, perhaps the TRUNC bit is in a different - place on the original host ?*/ - static char* fmode[] = {"r","rb","r+","r+b", - "w","wb","w+","w+b", - "a","ab","a+","a+b", - "r","r","r","r"} /* last 4 are illegal */ ; + /* It seems to me that these are in the wrong order + sac@cygnus.com, so I've redone it to use the + flags instead, with the functionality which was already + there -- ahh, perhaps the TRUNC bit is in a different + place on the original host ? */ + static char *fmode[] = { "r", "rb", "r+", "r+b", + "w", "wb", "w+", "w+b", + "a", "ab", "a+", "a+b", + "r", "r", "r", "r" + } /* last 4 are illegal */ ; #endif - unsigned type ; - - type = (unsigned)(state->Reg[1] & 3L) ; - getstring(state,state->Reg[0],buffer) ; - if (strcmp(buffer,":tt")==0 && (type == O_RDONLY )) /* opening tty "r" */ - fptr = stdin ; - else if (strcmp(buffer,":tt")==0 && (type == O_WRONLY)) /* opening tty "w" */ - fptr = stderr ; - else - { - switch (type) - { - case O_RDONLY: - fptr = fopen(buffer,"r") ; - break; - case O_WRONLY: - fptr = fopen(buffer,"w") ; - break; - case O_RDWR: - fptr = fopen(buffer,"rw") ; - break; - } - } - - state->Reg[0] = 0 ; - if (fptr != NULL) { - for (temp = 0 ; temp < FOPEN_MAX ; temp++) - if (OSptr->FileTable[temp] == NULL) { - OSptr->FileTable[temp] = fptr ; - OSptr->FileFlags[temp] = type & 1 ; /* preserve the binary bit */ - state->Reg[0] = (ARMword)(temp + 1) ; - break ; - } - if (state->Reg[0] == 0) - OSptr->ErrorNo = EMFILE ; /* too many open files */ - else - OSptr->ErrorNo = errno ; - } - else - OSptr->ErrorNo = errno ; - return(TRUE) ; - } - - case SWI_Close : - temp = state->Reg[0] ; - if (temp == 0 || temp > FOPEN_MAX || OSptr->FileTable[temp - 1] == 0) { - OSptr->ErrorNo = EBADF ; - state->Reg[0] = -1L ; - return(TRUE) ; - } - temp-- ; - fptr = OSptr->FileTable[temp] ; - if (fptr == stdin || fptr == stderr) - state->Reg[0] = 0 ; - else - state->Reg[0] = fclose(fptr) ; - OSptr->FileTable[temp] = NULL ; - OSptr->ErrorNo = errno ; - return(TRUE) ; - - case SWI_Write : { - unsigned size, upto, type ; - char ch ; - - temp = state->Reg[0] ; - if (temp == 0 || temp > FOPEN_MAX || OSptr->FileTable[temp - 1] == 0) { - OSptr->ErrorNo = EBADF ; - state->Reg[0] = -1L ; - return(TRUE) ; - } - temp-- ; - fptr = OSptr->FileTable[temp] ; - type = OSptr->FileFlags[temp] ; - addr = state->Reg[1] ; - size = (unsigned)state->Reg[2] ; - - if (type & READOP) - fseek(fptr,0L,SEEK_CUR) ; - OSptr->FileFlags[temp] = (type & BINARY) | WRITEOP ; ; - while (size > 0) { - if (size >= BUFFERSIZE) - upto = BUFFERSIZE ; - else - upto = size ; - for (cptr = buffer ; (cptr - buffer) < upto ; cptr++) { - ch = (char)ARMul_ReadByte(state,(ARMword)addr++) ; - *cptr = FIXCRLF(type,ch) ; - } - temp = fwrite(buffer,1,upto,fptr) ; - if (temp < upto) { - state->Reg[0] = (ARMword)(size - temp) ; - OSptr->ErrorNo = errno ; - return(TRUE) ; - } - size -= upto ; - } - state->Reg[0] = 0 ; - OSptr->ErrorNo = errno ; - return(TRUE) ; - } - - case SWI_Read : { - unsigned size, upto, type ; - char ch ; - - temp = state->Reg[0] ; - if (temp == 0 || temp > FOPEN_MAX || OSptr->FileTable[temp - 1] == 0) { - OSptr->ErrorNo = EBADF ; - state->Reg[0] = -1L ; - return(TRUE) ; - } - temp-- ; - fptr = OSptr->FileTable[temp] ; - addr = state->Reg[1] ; - size = (unsigned)state->Reg[2] ; - type = OSptr->FileFlags[temp] ; - - if (type & WRITEOP) - fseek(fptr,0L,SEEK_CUR) ; - OSptr->FileFlags[temp] = (type & BINARY) | READOP ; ; - while (size > 0) { - if (isatty_(fptr)) { - upto = (size >= BUFFERSIZE)?BUFFERSIZE:size + 1 ; - if (fgets(buffer, upto, fptr) != 0) - temp = strlen(buffer) ; - else - temp = 0 ; - upto-- ; /* 1 char used for terminating null */ - } - else { - upto = (size>=BUFFERSIZE)?BUFFERSIZE:size ; - temp = fread(buffer,1,upto,fptr) ; - } - for (cptr = buffer ; (cptr - buffer) < temp ; cptr++) { - ch = *cptr ; - ARMul_WriteByte(state,(ARMword)addr++,FIXCRLF(type,ch)) ; - } - if (temp < upto) { - state->Reg[0] = (ARMword)(size - temp) ; - OSptr->ErrorNo = errno ; - return(TRUE) ; - } - size -= upto ; - } - state->Reg[0] = 0 ; - OSptr->ErrorNo = errno ; - return(TRUE) ; - } - - case SWI_Seek : - if (state->Reg[0] == 0 || state->Reg[0] > FOPEN_MAX - || OSptr->FileTable[state->Reg[0] - 1] == 0) { - OSptr->ErrorNo = EBADF ; - state->Reg[0] = -1L ; - return(TRUE) ; - } - fptr = OSptr->FileTable[state->Reg[0] - 1] ; - state->Reg[0] = fseek(fptr,(long)state->Reg[1],SEEK_SET) ; - OSptr->ErrorNo = errno ; - return(TRUE) ; - - case SWI_Flen : - if (state->Reg[0] == 0 || state->Reg[0] > FOPEN_MAX - || OSptr->FileTable[state->Reg[0] - 1] == 0) { - OSptr->ErrorNo = EBADF ; - state->Reg[0] = -1L ; - return(TRUE) ; - } - fptr = OSptr->FileTable[state->Reg[0] - 1] ; - addr = (ARMword)ftell(fptr) ; - if (fseek(fptr,0L,SEEK_END) < 0) - state->Reg[0] = -1 ; - else { - state->Reg[0] = (ARMword)ftell(fptr) ; - (void)fseek(fptr,addr,SEEK_SET) ; - } - OSptr->ErrorNo = errno ; - return(TRUE) ; - - case SWI_IsTTY : - if (state->Reg[0] == 0 || state->Reg[0] > FOPEN_MAX - || OSptr->FileTable[state->Reg[0] - 1] == 0) { - OSptr->ErrorNo = EBADF ; - state->Reg[0] = -1L ; - return(TRUE) ; - } - fptr = OSptr->FileTable[state->Reg[0] - 1] ; - state->Reg[0] = isatty_(fptr) ; - OSptr->ErrorNo = errno ; - return(TRUE) ; - - case SWI_TmpNam :{ - ARMword size ; - - addr = state->Reg[0] ; - temp = state->Reg[1] & 0xff ; - size = state->Reg[2] ; - if (OSptr->tempnames[temp] == NULL) { - if ((OSptr->tempnames[temp] = malloc(L_tmpnam)) == NULL) { - state->Reg[0] = 0 ; - return(TRUE) ; - } - (void)tmpnam(OSptr->tempnames[temp]) ; - } - cptr = OSptr->tempnames[temp] ; - if (strlen(cptr) > state->Reg[2]) - state->Reg[0] = 0 ; - else - do { - ARMul_WriteByte(state,addr++,*cptr) ; - } while (*cptr++ != 0) ; - OSptr->ErrorNo = errno ; - return(TRUE) ; - } + unsigned type; + + type = (unsigned) (state->Reg[1] & 3L); + getstring (state, state->Reg[0], buffer); + if (strcmp (buffer, ":tt") == 0 && (type == O_RDONLY)) /* opening tty "r" */ + fptr = stdin; + else if (strcmp (buffer, ":tt") == 0 && (type == O_WRONLY)) /* opening tty "w" */ + fptr = stderr; + else + { + switch (type) + { + case O_RDONLY: + fptr = fopen (buffer, "r"); + break; + case O_WRONLY: + fptr = fopen (buffer, "w"); + break; + case O_RDWR: + fptr = fopen (buffer, "rw"); + break; + } + } + + state->Reg[0] = 0; + if (fptr != NULL) + { + for (temp = 0; temp < FOPEN_MAX; temp++) + if (OSptr->FileTable[temp] == NULL) + { + OSptr->FileTable[temp] = fptr; + OSptr->FileFlags[temp] = type & 1; /* preserve the binary bit */ + state->Reg[0] = (ARMword) (temp + 1); + break; + } + if (state->Reg[0] == 0) + OSptr->ErrorNo = EMFILE; /* too many open files */ + else + OSptr->ErrorNo = errno; + } + else + OSptr->ErrorNo = errno; + return (TRUE); + } + + case SWI_Close: + temp = state->Reg[0]; + if (temp == 0 || temp > FOPEN_MAX || OSptr->FileTable[temp - 1] == 0) + { + OSptr->ErrorNo = EBADF; + state->Reg[0] = -1L; + return (TRUE); + } + temp--; + fptr = OSptr->FileTable[temp]; + if (fptr == stdin || fptr == stderr) + state->Reg[0] = 0; + else + state->Reg[0] = fclose (fptr); + OSptr->FileTable[temp] = NULL; + OSptr->ErrorNo = errno; + return (TRUE); + + case SWI_Write: + { + unsigned size, upto, type; + char ch; + + temp = state->Reg[0]; + if (temp == 0 || temp > FOPEN_MAX || OSptr->FileTable[temp - 1] == 0) + { + OSptr->ErrorNo = EBADF; + state->Reg[0] = -1L; + return (TRUE); + } + temp--; + fptr = OSptr->FileTable[temp]; + type = OSptr->FileFlags[temp]; + addr = state->Reg[1]; + size = (unsigned) state->Reg[2]; + + if (type & READOP) + fseek (fptr, 0L, SEEK_CUR); + OSptr->FileFlags[temp] = (type & BINARY) | WRITEOP;; + while (size > 0) + { + if (size >= BUFFERSIZE) + upto = BUFFERSIZE; + else + upto = size; + for (cptr = buffer; (cptr - buffer) < upto; cptr++) + { + ch = (char) ARMul_ReadByte (state, (ARMword) addr++); + *cptr = FIXCRLF (type, ch); + } + temp = fwrite (buffer, 1, upto, fptr); + if (temp < upto) + { + state->Reg[0] = (ARMword) (size - temp); + OSptr->ErrorNo = errno; + return (TRUE); + } + size -= upto; + } + state->Reg[0] = 0; + OSptr->ErrorNo = errno; + return (TRUE); + } + + case SWI_Read: + { + unsigned size, upto, type; + char ch; + + temp = state->Reg[0]; + if (temp == 0 || temp > FOPEN_MAX || OSptr->FileTable[temp - 1] == 0) + { + OSptr->ErrorNo = EBADF; + state->Reg[0] = -1L; + return (TRUE); + } + temp--; + fptr = OSptr->FileTable[temp]; + addr = state->Reg[1]; + size = (unsigned) state->Reg[2]; + type = OSptr->FileFlags[temp]; + + if (type & WRITEOP) + fseek (fptr, 0L, SEEK_CUR); + OSptr->FileFlags[temp] = (type & BINARY) | READOP;; + while (size > 0) + { + if (isatty_ (fptr)) + { + upto = (size >= BUFFERSIZE) ? BUFFERSIZE : size + 1; + if (fgets (buffer, upto, fptr) != 0) + temp = strlen (buffer); + else + temp = 0; + upto--; /* 1 char used for terminating null */ + } + else + { + upto = (size >= BUFFERSIZE) ? BUFFERSIZE : size; + temp = fread (buffer, 1, upto, fptr); + } + for (cptr = buffer; (cptr - buffer) < temp; cptr++) + { + ch = *cptr; + ARMul_WriteByte (state, (ARMword) addr++, FIXCRLF (type, ch)); + } + if (temp < upto) + { + state->Reg[0] = (ARMword) (size - temp); + OSptr->ErrorNo = errno; + return (TRUE); + } + size -= upto; + } + state->Reg[0] = 0; + OSptr->ErrorNo = errno; + return (TRUE); + } + + case SWI_Seek: + if (state->Reg[0] == 0 || state->Reg[0] > FOPEN_MAX + || OSptr->FileTable[state->Reg[0] - 1] == 0) + { + OSptr->ErrorNo = EBADF; + state->Reg[0] = -1L; + return (TRUE); + } + fptr = OSptr->FileTable[state->Reg[0] - 1]; + state->Reg[0] = fseek (fptr, (long) state->Reg[1], SEEK_SET); + OSptr->ErrorNo = errno; + return (TRUE); + + case SWI_Flen: + if (state->Reg[0] == 0 || state->Reg[0] > FOPEN_MAX + || OSptr->FileTable[state->Reg[0] - 1] == 0) + { + OSptr->ErrorNo = EBADF; + state->Reg[0] = -1L; + return (TRUE); + } + fptr = OSptr->FileTable[state->Reg[0] - 1]; + addr = (ARMword) ftell (fptr); + if (fseek (fptr, 0L, SEEK_END) < 0) + state->Reg[0] = -1; + else + { + state->Reg[0] = (ARMword) ftell (fptr); + (void) fseek (fptr, addr, SEEK_SET); + } + OSptr->ErrorNo = errno; + return (TRUE); + + case SWI_IsTTY: + if (state->Reg[0] == 0 || state->Reg[0] > FOPEN_MAX + || OSptr->FileTable[state->Reg[0] - 1] == 0) + { + OSptr->ErrorNo = EBADF; + state->Reg[0] = -1L; + return (TRUE); + } + fptr = OSptr->FileTable[state->Reg[0] - 1]; + state->Reg[0] = isatty_ (fptr); + OSptr->ErrorNo = errno; + return (TRUE); + + case SWI_TmpNam: + { + ARMword size; + + addr = state->Reg[0]; + temp = state->Reg[1] & 0xff; + size = state->Reg[2]; + if (OSptr->tempnames[temp] == NULL) + { + if ((OSptr->tempnames[temp] = malloc (L_tmpnam)) == NULL) + { + state->Reg[0] = 0; + return (TRUE); + } + (void) tmpnam (OSptr->tempnames[temp]); + } + cptr = OSptr->tempnames[temp]; + if (strlen (cptr) > state->Reg[2]) + state->Reg[0] = 0; + else + do + { + ARMul_WriteByte (state, addr++, *cptr); + } + while (*cptr++ != 0); + OSptr->ErrorNo = errno; + return (TRUE); + } case SWI_InstallHandler: - { ARMword handlerp = ADDRSOFHANDLERS + state->Reg[0] * 8; - ARMword oldr1 = ARMul_ReadWord(state, handlerp), - oldr2 = ARMul_ReadWord(state, handlerp + 4); - ARMul_WriteWord(state, handlerp, state->Reg[1]); - ARMul_WriteWord(state, handlerp + 4, state->Reg[2]); - state->Reg[1] = oldr1; - state->Reg[2] = oldr2; - return(TRUE); - } + { + ARMword handlerp = ADDRSOFHANDLERS + state->Reg[0] * 8; + ARMword oldr1 = ARMul_ReadWord (state, handlerp), + oldr2 = ARMul_ReadWord (state, handlerp + 4); + ARMul_WriteWord (state, handlerp, state->Reg[1]); + ARMul_WriteWord (state, handlerp + 4, state->Reg[2]); + state->Reg[1] = oldr1; + state->Reg[2] = oldr2; + return (TRUE); + } case SWI_GenerateError: - ARMul_Abort(state, ARMSWIV) ; - if (state->Emulate) - ARMul_SetR15(state, ARMul_ReadWord(state, ADDRSOFTVECTORS + ARMErrorV)); - return(TRUE); + ARMul_Abort (state, ARMSWIV); + if (state->Emulate) + ARMul_SetR15 (state, + ARMul_ReadWord (state, ADDRSOFTVECTORS + ARMErrorV)); + return (TRUE); /* SWI's 0x9x unwind the state of the CPU after an abort of type x */ - case 0x90: /* Branch through zero */ - { ARMword oldpsr = ARMul_GetCPSR(state) ; - ARMul_SetCPSR(state, (oldpsr & 0xffffffc0) | 0x13) ; - ARMul_SetSPSR(state, SVC32MODE, oldpsr) ; - state->Reg[14] = 0; - goto TidyCommon; - } - - case 0x98: /* Error */ - { ARMword errorp = state->Reg[0], - regp = state->Reg[1]; - unsigned i; - ARMword errorpsr = ARMul_ReadWord(state, regp + 16*4); - for (i = 0; i < 15; i++) - ARMul_SetReg(state,errorpsr,i,ARMul_ReadWord(state, regp + i*4L)) ; - state->Reg[14] = ARMul_ReadWord(state, regp + 15*4L); - state->Reg[10] = errorp; - ARMul_SetSPSR(state,state->Mode,errorpsr) ; - OSptr->ErrorP = errorp; - goto TidyCommon; - } - - case 0x94: /* Data abort */ - { ARMword addr = state->Reg[14] - 8; - ARMword cpsr = ARMul_GetCPSR(state) ; - if (ARM26BITMODE) - addr = addr & 0x3fffffc ; - ARMul_SetCPSR(state,ARMul_GetSPSR(state,cpsr)) ; - UnwindDataAbort(state, addr); - if (addr >= FPESTART && addr < FPEEND) { /* in the FPE */ - ARMword sp, spsr ; - unsigned i ; - - sp = state->Reg[13] ; - state->Reg[13] += 64 ; /* fix the aborting mode sp */ - state->Reg[14] = ARMul_ReadWord(state,sp + 60) ; /* and its lr */ - spsr = ARMul_GetSPSR(state,state->Mode) ; - state->Mode = ARMul_SwitchMode(state, state->Mode, spsr); - for (i = 0 ; i < 15 ; i++) { - ARMul_SetReg(state,spsr,i,ARMul_ReadWord(state,sp)) ; - sp += 4 ; - } - ARMul_SetCPSR(state,cpsr) ; - state->Reg[14] = ARMul_ReadWord(state,sp) + 4 ; /* botch it */ - ARMul_SetSPSR(state,state->Mode,spsr) ; - } - else - ARMul_SetCPSR(state,cpsr) ; - - /* and fall through to correct r14 */ - } - case 0x95: /* Address Exception */ - state->Reg[14] -= 4; - case 0x91: /* Undefined instruction */ - case 0x92: /* SWI */ - case 0x93: /* Prefetch abort */ - case 0x96: /* IRQ */ - case 0x97: /* FIQ */ - state->Reg[14] -= 4; + case 0x90: /* Branch through zero */ + { + ARMword oldpsr = ARMul_GetCPSR (state); + ARMul_SetCPSR (state, (oldpsr & 0xffffffc0) | 0x13); + ARMul_SetSPSR (state, SVC32MODE, oldpsr); + state->Reg[14] = 0; + goto TidyCommon; + } + + case 0x98: /* Error */ + { + ARMword errorp = state->Reg[0], regp = state->Reg[1]; + unsigned i; + ARMword errorpsr = ARMul_ReadWord (state, regp + 16 * 4); + for (i = 0; i < 15; i++) + ARMul_SetReg (state, errorpsr, i, + ARMul_ReadWord (state, regp + i * 4L)); + state->Reg[14] = ARMul_ReadWord (state, regp + 15 * 4L); + state->Reg[10] = errorp; + ARMul_SetSPSR (state, state->Mode, errorpsr); + OSptr->ErrorP = errorp; + goto TidyCommon; + } + + case 0x94: /* Data abort */ + { + ARMword addr = state->Reg[14] - 8; + ARMword cpsr = ARMul_GetCPSR (state); + if (ARM26BITMODE) + addr = addr & 0x3fffffc; + ARMul_SetCPSR (state, ARMul_GetSPSR (state, cpsr)); + UnwindDataAbort (state, addr); + if (addr >= FPESTART && addr < FPEEND) + { /* in the FPE */ + ARMword sp, spsr; + unsigned i; + + sp = state->Reg[13]; + state->Reg[13] += 64; /* fix the aborting mode sp */ + state->Reg[14] = ARMul_ReadWord (state, sp + 60); /* and its lr */ + spsr = ARMul_GetSPSR (state, state->Mode); + state->Mode = ARMul_SwitchMode (state, state->Mode, spsr); + for (i = 0; i < 15; i++) + { + ARMul_SetReg (state, spsr, i, ARMul_ReadWord (state, sp)); + sp += 4; + } + ARMul_SetCPSR (state, cpsr); + state->Reg[14] = ARMul_ReadWord (state, sp) + 4; /* botch it */ + ARMul_SetSPSR (state, state->Mode, spsr); + } + else + ARMul_SetCPSR (state, cpsr); + + /* and fall through to correct r14 */ + } + case 0x95: /* Address Exception */ + state->Reg[14] -= 4; + case 0x91: /* Undefined instruction */ + case 0x92: /* SWI */ + case 0x93: /* Prefetch abort */ + case 0x96: /* IRQ */ + case 0x97: /* FIQ */ + state->Reg[14] -= 4; TidyCommon: - if (state->VectorCatch & (1 << (number - 0x90))) { - ARMul_SetR15(state, state->Reg[14] + 8) ; /* the 8 is the pipelining the the RDI will undo */ - ARMul_SetCPSR(state,ARMul_GetSPSR(state,ARMul_GetCPSR(state))) ; - if (number == 0x90) - state->EndCondition = 10 ; /* Branch through Zero Error */ - else - state->EndCondition = (unsigned)number - 0x8f; - state->Emulate = FALSE ; - } - else { - ARMword sp = state->Reg[13]; - ARMul_WriteWord(state, sp - 4, state->Reg[14]); - ARMul_WriteWord(state, sp - 8, state->Reg[12]); - ARMul_WriteWord(state, sp - 12, state->Reg[11]); - ARMul_WriteWord(state, sp - 16, state->Reg[10]); - state->Reg[13] = sp - 16; - state->Reg[11] = ADDRSOFHANDLERS + 8 * (number - 0x90); - } - return(TRUE); + if (state->VectorCatch & (1 << (number - 0x90))) + { + ARMul_SetR15 (state, state->Reg[14] + 8); /* the 8 is the pipelining the the RDI will undo */ + ARMul_SetCPSR (state, ARMul_GetSPSR (state, ARMul_GetCPSR (state))); + if (number == 0x90) + state->EndCondition = 10; /* Branch through Zero Error */ + else + state->EndCondition = (unsigned) number - 0x8f; + state->Emulate = FALSE; + } + else + { + ARMword sp = state->Reg[13]; + ARMul_WriteWord (state, sp - 4, state->Reg[14]); + ARMul_WriteWord (state, sp - 8, state->Reg[12]); + ARMul_WriteWord (state, sp - 12, state->Reg[11]); + ARMul_WriteWord (state, sp - 16, state->Reg[10]); + state->Reg[13] = sp - 16; + state->Reg[11] = ADDRSOFHANDLERS + 8 * (number - 0x90); + } + return (TRUE); /* SWI's 0x8x pass an abort of type x to the debugger if a handler returns */ - case 0x80: case 0x81: case 0x82: case 0x83: - case 0x84: case 0x85: case 0x86: case 0x87: case 0x88: - { ARMword sp = state->Reg[13]; - state->Reg[10] = ARMul_ReadWord(state, sp); - state->Reg[11] = ARMul_ReadWord(state, sp + 4); - state->Reg[12] = ARMul_ReadWord(state, sp + 8); - state->Reg[14] = ARMul_ReadWord(state, sp + 12); - state->Reg[13] = sp + 16; - ARMul_SetR15(state, state->Reg[14] + 8) ; /* the 8 is the pipelining the the RDI will undo */ - ARMul_SetCPSR(state,ARMul_GetSPSR(state,ARMul_GetCPSR(state))) ; - if (number == 0x80) - state->EndCondition = 10 ; /* Branch through Zero Error */ - else - state->EndCondition = (unsigned)number - 0x7f; - state->Emulate = FALSE ; - return(TRUE); - } - - default : - state->Emulate = FALSE ; - return(FALSE) ; + case 0x80: + case 0x81: + case 0x82: + case 0x83: + case 0x84: + case 0x85: + case 0x86: + case 0x87: + case 0x88: + { + ARMword sp = state->Reg[13]; + state->Reg[10] = ARMul_ReadWord (state, sp); + state->Reg[11] = ARMul_ReadWord (state, sp + 4); + state->Reg[12] = ARMul_ReadWord (state, sp + 8); + state->Reg[14] = ARMul_ReadWord (state, sp + 12); + state->Reg[13] = sp + 16; + ARMul_SetR15 (state, state->Reg[14] + 8); /* the 8 is the pipelining the the RDI will undo */ + ARMul_SetCPSR (state, ARMul_GetSPSR (state, ARMul_GetCPSR (state))); + if (number == 0x80) + state->EndCondition = 10; /* Branch through Zero Error */ + else + state->EndCondition = (unsigned) number - 0x7f; + state->Emulate = FALSE; + return (TRUE); + } + + default: + state->Emulate = FALSE; + return (FALSE); } #endif #endif - } -#endif /* CYGNUS LOCAL: #if 1 */ +} + +#endif /* CYGNUS LOCAL: #if 1 */ #ifndef NOOS #ifndef ASIM @@ -1091,10 +1144,10 @@ ARMul_OSHandleSWI (ARMul_State *state, ARMword number) * be ignored (so set state->Emulate to FALSE!). * \***************************************************************************/ -unsigned -ARMul_OSException (ARMul_State *state, ARMword vector, ARMword pc) -{ /* don't use this here */ - return(FALSE) ; +unsigned +ARMul_OSException (ARMul_State * state, ARMword vector, ARMword pc) +{ /* don't use this here */ + return (FALSE); } #endif @@ -1103,29 +1156,36 @@ ARMul_OSException (ARMul_State *state, ARMword vector, ARMword pc) * Unwind a data abort * \***************************************************************************/ -static void -UnwindDataAbort (ARMul_State *state, ARMword addr) +static void +UnwindDataAbort (ARMul_State * state, ARMword addr) { - ARMword instr = ARMul_ReadWord(state, addr); - ARMword rn = BITS(16, 19); - ARMword itype = BITS(24, 27); + ARMword instr = ARMul_ReadWord (state, addr); + ARMword rn = BITS (16, 19); + ARMword itype = BITS (24, 27); ARMword offset; - if (rn == 15) return; - if (itype == 8 || itype == 9) { - /* LDM or STM */ - unsigned long regs = BITS(0, 15); - offset = 0; - if (!BIT(21)) return; /* no wb */ - for (; regs != 0; offset++) - regs ^= (regs & -regs); - if (offset == 0) offset = 16; - } else if (itype == 12 || /* post-indexed CPDT */ - (itype == 13 && BIT(21))) { /* pre_indexed CPDT with WB */ - offset = BITS(0, 7); - } else + if (rn == 15) + return; + if (itype == 8 || itype == 9) + { + /* LDM or STM */ + unsigned long regs = BITS (0, 15); + offset = 0; + if (!BIT (21)) + return; /* no wb */ + for (; regs != 0; offset++) + regs ^= (regs & -regs); + if (offset == 0) + offset = 16; + } + else if (itype == 12 || /* post-indexed CPDT */ + (itype == 13 && BIT (21))) + { /* pre_indexed CPDT with WB */ + offset = BITS (0, 7); + } + else return; - if (BIT(23)) + if (BIT (23)) state->Reg[rn] -= offset * 4; else state->Reg[rn] += offset * 4; @@ -1135,13 +1195,14 @@ UnwindDataAbort (ARMul_State *state, ARMword addr) * Copy a string from the debuggee's memory to the host's * \***************************************************************************/ -static void -getstring (ARMul_State *state, ARMword from, char *to) +static void +getstring (ARMul_State * state, ARMword from, char *to) { - do + do { *to = (char) ARMul_ReadByte (state, from++); - } while (*to++ != '\0'); + } + while (*to++ != '\0'); } #endif /* NOOS */ |