提交 af58caab 编写于 作者: G gary.li.wenchao.4

Modified start_gcc.s for mini2440

git-svn-id: https://rt-thread.googlecode.com/svn/trunk@451 bbd45198-f89e-11dd-88c7-29a3b14d5316
上级 ca696234
...@@ -5,20 +5,15 @@ ...@@ -5,20 +5,15 @@
* *
* The license and distribution terms for this file may be * The license and distribution terms for this file may be
* found in the file LICENSE in this distribution or at * found in the file LICENSE in this distribution or at
* http://openlab.rt-thread.com/license/LICENSE * http:/*openlab.rt-thread.com/license/LICENSE
* *
* Change Logs: * Change Logs:
* Date Author Notes * Date Author Notes
* 2006-03-13 Bernard first version * 2006-03-13 Bernard first version
* 2006-10-05 Alsor.Z for s3c2410 initialize * 2006-10-05 Alsor.Z for s3c2440 initialize
* 2008-01-29 Yi.Qiu for QEMU emulator * 2008-01-29 Yi.Qiu for QEMU emulator
*/ */
/**
* @addtogroup S3C2410
*/
/*@{*/
#define CONFIG_STACKSIZE 512 #define CONFIG_STACKSIZE 512
#define S_FRAME_SIZE 72 #define S_FRAME_SIZE 72
...@@ -42,17 +37,55 @@ ...@@ -42,17 +37,55 @@
#define S_R1 4 #define S_R1 4
#define S_R0 0 #define S_R0 0
.equ USERMODE, 0x10 .equ USERMODE, 0x10
.equ FIQMODE, 0x11 .equ FIQMODE, 0x11
.equ IRQMODE, 0x12 .equ IRQMODE, 0x12
.equ SVCMODE, 0x13 .equ SVCMODE, 0x13
.equ ABORTMODE, 0x17 .equ ABORTMODE, 0x17
.equ UNDEFMODE, 0x1b .equ UNDEFMODE, 0x1b
.equ MODEMASK, 0x1f .equ MODEMASK, 0x1f
.equ NOINT, 0xc0 .equ NOINT, 0xc0
.equ RAM_BASE, 0x00000000 /*Start address of RAM */
.equ ROM_BASE, 0x30000000 /*Start address of Flash */
.equ MPLLCON, 0x4c000004 /*Mpll control register */
.equ M_MDIV, 0x20
.equ M_PDIV, 0x4
.equ M_SDIV, 0x2
.equ INTMSK, 0x4a000008
.equ INTSUBMSK, 0x4a00001c
.equ WTCON, 0x53000000
.equ LOCKTIME, 0x4c000000
.equ CLKDIVN, 0x4c000014 /*Clock divider control */
.equ GPHCON, 0x56000070 /*Port H control */
.equ GPHUP, 0x56000078 /*Pull-up control H */
.equ BWSCON, 0x48000000 /*Bus width & wait status */
.equ BANKCON0, 0x48000004 /*Boot ROM control */
.equ BANKCON1, 0x48000008 /*BANK1 control */
.equ BANKCON2, 0x4800000c /*BANK2 cControl */
.equ BANKCON3, 0x48000010 /*BANK3 control */
.equ BANKCON4, 0x48000014 /*BANK4 control */
.equ BANKCON5, 0x48000018 /*BANK5 control */
.equ BANKCON6, 0x4800001c /*BANK6 control */
.equ BANKCON7, 0x48000020 /*BANK7 control */
.equ REFRESH, 0x48000024 /*DRAM/SDRAM efresh */
.equ BANKSIZE, 0x48000028 /*Flexible Bank Size */
.equ MRSRB6, 0x4800002c /*Mode egister set for SDRAM*/
.equ MRSRB7, 0x48000030 /*Mode egister set for SDRAM*/
/*
*************************************************************************
*
* Jump vector table
*
*************************************************************************
*/
.section .init, "ax" .section .init, "ax"
.code 32 .code 32
.globl _start .globl _start
_start: _start:
b reset b reset
...@@ -72,7 +105,18 @@ _vector_resv: .word vector_resv ...@@ -72,7 +105,18 @@ _vector_resv: .word vector_resv
_vector_irq: .word vector_irq _vector_irq: .word vector_irq
_vector_fiq: .word vector_fiq _vector_fiq: .word vector_fiq
.balignl 16,0xdeadbeef .balignl 16,0xdeadbeef
/*
*************************************************************************
*
* Startup Code (reset vector)
* relocate armboot to ram
* setup stack
* jump to second stage
*
*************************************************************************
*/
_TEXT_BASE: _TEXT_BASE:
.word TEXT_BASE .word TEXT_BASE
...@@ -82,66 +126,47 @@ _TEXT_BASE: ...@@ -82,66 +126,47 @@ _TEXT_BASE:
* which are defined in linker script * which are defined in linker script
*/ */
.globl _rtthread_start .globl _rtthread_start
_rtthread_start:.word _start _rtthread_start:
.word _start
.globl _rtthread_end .globl _rtthread_end
_rtthread_end: .word _end _rtthread_end:
.word _end
/* /*
* rtthread bss start and end * rtthread bss start and end which are defined in linker script
* which are defined in linker script
*/ */
.globl _bss_start .globl _bss_start
_bss_start: .word __bss_start _bss_start:
.word __bss_start
.globl _bss_end .globl _bss_end
_bss_end: .word __bss_end _bss_end:
.word __bss_end
/* IRQ stack memory (calculated at run-time) */ /* IRQ stack memory (calculated at run-time) */
.globl IRQ_STACK_START .globl IRQ_STACK_START
IRQ_STACK_START:.word _irq_stack_start + 1024 IRQ_STACK_START:
.word _irq_stack_start + 1024
.globl FIQ_STACK_START .globl FIQ_STACK_START
FIQ_STACK_START:.word _fiq_stack_start + 1024 FIQ_STACK_START:
.word _fiq_stack_start + 1024
.globl UNDEFINED_STACK_START .globl UNDEFINED_STACK_START
UNDEFINED_STACK_START:.word _undefined_stack_start + CONFIG_STACKSIZE UNDEFINED_STACK_START:
.word _undefined_stack_start + CONFIG_STACKSIZE
.globl ABORT_STACK_START .globl ABORT_STACK_START
ABORT_STACK_START:.word _abort_stack_start + CONFIG_STACKSIZE ABORT_STACK_START:
.word _abort_stack_start + CONFIG_STACKSIZE
.globl _STACK_START .globl _STACK_START
_STACK_START:.word _svc_stack_start + 4096 _STACK_START:
.word _svc_stack_start + 4096
.equ RAM_BASE, 0x00000000 //Start address of RAM
.equ ROM_BASE, 0x30000000 //Start address of Flash /* ----------------------------------entry------------------------------*/
.equ INTMSK, 0x4a000008
.equ WTCON, 0x53000000
.equ INTSUBMSK, 0x4a00001c
.equ LOCKTIME, 0x4c000000
.equ MPLLCON, 0x4c000004
.equ M_MDIV, 0x20
.equ M_PDIV, 0x4
.equ M_SDIV, 0x2
.equ CLKDIVN, 0x4c000014 //Clock divider control
.equ GPHCON, 0x56000070 //Port H control
.equ GPHUP, 0x56000078 //Pull-up control H
.equ BWSCON, 0x48000000 //Bus width & wait status
.equ BANKCON0, 0x48000004 //Boot ROM control
.equ BANKCON1, 0x48000008 //BANK1 control
.equ BANKCON2, 0x4800000c //BANK2 cControl
.equ BANKCON3, 0x48000010 //BANK3 control
.equ BANKCON4, 0x48000014 //BANK4 control
.equ BANKCON5, 0x48000018 //BANK5 control
.equ BANKCON6, 0x4800001c //BANK6 control
.equ BANKCON7, 0x48000020 //BANK7 control
.equ REFRESH, 0x48000024 //DRAM/SDRAM efresh
.equ BANKSIZE, 0x48000028 //Flexible Bank Size
.equ MRSRB6, 0x4800002c //Mode egister set for SDRAM
.equ MRSRB7, 0x48000030 //Mode egister set for SDRAM
/* -----------------entry--------------- */
reset: reset:
/* watch dog disable */
ldr r0,=WTCON
ldr r1,=0x0
str r1,[r0]
/* set the cpu to SVC32 mode */ /* set the cpu to SVC32 mode */
mrs r0,cpsr mrs r0,cpsr
...@@ -149,10 +174,18 @@ reset: ...@@ -149,10 +174,18 @@ reset:
orr r0,r0,#SVCMODE orr r0,r0,#SVCMODE
msr cpsr,r0 msr cpsr,r0
/* watch dog disable */
ldr r0,=WTCON
ldr r1,=0x0
str r1,[r0]
/* mask all IRQs by clearing all bits in the INTMRs */ /* mask all IRQs by clearing all bits in the INTMRs */
ldr r1, =INTMSK ldr r1, =INTMSK
ldr r0, =0xffffffff ldr r0, =0xffffffff
str r0, [r1] str r0, [r1]
ldr r1, =INTSUBMSK
ldr r0, =0x7fff /*all sub interrupt disable */
str r0, [r1]
/* set interrupt vector */ /* set interrupt vector */
ldr r0, _load_address ldr r0, _load_address
...@@ -172,6 +205,7 @@ copy_loop: ...@@ -172,6 +205,7 @@ copy_loop:
mov r0,#0 /* get a zero */ mov r0,#0 /* get a zero */
ldr r1,=__bss_start /* bss start */ ldr r1,=__bss_start /* bss start */
ldr r2,=__bss_end /* bss end */ ldr r2,=__bss_end /* bss end */
bss_loop: bss_loop:
cmp r1,r2 /* check if data to clear */ cmp r1,r2 /* check if data to clear */
strlo r0,[r1],#4 /* clear 4 bytes */ strlo r0,[r1],#4 /* clear 4 bytes */
...@@ -180,6 +214,7 @@ bss_loop: ...@@ -180,6 +214,7 @@ bss_loop:
/* call C++ constructors of global objects */ /* call C++ constructors of global objects */
ldr r0, =__ctors_start__ ldr r0, =__ctors_start__
ldr r1, =__ctors_end__ ldr r1, =__ctors_end__
ctor_loop: ctor_loop:
cmp r0, r1 cmp r0, r1
beq ctor_end beq ctor_end
...@@ -189,16 +224,20 @@ ctor_loop: ...@@ -189,16 +224,20 @@ ctor_loop:
bx r2 bx r2
ldmfd sp!, {r0-r1} ldmfd sp!, {r0-r1}
b ctor_loop b ctor_loop
ctor_end: ctor_end:
/* start RT-Thread Kernel */ /* start RT-Thread Kernel */
ldr pc, _rtthread_startup ldr pc, _rtthread_startup
_rtthread_startup: .word rtthread_startup _rtthread_startup:
.word rtthread_startup
#if defined (__FLASH_BUILD__) #if defined (__FLASH_BUILD__)
_load_address: .word ROM_BASE + _TEXT_BASE _load_address:
.word ROM_BASE + _TEXT_BASE
#else #else
_load_address: .word RAM_BASE + _TEXT_BASE _load_address:
.word RAM_BASE + _TEXT_BASE
#endif #endif
/* /*
...@@ -213,13 +252,13 @@ _load_address: .word RAM_BASE + _TEXT_BASE ...@@ -213,13 +252,13 @@ _load_address: .word RAM_BASE + _TEXT_BASE
.align 5 .align 5
vector_undef: vector_undef:
sub sp, sp, #S_FRAME_SIZE sub sp, sp, #S_FRAME_SIZE
stmia sp, {r0 - r12} @ Calling r0-r12 stmia sp, {r0 - r12} /* Calling r0-r12 */
add r8, sp, #S_PC add r8, sp, #S_PC
stmdb r8, {sp, lr}^ @ Calling SP, LR stmdb r8, {sp, lr}^ /* Calling SP, LR */
str lr, [r8, #0] @ Save calling PC str lr, [r8, #0] /* Save calling PC */
mrs r6, spsr mrs r6, spsr
str r6, [r8, #4] @ Save CPSR str r6, [r8, #4] /* Save CPSR */
str r0, [r8, #8] @ Save OLD_R0 str r0, [r8, #8] /* Save OLD_R0 */
mov r0, sp mov r0, sp
bl rt_hw_trap_udef bl rt_hw_trap_udef
...@@ -235,13 +274,13 @@ vector_pabt: ...@@ -235,13 +274,13 @@ vector_pabt:
.align 5 .align 5
vector_dabt: vector_dabt:
sub sp, sp, #S_FRAME_SIZE sub sp, sp, #S_FRAME_SIZE
stmia sp, {r0 - r12} @ Calling r0-r12 stmia sp, {r0 - r12} /* Calling r0-r12 */
add r8, sp, #S_PC add r8, sp, #S_PC
stmdb r8, {sp, lr}^ @ Calling SP, LR stmdb r8, {sp, lr}^ /* Calling SP, LR */
str lr, [r8, #0] @ Save calling PC str lr, [r8, #0] /* Save calling PC */
mrs r6, spsr mrs r6, spsr
str r6, [r8, #4] @ Save CPSR str r6, [r8, #4] /* Save CPSR */
str r0, [r8, #8] @ Save OLD_R0 str r0, [r8, #8] /* Save OLD_R0 */
mov r0, sp mov r0, sp
bl rt_hw_trap_dabt bl rt_hw_trap_dabt
...@@ -278,74 +317,74 @@ vector_fiq: ...@@ -278,74 +317,74 @@ vector_fiq:
subs pc,lr,#4 subs pc,lr,#4
_interrupt_thread_switch: _interrupt_thread_switch:
mov r1, #0 @ clear rt_thread_switch_interrput_flag mov r1, #0 /* clear rt_thread_switch_interrput_flag*/
str r1, [r0] str r1, [r0]
ldmfd sp!, {r0-r12,lr}@ reload saved registers ldmfd sp!, {r0-r12,lr} /* reload saved registers */
stmfd sp!, {r0-r3} @ save r0-r3 stmfd sp!, {r0-r3} /* save r0-r3 */
mov r1, sp mov r1, sp
add sp, sp, #16 @ restore sp add sp, sp, #16 /* restore sp */
sub r2, lr, #4 @ save old task's pc to r2 sub r2, lr, #4 /* save old task's pc to r2 */
mrs r3, spsr @ disable interrupt mrs r3, spsr /* disable interrupt */
orr r0, r3, #NOINT orr r0, r3, #NOINT
msr spsr_c, r0 msr spsr_c, r0
ldr r0, =.+8 @ switch to interrupted task's stack ldr r0, =.+8 /* switch to interrupted task's stack*/
movs pc, r0 movs pc, r0
stmfd sp!, {r2} @ push old task's pc stmfd sp!, {r2} /* push old task's pc */
stmfd sp!, {r4-r12,lr}@ push old task's lr,r12-r4 stmfd sp!, {r4-r12,lr} /* push old task's lr,r12-r4 */
mov r4, r1 @ Special optimised code below mov r4, r1 /* Special optimised code below */
mov r5, r3 mov r5, r3
ldmfd r4!, {r0-r3} ldmfd r4!, {r0-r3}
stmfd sp!, {r0-r3} @ push old task's r3-r0 stmfd sp!, {r0-r3} /* push old task's r3-r0 */
stmfd sp!, {r5} @ push old task's psr stmfd sp!, {r5} /* push old task's psr */
mrs r4, spsr mrs r4, spsr
stmfd sp!, {r4} @ push old task's spsr stmfd sp!, {r4} /* push old task's spsr */
ldr r4, =rt_interrupt_from_thread ldr r4, =rt_interrupt_from_thread
ldr r5, [r4] ldr r5, [r4]
str sp, [r5] @ store sp in preempted tasks's TCB str sp, [r5] /* store sp in preempted tasks's TCB*/
ldr r6, =rt_interrupt_to_thread ldr r6, =rt_interrupt_to_thread
ldr r6, [r6] ldr r6, [r6]
ldr sp, [r6] @ get new task's stack pointer ldr sp, [r6] /* get new task's stack pointer */
ldmfd sp!, {r4} @ pop new task's spsr ldmfd sp!, {r4} /* pop new task's spsr */
msr SPSR_cxsf, r4 msr SPSR_cxsf, r4
ldmfd sp!, {r4} @ pop new task's psr ldmfd sp!, {r4} /* pop new task's psr */
msr CPSR_cxsf, r4 msr CPSR_cxsf, r4
ldmfd sp!, {r0-r12,lr,pc} @ pop new task's r0-r12,lr & pc ldmfd sp!, {r0-r12,lr,pc} /* pop new task's r0-r12,lr & pc */
stack_setup: stack_setup:
mrs r0, cpsr mrs r0, cpsr
bic r0, r0, #MODEMASK bic r0, r0, #MODEMASK
orr r1, r0, #UNDEFMODE|NOINT orr r1, r0, #UNDEFMODE|NOINT
msr cpsr_cxsf, r1 @ undef mode msr cpsr_cxsf, r1 /* undef mode */
ldr sp, UNDEFINED_STACK_START ldr sp, UNDEFINED_STACK_START
orr r1,r0,#ABORTMODE|NOINT orr r1,r0,#ABORTMODE|NOINT
msr cpsr_cxsf,r1 @ abort mode msr cpsr_cxsf,r1 /* abort mode */
ldr sp, ABORT_STACK_START ldr sp, ABORT_STACK_START
orr r1,r0,#IRQMODE|NOINT orr r1,r0,#IRQMODE|NOINT
msr cpsr_cxsf,r1 @ IRQ mode msr cpsr_cxsf,r1 /* IRQ mode */
ldr sp, IRQ_STACK_START ldr sp, IRQ_STACK_START
orr r1,r0,#FIQMODE|NOINT orr r1,r0,#FIQMODE|NOINT
msr cpsr_cxsf,r1 @ FIQ mode msr cpsr_cxsf,r1 /* FIQ mode */
ldr sp, FIQ_STACK_START ldr sp, FIQ_STACK_START
bic r0,r0,#MODEMASK bic r0,r0,#MODEMASK
orr r1,r0,#SVCMODE|NOINT orr r1,r0,#SVCMODE|NOINT
msr cpsr_cxsf,r1 @ SVC mode msr cpsr_cxsf,r1 /* SVC mode */
ldr sp, _STACK_START ldr sp, _STACK_START
/* USER mode is not initialized. */ /* USER mode is not initialized. */
mov pc,lr @ The LR register may be not valid for the mode changes. mov pc,lr /* The LR register may be not valid for the mode changes.*/
/*@}*/ /*/*}*/
Markdown is supported
0% .
You are about to add 0 people to the discussion. Proceed with caution.
先完成此消息的编辑!
想要评论请 注册