#include "swi.h"
|
#include "swi.h"
|
|
|
/* ANSI concatenation macros. */
|
/* ANSI concatenation macros. */
|
#define CONCAT(a, b) CONCAT2(a, b)
|
#define CONCAT(a, b) CONCAT2(a, b)
|
#define CONCAT2(a, b) a ## b
|
#define CONCAT2(a, b) a ## b
|
|
|
#ifdef __USER_LABEL_PREFIX__
|
#ifdef __USER_LABEL_PREFIX__
|
#define FUNCTION( name ) CONCAT (__USER_LABEL_PREFIX__, name)
|
#define FUNCTION( name ) CONCAT (__USER_LABEL_PREFIX__, name)
|
#else
|
#else
|
#error __USER_LABEL_PREFIX is not defined
|
#error __USER_LABEL_PREFIX is not defined
|
#endif
|
#endif
|
|
|
/* .text is used instead of .section .text so it works with arm-aout too. */
|
/* .text is used instead of .section .text so it works with arm-aout too. */
|
.text
|
.text
|
.code 32
|
.code 32
|
.align 0
|
.align 0
|
|
|
.global _mainCRTStartup
|
.global _mainCRTStartup
|
.global _start
|
.global _start
|
.global start
|
.global start
|
start:
|
start:
|
_start:
|
_start:
|
_mainCRTStartup:
|
_mainCRTStartup:
|
|
|
/* Start by setting up a stack */
|
/* Start by setting up a stack */
|
#ifdef ARM_RDP_MONITOR
|
#ifdef ARM_RDP_MONITOR
|
/* Issue Demon SWI to read stack info */
|
/* Issue Demon SWI to read stack info */
|
swi SWI_GetEnv /* Returns command line in r0 */
|
swi SWI_GetEnv /* Returns command line in r0 */
|
mov sp,r1 /* and the highest memory address in r1 */
|
mov sp,r1 /* and the highest memory address in r1 */
|
ldr sl, .LC2 /* stack limit is at end of data */
|
ldr sl, .LC2 /* stack limit is at end of data */
|
add sl, sl, #256 /* allow slop for stack overflow handling */
|
add sl, sl, #256 /* allow slop for stack overflow handling */
|
/* and small frames */
|
/* and small frames */
|
#else
|
#else
|
#ifdef ARM_RDI_MONITOR
|
#ifdef ARM_RDI_MONITOR
|
/* Issue Angel SWI to read stack info */
|
/* Issue Angel SWI to read stack info */
|
mov r0, #AngelSWI_Reason_HeapInfo
|
mov r0, #AngelSWI_Reason_HeapInfo
|
adr r1, .LC0 /* point at ptr to 4 words to receive data */
|
adr r1, .LC0 /* point at ptr to 4 words to receive data */
|
swi AngelSWI_ARM /* We are always in ARM mode for startup */
|
swi AngelSWI_ARM /* We are always in ARM mode for startup */
|
ldr r0, .LC0 /* point at values read */
|
ldr r0, .LC0 /* point at values read */
|
ldr sp, [r0, #8]
|
ldr sp, [r0, #8]
|
ldr sl, [r0, #12]
|
ldr sl, [r0, #12]
|
add sl, sl, #256 /* allow slop for stack overflow handling */
|
add sl, sl, #256 /* allow slop for stack overflow handling */
|
/* and small frames */
|
/* and small frames */
|
#else
|
#else
|
/* Set up the stack pointer to a fixed value */
|
/* Set up the stack pointer to a fixed value */
|
ldr r3, .LC0
|
ldr r3, .LC0
|
mov sp, r3
|
mov sp, r3
|
/* Setup a default stack-limit in-case the code has been
|
/* Setup a default stack-limit in-case the code has been
|
compiled with "-mapcs-stack-check". Hard-wiring this value
|
compiled with "-mapcs-stack-check". Hard-wiring this value
|
is not ideal, since there is currently no support for
|
is not ideal, since there is currently no support for
|
checking that the heap and stack have not collided, or that
|
checking that the heap and stack have not collided, or that
|
this default 64k is enough for the program being executed.
|
this default 64k is enough for the program being executed.
|
However, it ensures that this simple crt0 world will not
|
However, it ensures that this simple crt0 world will not
|
immediately cause an overflow event: */
|
immediately cause an overflow event: */
|
sub sl, sp, #64 << 10 /* Still assumes 256bytes below sl */
|
sub sl, sp, #64 << 10 /* Still assumes 256bytes below sl */
|
#endif
|
#endif
|
#endif
|
#endif
|
mov a2, #0 /* Second arg: fill value */
|
mov a2, #0 /* Second arg: fill value */
|
mov fp, a2 /* Null frame pointer */
|
mov fp, a2 /* Null frame pointer */
|
mov r7, a2 /* Null frame pointer for Thumb */
|
mov r7, a2 /* Null frame pointer for Thumb */
|
|
|
ldr a1, .LC1 /* First arg: start of memory block */
|
ldr a1, .LC1 /* First arg: start of memory block */
|
ldr a3, .LC2
|
ldr a3, .LC2
|
sub a3, a3, a1 /* Third arg: length of block */
|
sub a3, a3, a1 /* Third arg: length of block */
|
|
|
|
|
#ifdef __thumb__ /* Enter Thumb mode.... */
|
#ifdef __thumb__ /* Enter Thumb mode.... */
|
|
|
add a4, pc, #1 /* Get the address of the Thumb block */
|
add a4, pc, #1 /* Get the address of the Thumb block */
|
bx a4 /* Go there and start Thumb decoding */
|
bx a4 /* Go there and start Thumb decoding */
|
|
|
.code 16
|
.code 16
|
.global __change_mode
|
.global __change_mode
|
.thumb_func
|
.thumb_func
|
__change_mode:
|
__change_mode:
|
#endif
|
#endif
|
|
|
bl FUNCTION (memset)
|
bl FUNCTION (memset)
|
#if !defined (ARM_RDP_MONITOR) && !defined (ARM_RDI_MONITOR)
|
#if !defined (ARM_RDP_MONITOR) && !defined (ARM_RDI_MONITOR)
|
mov r0, #0 /* no arguments */
|
mov r0, #0 /* no arguments */
|
mov r1, #0 /* no argv either */
|
mov r1, #0 /* no argv either */
|
#else
|
#else
|
/* Need to set up standard file handles */
|
/* Need to set up standard file handles */
|
bl FUNCTION (initialise_monitor_handles)
|
bl FUNCTION (initialise_monitor_handles)
|
|
|
#ifdef ARM_RDP_MONITOR
|
#ifdef ARM_RDP_MONITOR
|
swi SWI_GetEnv /* sets r0 to point to the command line */
|
swi SWI_GetEnv /* sets r0 to point to the command line */
|
mov r1, r0
|
mov r1, r0
|
#else
|
#else
|
mov r0, #AngelSWI_Reason_GetCmdLine
|
mov r0, #AngelSWI_Reason_GetCmdLine
|
adr r1, .LC30 /* Space for command line */
|
adr r1, .LC30 /* Space for command line */
|
swi AngelSWI
|
swi AngelSWI
|
ldr r1, .LC30
|
ldr r1, .LC30
|
#endif
|
#endif
|
/* Parse string at r1 */
|
/* Parse string at r1 */
|
mov r0, #0 /* count of arguments so far */
|
mov r0, #0 /* count of arguments so far */
|
.LC10:
|
.LC10:
|
/* Skip leading blanks */
|
/* Skip leading blanks */
|
#ifdef __thumb__
|
#ifdef __thumb__
|
ldrb r3, [r1]
|
ldrb r3, [r1]
|
add r1, #1
|
add r1, #1
|
#else
|
#else
|
ldrb r3, [r1], #1
|
ldrb r3, [r1], #1
|
#endif
|
#endif
|
cmp r3, #0
|
cmp r3, #0
|
beq .LC12
|
beq .LC12
|
cmp r3, #' '
|
cmp r3, #' '
|
beq .LC10
|
beq .LC10
|
|
|
/* See whether we are scanning a string */
|
/* See whether we are scanning a string */
|
cmp r3, #'"'
|
cmp r3, #'"'
|
#ifdef __thumb__
|
#ifdef __thumb__
|
beq .LC20
|
beq .LC20
|
cmp r3, #'\''
|
cmp r3, #'\''
|
bne .LC21
|
bne .LC21
|
.LC20:
|
.LC20:
|
mov r2, r3
|
mov r2, r3
|
b .LC22
|
b .LC22
|
|
|
.LC21:
|
.LC21:
|
mov r2, #' ' /* terminator type */
|
mov r2, #' ' /* terminator type */
|
sub r1, r1, #1 /* adjust back to point at start char */
|
sub r1, r1, #1 /* adjust back to point at start char */
|
.LC22:
|
.LC22:
|
#else
|
#else
|
cmpne r3, #'\''
|
cmpne r3, #'\''
|
moveq r2, r3
|
moveq r2, r3
|
movne r2, #' ' /* terminator type */
|
movne r2, #' ' /* terminator type */
|
subne r1, r1, #1 /* adjust back to point at start char */
|
subne r1, r1, #1 /* adjust back to point at start char */
|
#endif
|
#endif
|
|
|
/* Stack a pointer to the current argument */
|
/* Stack a pointer to the current argument */
|
#ifdef __thumb__
|
#ifdef __thumb__
|
push {r1}
|
push {r1}
|
#else
|
#else
|
stmfd sp!, {r1}
|
stmfd sp!, {r1}
|
#endif
|
#endif
|
add r0, r0, #1
|
add r0, r0, #1
|
.LC11:
|
.LC11:
|
#ifdef __thumb__
|
#ifdef __thumb__
|
ldrb r3, [r1]
|
ldrb r3, [r1]
|
add r1, #1
|
add r1, #1
|
#else
|
#else
|
ldrb r3, [r1], #1
|
ldrb r3, [r1], #1
|
#endif
|
#endif
|
cmp r3, #0
|
cmp r3, #0
|
beq .LC12
|
beq .LC12
|
cmp r2, r3 /* reached terminator? */
|
cmp r2, r3 /* reached terminator? */
|
bne .LC11
|
bne .LC11
|
mov r2, #0
|
mov r2, #0
|
sub r3, r1, #1
|
sub r3, r1, #1
|
strb r2, [r3] /* terminate the arg string */
|
strb r2, [r3] /* terminate the arg string */
|
b .LC10
|
b .LC10
|
|
|
.LC12:
|
.LC12:
|
mov r1, sp /* point at stacked arg pointers */
|
mov r1, sp /* point at stacked arg pointers */
|
/* We've now got the stacked args in order reverse the */
|
/* We've now got the stacked args in order reverse the */
|
#ifdef __thumb__
|
#ifdef __thumb__
|
mov r2, r0
|
mov r2, r0
|
lsl r2, #2
|
lsl r2, #2
|
add r2, sp
|
add r2, sp
|
mov r3, sp
|
mov r3, sp
|
.LC15: cmp r2, r3
|
.LC15: cmp r2, r3
|
bls .LC14
|
bls .LC14
|
sub r2, #4
|
sub r2, #4
|
ldr r4, [r2]
|
ldr r4, [r2]
|
ldr r5, [r3]
|
ldr r5, [r3]
|
str r5, [r2]
|
str r5, [r2]
|
str r4, [r3]
|
str r4, [r3]
|
add r3, #4
|
add r3, #4
|
b .LC15
|
b .LC15
|
.LC14:
|
.LC14:
|
#else
|
#else
|
add r2, sp, r0, LSL #2 /* End of args */
|
add r2, sp, r0, LSL #2 /* End of args */
|
mov r3, sp /* Start of args */
|
mov r3, sp /* Start of args */
|
.LC13: cmp r2, r3
|
.LC13: cmp r2, r3
|
ldrhi r4,[r2, #-4] /* Reverse ends of list */
|
ldrhi r4,[r2, #-4] /* Reverse ends of list */
|
ldrhi r5, [r3]
|
ldrhi r5, [r3]
|
strhi r5, [r2, #-4]!
|
strhi r5, [r2, #-4]!
|
strhi r4, [r3], #4
|
strhi r4, [r3], #4
|
bhi .LC13
|
bhi .LC13
|
#endif
|
#endif
|
|
|
#endif
|
#endif
|
|
|
#ifdef __USES_INITFINI__
|
#ifdef __USES_INITFINI__
|
/* Some arm/elf targets use the .init and .fini sections
|
/* Some arm/elf targets use the .init and .fini sections
|
to create constructors and destructors, and for these
|
to create constructors and destructors, and for these
|
targets we need to call the _init function and arrange
|
targets we need to call the _init function and arrange
|
for _fini to be called at program exit. */
|
for _fini to be called at program exit. */
|
mov r4, r0
|
mov r4, r0
|
mov r5, r1
|
mov r5, r1
|
ldr r0, .Lfini
|
ldr r0, .Lfini
|
bl FUNCTION (atexit)
|
bl FUNCTION (atexit)
|
bl FUNCTION (_init)
|
bl FUNCTION (_init)
|
mov r0, r4
|
mov r0, r4
|
mov r1, r5
|
mov r1, r5
|
#endif
|
#endif
|
bl FUNCTION (main)
|
bl FUNCTION (main)
|
|
|
bl FUNCTION (exit) /* Should not return. */
|
bl FUNCTION (exit) /* Should not return. */
|
|
|
#ifdef __thumb__
|
#ifdef __thumb__
|
/* Come out of Thumb mode. This code should be redundant. */
|
/* Come out of Thumb mode. This code should be redundant. */
|
|
|
mov a4, pc
|
mov a4, pc
|
bx a4
|
bx a4
|
|
|
.code 32
|
.code 32
|
.global change_back
|
.global change_back
|
change_back:
|
change_back:
|
/* Halt the execution. This code should never be executed. */
|
/* Halt the execution. This code should never be executed. */
|
/* With no debug monitor, this probably aborts (eventually).
|
/* With no debug monitor, this probably aborts (eventually).
|
With a Demon debug monitor, this halts cleanly.
|
With a Demon debug monitor, this halts cleanly.
|
With an Angel debug monitor, this will report 'Unknown SWI'. */
|
With an Angel debug monitor, this will report 'Unknown SWI'. */
|
swi SWI_Exit
|
swi SWI_Exit
|
#endif
|
#endif
|
|
|
/* For Thumb, constants must be after the code since only
|
/* For Thumb, constants must be after the code since only
|
positive offsets are supported for PC relative addresses. */
|
positive offsets are supported for PC relative addresses. */
|
|
|
.align 0
|
.align 0
|
.LC0:
|
.LC0:
|
#ifdef ARM_RDI_MONITOR
|
#ifdef ARM_RDI_MONITOR
|
.word HeapBase
|
.word HeapBase
|
#else
|
#else
|
#ifndef ARM_RDP_MONITOR
|
#ifndef ARM_RDP_MONITOR
|
#ifdef __pe__
|
#ifdef __pe__
|
.word 0x800000
|
.word 0x800000
|
#else
|
#else
|
/* .word 0x80000 */ /* Top of RAM on the PIE board. */
|
/* .word 0x80000 */ /* Top of RAM on the PIE board. */
|
#endif
|
#endif
|
#endif
|
#endif
|
#endif
|
#endif
|
.LC1:
|
.LC1:
|
.word __bss_start__
|
.word __bss_start__
|
.LC2:
|
.LC2:
|
.word __bss_end__
|
.word __bss_end__
|
#ifdef __USES_INITFINI__
|
#ifdef __USES_INITFINI__
|
.Lfini:
|
.Lfini:
|
.word FUNCTION(_fini)
|
.word FUNCTION(_fini)
|
#endif
|
#endif
|
#ifdef ARM_RDI_MONITOR
|
#ifdef ARM_RDI_MONITOR
|
.LC30:
|
.LC30:
|
.word CommandLine
|
.word CommandLine
|
.word 255
|
.word 255
|
|
|
/* Workspace for Angel calls. */
|
/* Workspace for Angel calls. */
|
.data
|
.data
|
/* Data returned by monitor SWI. */
|
/* Data returned by monitor SWI. */
|
.global __stack_base__
|
.global __stack_base__
|
HeapBase: .word 0
|
HeapBase: .word 0
|
HeapLimit: .word 0
|
HeapLimit: .word 0
|
__stack_base__: .word 0
|
__stack_base__: .word 0
|
StackLimit: .word 0
|
StackLimit: .word 0
|
CommandLine: .space 256,0 /* Maximum length of 255 chars handled. */
|
CommandLine: .space 256,0 /* Maximum length of 255 chars handled. */
|
#endif
|
#endif
|
|
|
#ifdef __pe__
|
#ifdef __pe__
|
.section .idata$3
|
.section .idata$3
|
.long 0,0,0,0,0,0,0,0
|
.long 0,0,0,0,0,0,0,0
|
#endif
|
#endif
|
|
|
|
|
