***************************************************
*FILENAME:initdsp.asm							  *
*This file initiates main registers of c5409.     *	
*BY:Wuchun            DATE:2002.8.7		    	  *	
*Modified:Xusheng     DATE:2003.3.3   	          *	
***************************************************


         .include "initdsp.inc"
         .mmregs
         .global  _initdsp
         
         .text   
_initdsp:
         ssbx  intm            ;close all interrupt
         stm  #0ffffh,ifr      ;clear all interrupt_flag
         stm  #0h,imr
         stm #0h,54h           ;disable all dma
		 ssbx xf 			   ;XF = 1
		                  
         nop
         stm  #0,clkmd         ;switch to DIV mode (1/2 clkin)
         nop
         nop
ts:      ldm  clkmd,a
         and  #01b,a
         bc  ts,aneq
         stm  #0f007h,clkmd     ;clkout=clkin X 8 (PLL mode_) 
         rpt  #100             ;wait enough clocks
         nop
         
         stm  #K_SWWSR,swwsr   ;initialize swwsr
         stm  #K_BSCR,bscr     ;initialize bscr
         stm  #K_PMST,pmst     ;initialize pmst
		
		 rsbx  intm            ;enable all interrupt
		 
		 		
	    .if	__far_mode
		fret			
		.else
		ret				
		.endif
		
;end of the file