AREA	Init, CODE, READONLY
	ENTRY

	IMPORT	main

	;IMPORT  Time0_irq

;中斷向量表
Vectors
        LDR     PC, RESET1
        LDR     PC, UndefinedAddr
        LDR     PC, SWI_Addr
        LDR     PC, PrefetchAddr
        LDR     PC, DataAbortAddr
        LDR     PC, DataAbortAddr
        LDR     PC, [PC, #-0xF20] ;IRQ_Addr ;
        LDR     PC, FIQ_Addr

RESET1              DCD		Reset_Handler
UndefinedAddr       DCD     Undefined
SWI_Addr            DCD     SoftwareInterrupt
PrefetchAddr        DCD     PrefetchAbort
DataAbortAddr       DCD     DataAbort
nouse               DCD     0
FIQ_Addr            DCD     FIQ_Handler
  ;IRQ_Addr			DCD		Time0_irq
Reset_Handler
	;BL	CODECOPY		;把FALSH的程序拷貝到RAM里運行
	BL  InitStack		;初始化堆棧后進入管理模式	
	LDR R0, =0xFFE00000
	LDR R1, =0x1002529  ;MMU FLASH ADDR AT 0x1000000
	STR R1, [R0]
	MOV R1, #1
	STR R1, [R0,#0x20]  ;REMAP	
	B		main

CODECOPY
	LDR R1, =0x300000		;RAM START ADDR
	LDR R2, =0x0			;FLASH START ADDR
	MOV R0,	#0x20000		;COPY 128K FORM FLASH TO RAM
LOOP
	LDR R3, [R2],#4
	STR R3, [R1],#4
	CMP R2, R0
	BCC LOOP			;copy
	MOV PC,LR


;未定義指令

Undefined
        b       Undefined

;取指令中止
PrefetchAbort
        b       PrefetchAbort

;取數據中止
DataAbort
        b       DataAbort
SoftwareInterrupt
		B       SoftwareInterrupt

;快速中斷
FIQ_Handler
        STMFD   SP!, {R0-R3, LR}
        ;BL      FIQ_Exception
        LDMFD   SP!, {R0-R3, LR}
        SUBS    PC,  LR,  #4
        
InitStack    
        MOV     R0, LR
;設置中斷模式堆棧
        MSR     CPSR_c, #0xd2
        LDR     SP, =0x40000			;設置在RAM的最高位置
;設置快速中斷模式堆棧
        MSR     CPSR_c, #0xd1
        LDR     SP, =(0x40000-0x400)
;設置中止模式堆棧
        MSR     CPSR_c, #0xd7
        LDR     SP, =(0x40000-0x400)
;設置未定義模式堆棧
        MSR     CPSR_c, #0xdb
        LDR     SP, =(0x40000-0x400)
;設置系統模式堆棧
        MSR     CPSR_c, #0x1f
        LDR     SP, =(0x40000-0x400)
;設置管理模式堆棧
        MSR     CPSR_c, #0x13
        LDR     SP, =(0x40000-0x400)    	
        MOV     PC, R0

    END