124 lines
4.0 KiB
C
124 lines
4.0 KiB
C
#include "arm.h"
|
|
#include <_ansi.h>
|
|
|
|
/* SWI numbers for RDP (Demon) monitor. */
|
|
#define SWI_WriteC 0x0
|
|
#define SWI_Write0 0x2
|
|
#define SWI_ReadC 0x4
|
|
#define SWI_CLI 0x5
|
|
#define SWI_GetEnv 0x10
|
|
#define SWI_Exit 0x11
|
|
#define SWI_EnterOS 0x16
|
|
|
|
#define SWI_GetErrno 0x60
|
|
#define SWI_Clock 0x61
|
|
#define SWI_Time 0x63
|
|
#define SWI_Remove 0x64
|
|
#define SWI_Rename 0x65
|
|
#define SWI_Open 0x66
|
|
|
|
#define SWI_Close 0x68
|
|
#define SWI_Write 0x69
|
|
#define SWI_Read 0x6a
|
|
#define SWI_Seek 0x6b
|
|
#define SWI_Flen 0x6c
|
|
|
|
#define SWI_IsTTY 0x6e
|
|
#define SWI_TmpNam 0x6f
|
|
#define SWI_InstallHandler 0x70
|
|
#define SWI_GenerateError 0x71
|
|
|
|
|
|
/* Now the SWI numbers and reason codes for RDI (Angel) monitors. */
|
|
#if defined (SEMIHOST_V2) && defined (SEMIHOST_V2_MIXED_MODE)
|
|
#define AngelSWI_ARM 0xF000 /* HLT A32. */
|
|
#ifdef __thumb__
|
|
#define AngelSWI 0x3C /* HLT T32. */
|
|
#else /* __thumb__. */
|
|
#define AngelSWI AngelSWI_ARM
|
|
#endif /* __thumb__. */
|
|
#else /* SEMIHOST_V2. */
|
|
#define AngelSWI_ARM 0x123456 /* SVC A32. */
|
|
#ifdef __thumb__
|
|
#define AngelSWI 0xAB /* SVC T32. */
|
|
#else /* __thumb__. */
|
|
#define AngelSWI AngelSWI_ARM
|
|
#endif /* __thumb__. */
|
|
#endif /* SEMIHOST_V2. */
|
|
|
|
/* For thumb only architectures use the BKPT instruction instead of SWI. */
|
|
#ifdef THUMB_VXM
|
|
#define AngelSWIInsn "bkpt"
|
|
#define AngelSWIAsm bkpt
|
|
#else
|
|
#define AngelSWIInsn "swi"
|
|
#define AngelSWIAsm swi
|
|
#endif
|
|
|
|
/* The reason codes: */
|
|
#define AngelSWI_Reason_Open 0x01
|
|
#define AngelSWI_Reason_Close 0x02
|
|
#define AngelSWI_Reason_WriteC 0x03
|
|
#define AngelSWI_Reason_Write0 0x04
|
|
#define AngelSWI_Reason_Write 0x05
|
|
#define AngelSWI_Reason_Read 0x06
|
|
#define AngelSWI_Reason_ReadC 0x07
|
|
#define AngelSWI_Reason_IsError 0x08
|
|
#define AngelSWI_Reason_IsTTY 0x09
|
|
#define AngelSWI_Reason_Seek 0x0A
|
|
#define AngelSWI_Reason_FLen 0x0C
|
|
#define AngelSWI_Reason_TmpNam 0x0D
|
|
#define AngelSWI_Reason_Remove 0x0E
|
|
#define AngelSWI_Reason_Rename 0x0F
|
|
#define AngelSWI_Reason_Clock 0x10
|
|
#define AngelSWI_Reason_Time 0x11
|
|
#define AngelSWI_Reason_System 0x12
|
|
#define AngelSWI_Reason_Errno 0x13
|
|
#define AngelSWI_Reason_GetCmdLine 0x15
|
|
#define AngelSWI_Reason_HeapInfo 0x16
|
|
#define AngelSWI_Reason_EnterSVC 0x17
|
|
#define AngelSWI_Reason_ReportException 0x18
|
|
#define AngelSWI_Reason_ReportExceptionExtended 0x20
|
|
#define AngelSWI_Reason_Elapsed 0x30
|
|
#define AngelSWI_Reason_TickFreq 0x31
|
|
#define ADP_Stopped_ApplicationExit ((2 << 16) + 38)
|
|
#define ADP_Stopped_RunTimeError ((2 << 16) + 35)
|
|
|
|
/* Semihosting feature magic numbers. */
|
|
#define NUM_SHFB_MAGIC 4
|
|
#define SHFB_MAGIC_0 0x53
|
|
#define SHFB_MAGIC_1 0x48
|
|
#define SHFB_MAGIC_2 0x46
|
|
#define SHFB_MAGIC_3 0x42
|
|
|
|
/* Semihosting extensions. */
|
|
#define SH_EXT_EXIT_EXTENDED_BITNUM 0x0
|
|
#define SH_EXT_STDOUT_STDERR_BITNUM 0x1
|
|
|
|
#if !defined (__ASSEMBLER__)
|
|
extern int _get_semihosting_exts (char*, int, int);
|
|
extern int _has_ext_exit_extended (void);
|
|
extern int _has_ext_stdout_stderr (void);
|
|
#endif
|
|
|
|
#if defined(ARM_RDI_MONITOR) && !defined(__ASSEMBLER__)
|
|
|
|
static inline int
|
|
do_AngelSWI (int reason, void * arg)
|
|
{
|
|
int value;
|
|
asm volatile ("mov r0, %1; mov r1, %2; " AngelSWIInsn " %a3; mov %0, r0"
|
|
: "=r" (value) /* Outputs */
|
|
: "r" (reason), "r" (arg), "i" (AngelSWI) /* Inputs */
|
|
: "r0", "r1", "r2", "r3", "ip", "lr", "memory", "cc"
|
|
/* Clobbers r0 and r1, and lr if in supervisor mode */);
|
|
/* Accordingly to page 13-77 of ARM DUI 0040D other registers
|
|
can also be clobbered. Some memory positions may also be
|
|
changed by a system call, so they should not be kept in
|
|
registers. Note: we are assuming the manual is right and
|
|
Angel is respecting the APCS. */
|
|
return value;
|
|
}
|
|
|
|
#endif
|