/*  armos.c -- ARMulator OS interface:  ARM6 Instruction Emulator.    Copyright (C) 1994 Advanced RISC Machines Ltd.     This program is free software; you can redistribute it and/or modify    it under the terms of the GNU General Public License as published by    the Free Software Foundation; either version 2 of the License, or    (at your option) any later version.     This program is distributed in the hope that it will be useful,    but WITHOUT ANY WARRANTY; without even the implied warranty of    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the    GNU General Public License for more details.     You should have received a copy of the GNU General Public License    along with this program; if not, write to the Free Software    Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. *//* This file contains a model of Demon, ARM Ltd's Debug Monitor,including all the SWI's required to support the C library. The code init is not really for the faint-hearted (especially the abort handlingcode), but it is a complete example. Defining NOOS will disable all thefun, and definign VAILDATE will define SWI 1 to enter SVC mode, and SWI0x11 to halt the emulator. *///chy 2005-09-12 disable below line//#include "config.h"#include "ansidecl.h"#include <time.h>#include <errno.h>#include <string.h>#include <fcntl.h>#ifndef O_RDONLY#define O_RDONLY 0#endif#ifndef O_WRONLY#define O_WRONLY 1#endif#ifndef O_RDWR#define O_RDWR   2#endif#ifndef O_BINARY#define O_BINARY 0#endif#ifdef __STDC__#define unlink(s) remove(s)#endif#ifdef HAVE_UNISTD_H#include <unistd.h>		/* For SEEK_SET etc */#endif#ifdef __riscosextern int _fisatty (FILE *);#define isatty_(f) _fisatty(f)#else#ifdef __ZTC__#include <io.h>#define isatty_(f) isatty((f)->_file)#else#ifdef macintosh#include <ioctl.h>#define isatty_(f) (~ioctl ((f)->_file, FIOINTERACTIVE, NULL))#else#define isatty_(f) isatty (fileno (f))#endif#endif#endif#include "armdefs.h"#include "armos.h"#include "armemu.h"#ifndef NOOS#ifndef VALIDATE/* #ifndef ASIM *///chy 2005-09-12 disable below line//#include "armfpe.h"/* #endif */#endif#endif/* For RDIError_BreakpointReached.  *///chy 2005-09-12 disable below line//#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);#define BUFFERSIZE 4096#ifndef FOPEN_MAX#define FOPEN_MAX 64#endif#define UNIQUETEMPS 256/***************************************************************************\*                          OS private Information                           *\***************************************************************************/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#define READOP 2#define WRITEOP 4#ifdef macintosh#define FIXCRLF(t,c) ((t & BINARY) ? \                      c : \                      ((c == '\n' || c == '\r' ) ? (c ^ 7) : c) \                     )#else#define FIXCRLF(t,c) c#endifstatic 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 */};/***************************************************************************\*            Time for the Operating System to initialise itself.            *\***************************************************************************/unsignedARMul_OSInit (ARMul_State * state){#if 0				// ndef 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);		}	}	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");/* #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);		}	}	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);}voidARMul_OSExit (ARMul_State * state){	if (state->OSptr)		free ((char *) state->OSptr);}/***************************************************************************\*                  Return the last Operating System Error.                  *\***************************************************************************/ARMwordARMul_OSLastErrorP (ARMul_State * state){	return ((struct OSblock *) state->OSptr)->ErrorP;}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 voidSWIWrite0 (ARMul_State * state, ARMword addr){	ARMword temp;	struct OSblock *OSptr = (struct OSblock *) state->OSptr;	while ((temp = ARMul_ReadByte (state, addr++)) != 0)		(void) fputc ((char) temp, stdout);	OSptr->ErrorNo = errno;}static voidWriteCommandLineTo (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);}static voidSWIopen (ARMul_State * state, ARMword name, ARMword SWIflags){	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++);	/* Now we need to decode the Demon open mode */	flags = translate_open_mode[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 */	}	else {		state->Reg[0] = (int) open (dummy, flags, 0666);		OSptr->ErrorNo = errno;	}}static voidSWIread (ARMul_State * state, ARMword f, ARMword ptr, ARMword len){	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%ulx bytes - out of memory\n",			 len);		return;	}