init.s

RC531

	AREA	init, CODE, READONLY, ALIGN=5
	ENTRY

	;IMPORT	Sys_init							; From MyLib
	;IMPORT	Sys_init2						; From MyLib
	IMPORT	Main

	B		Reset_Handler						; Reset here(0)
	B		Reset_Handler						; Undefined_Handler(1)
	B		Reset_Handler						; SWI_Handler(2)
	B		Reset_Handler						; Prefetch_Handler(3)
	B		Reset_Handler						; Abort_Handler(4)
	B		Reset_Handler						; Reserved vector(5)
	B		Reset_Handler						; IRQ_Handler(6)
	B		Reset_Handler						; FIQ interrupt vector(7)

Reset_Handler
	MOV	R0,#0xFFFFFFFF
	MCR	p15, 0, R0, c3, c0, 0			; Reset DAC
	MRC	p15, 0, R0, c2, c0, 0
	MOV	R0, R0
	SUB	PC, PC, #4
	MRC	p15, 0, R0, c1, c0, 0
	ORR	R0, R0, #0x1800					; Enable I-Cache
	MCR	p15, 0, R0, c1, c0, 0
	MRC	p15, 0, R0, c2, c0, 0
	MOV	R0, R0
	SUB	PC, PC, #4
	LDR	SP, =0xA0800000					; End of SDRAM(8M)
	LDR	R1, =0x981
	MOV	R0, #0x48000000
	STR	R1, [R0,#0]							; MDCNFG=0x981(8M SDRAM)
	LDR	R2, =0x0001c030
	STR	R2, [r0,#4]							; MDREFR=MEM_CLK_100M
	MOV	R3, #0
	STR	R3, [r0,#0x40]						; MDMRS=0
	LDR	R0, =0xA0700000
	MCR	p15, 0, R0, c2, c0, 0
	;MOV	R0,PC
	;TST	R0, #0x80000000
	;BEQ	SYS_2									; Jump if R0<0x80000000
	;BL		Sys_init
	;B		SYS_EXIT
	;SYS_2
	;BL		Sys_init2
	;SYS_EXIT

	B		Main

	END