.global _InitC5402 
	.global _OpenMcBSP
	.global _CloseMcBSP 
	.global	_Start
	.global _DAout
	.include MMRegs.h
_InitC5402:
	NOP
	LD  #0, DP     ; reset data–page pointer
	STM #0, CLKMD  ; software setting of DSP clock
	STM #0, CLKMD  ; (to divider mode before setting)	
	STM #0xf007, CLKMD ; set C5402 DSP clock to 40MHz	
	STM #0x00e0,PMST 
   
	ssbx	intm   ; set st1.intm=1 stop all interrupt
	stm     0b1bh,TCR
    stm     04e1fh,PRD
	stm     00h,IMR ;stop all interrupt
	stm     0ffffh,IFR ;clear all interrupt sign

    stm     0x0b29,TCR
	stm     000Ah,IMR;allow int2 interrupt
	rsbx    intm ;allow all interrupt

_Start:
    nop
    nop
    rsbx  xf
    nop
    nop
	stm 	0xfff,ar2

loopstart:
    nop
    nop
	banz 	loopstart,*ar2-
	nop
	ret
	nop
_DAout:	
 	mvdm 0x2502,ar5
	nop
	ssbx xf        ; set break point here, motor in high speed 
loop3:	
    nop
    nop               
	banz 	loop3,*ar5-
    nop
	nop
    mvdm  0x2504, ar6
    nop
    rsbx xf       ;set break point here, motor in low speed
loop4:
    nop
    nop
    banz  loop4,*ar6-
	nop		
    ret
	nop
************************************************************************
** End of File –– InitC5402.asm
************************************************************************