;--------------------------------------------------------
; Description	: This is startup file for calmRISC16
; History	:
;			2001.3.29 change sp initialization
;			2000.11.24 ld ...$$SIZE  at A-register
;			2000.3.7   change interrupt number => 1fh	
;			1999.11.8  init SP = FFF0h , Call stack 
;			1999.10.08 first edited
; BY		: Han Sung Hui
;--------------------------------------------------------
	 
	
;-------------------------------------------------------
; Vector and Option area (0x0 ~ 0xFE)
; - This area might be modified by user
;-------------------------------------------------------
      vector  0,Reset_handler        ;Reset vector address
 ;    vector  2,Reset_handler        ;Reset vector address
 ;    vector  4,Reset_handler        ;Reset vector address
   vector  4,_9908_IRQHandler         ;IRQ vector address
   ;  vector  4,_IRQ_handler
     
      
ResetSec        SECTION CODE
        ResetSec
        ;EXTERN	_IRQ_handler;_FIQ_handler         
       	EXTERN	_9908_IRQHandler;_FIQ_handler         
        EXTERN  _main
        EXTERN  _INIT_CPADWALTZ        
        EXTERN  |IMAGE$$IDATALOAD$$BASE|
        EXTERN  |IMAGE$$IDATA$$BASE|
        EXTERN  |IMAGE$$IDATA$$SIZE|
        EXTERN  |IMAGE$$ZDATA$$BASE|
        EXTERN  |IMAGE$$ZDATA$$SIZE|
        EXTERN  |IMAGE$$UDATA$$BASE|
	EXTERN  |IMAGE$$STACK$$LIMIT|
;JSY added 00-11-03
        EXTERN  |IMAGE$$DM$$BASE|
        
	org 0x200
	;org 0x126
Reset_handler
	;Disable all interrupt
	
	//CLRSR	FE	;FRQ disable

	CLRSR	IE	;IRQ disable
	CLRSR	TE	;TRQ disable
	
	JSR		_INIT_CPADWALTZ

;--------------------------------------------------------
; Initialize memory required by C code
;--------------------------------------------------------
; 1. Copy ROM's IDATA block to RAM(Data Memory)'s IDATA block
	; Get IDATA size
	LD		A9, #|IMAGE$$IDATA$$SIZE|
	; Check that they are different
	CMP		EQ, A9,#0
	BRT		_a
 
_CopyIDATA

	LD		R6,E9		;high byte of |IMAGE$$IDATA$$SIZE|
	; Get from_startaddress to from_pointer
	LD		A11, #|IMAGE$$IDATALOAD$$BASE|
	
	; Get to_startaddress to to_pointer
	LD		A8,#|IMAGE$$IDATA$$BASE|
	; index for data memory A8
	
_b

	; LDC(Load @[IL] in PM(Program Memory) to [0..1] addr in DM(Data Memory) )
	LDC		R2,@A11                
	LDW		@[A8],R2
	ADD		A11,#2		;byte code memory
	ADD		A8,#2
	;-------------------------------------------------------------------------
	; => Notice : following block can be modified as compiler data alignment.
	;-------------------------------------------------------------------------


	SUB		R9,#2
	SBC		R6,#0
	CMPU	GT,R6,#0
	BRT		_b
	CMPU	GT,R9,#0
	BRT		_b

; 2. Initialize RAM's ZDATA block with zero

_a
	
	; Get ZDATA size
	LD		A9, #|IMAGE$$ZDATA$$SIZE|
       
	; Check that they are different
	CMP		EQ,A9,#0        
	BRT		_e
_InitZDATA
	LD		R6,E9		;high byte of |IMAGE$$ZDATA$$SIZE|
	LD		R4,#0			;Zero data	
	LD		A8,#|IMAGE$$ZDATA$$BASE|
_d
	LDW		@[A8],R4     ; Zero init
	ADD		A8,#2
	SUB		R9,#2
	SBC		R6,#0	 
	CMPU	GT,R6,#0
	BRT		_d
	CMPU	GT,R9,#0
	BRT		_d


;--------------------------------------------------------
; Initialize special register
;--------------------------------------------------------
_e
		
	; stack sp initialization
	.ifdef ___CALLSTACKSIZE

	LD	SP, #|IMAGE$$STACK$$LIMIT|-4*32 ;

	; Callstack sp initialization
	LD	A8,#|IMAGE$$STACK$$LIMIT|-8
        
	
	LD	R0,E8
	LDW	@[A8+4],R0			;high
	LDW	@[A8+6],R8			;low

	.else
	LD	SP, #|IMAGE$$STACK$$LIMIT|;
	.endif
	
	; Initialize global data head pointer
	LD	A9,#0
	LD	A8,#0x3F0000
	

;--------------------------------------------------------
;   call the main() function
;--------------------------------------------------------
;JSY added 00-11-03
	LD	R1,#<|IMAGE$$IDATA$$BASE|
	LD	E9,R1
;end
	JSR     _main

;--------------------------------------------------------
;   termination 
;--------------------------------------------------------

;	BREAK + SYS #SWI_num
	LD	R10,#3
	DL	#0x9E999E3F	;SWI_num: 0x1F, Halt interrupt

SWISEC2        SECTION CODE,abs 0x8
	SWISEC2
	jmp	$__pushregs_swi
SWISEC3        SECTION CODE,abs 0xc
	SWISEC3
	jmp	$__popregs_swi	
	

	END