您的位置:首页 > 运维架构

IAR EWARM __iar_program_start, __iar_data_init3, __iar_copy_init3, __iar_zero_init3

2015-06-22 18:47 417 查看
#include <stdint.h>

// The type of a pointer into the init table.
typedef void const * table_ptr_t;

// The type of an initialization routine. It takes a pointer to the start of
// its entry (after the function pointer) in the init table and returns a
// pointer to after its entry.
typedef table_ptr_t init_fun_t( table_ptr_t );

typedef struct
{
int32_t mOff;
} FAddr;

__no_init uint32_t __iar_SB @ r9;

uint32_t const * __iar_zero_init3( uint32_t const * p )
{
uint32_t size;
while ( ( size = *p++ ) != 0 )
{
uint32_t d = *p++;
uint32_t * dest;

if ( d & 1 )
{
d -= 1;
d += __iar_SB;
}

dest = (uint32_t*) d;

do
{
*dest++ = 0;
size -= 4;
}while ( size != 0 );
}
return p;
}

uint32_t const * __iar_copy_init3( uint32_t const * p )
{
uint32_t size;
while ( ( size = *p++ ) != 0 )
{
uint32_t const * src;
uint32_t d;
uint32_t * dest;

src = (uint32_t *) ( (char const *) p + *(int32_t *) p );
p++;

d = *p++;

if ( d & 1 )
{
d -= 1;
d += __iar_SB;
}

dest = (uint32_t *) d;

do
{
*dest++ = *src++;
size -= 4;
}while ( size != 0 );
}
return p;
}

#pragma section = "Region$$Table"
void __iar_data_init3( void )
{
FAddr const * pi = __section_begin("Region$$Table");
table_ptr_t pe = __section_end ("Region$$Table");
while ( pi != pe )
{
init_fun_t * fun = (init_fun_t *) ( (uint32_t) pi + pi->mOff );
++pi;
pi = fun( pi );
}
}


Mode_USR  EQU     0x10
Mode_FIQ  EQU     0x11
Mode_IRQ  EQU     0x12
Mode_SVC  EQU     0x13
Mode_ABT  EQU     0x17
Mode_UND  EQU     0x1B
Mode_SYS  EQU     0x1F ; available on ARM Arch 4 and later

I_Bit     EQU     0x80 ; when I bit is set, IRQ is disabled
F_Bit     EQU     0x40 ; when F bit is set, FIQ is disabled

__iar_program_start
MSR     CPSR_c, #Mode_SYS|F_Bit|I_Bit
ldr     sp,=SFE(CSTACK)     ; End of CSTACK(user)
BL      __iar_data_init3
BL      main
B       .
内容来自用户分享和网络整理,不保证内容的准确性,如有侵权内容,可联系管理员处理 点击这里给我发消息
标签: