time.asm

spwm测试程序

********************************** 
         .def     TIME_P,P_TIME,TIME_ADD,TIME_SUB,TIME_CNT 
         .def     TIME_CNT_ADD,TIME_CNT_SUB,TIME_INT,P_TIME_1
********************************** 
         .include "lf2407a.H" 
**********************************
         .bss   MIAO,1
         .bss   FEN,1
         .bss   QIAO,1
         .bss   MIAO_ERR,1
         .bss   TIME_CNT,1
         .bss   TIME_RST,1
********************************** 
         .text
**********************************          
TIME_P:     
        LDP         #5
        LACL        MIAO 
        ADD         #1
        SACL        MIAO 
        SUB         #60    
        BCND        DD1,LT
        SPLK        #0,MIAO 
        LACL        TIME_RST
        BCND        DD2,NEQ
        LACL        FEN  
        ADD         #1
        SACL        FEN   
        SUB         #60    
        BCND        DD1,LT
        SPLK        #0,FEN  
        LACL        QIAO  
        ADD         #1
        SACL        QIAO 
        SUB         #24    
        BCND        DD1,LT 
        SPLK        #0,QIAO 
DD1:    
        LACL        MIAO_ERR
        ADD         #1
        SACL        MIAO_ERR
        SUB         #610
        RETC        LT  
        SPLK        #0,MIAO_ERR
        LACL        MIAO
        ADD         #1
        SACL        MIAO
        SUB         #60
        BCND        DD2,LT
        SPLK        #0,MIAO
        LACL        FEN 
        ADD         #1
        SACL        FEN 
DD2:    
        RET  
**********************************
P_TIME:		    
	    LDP         #5
		LACL        FEN
		
        LDP         #6
        SPLK		#10,TEMP 
		RPT 		#15  
		SUBC		TEMP
		SACL		DTA20
		SACH		DTA19 
		LACL        DTA20
		BCND        P_TIME1,NEQ
		SPLK        #17,DTA20		  
P_TIME1:		
	    LDP         #5
		LACL        QIAO
		LDP         #6   
		SPLK		#10,TEMP  
		RPT 		#15  
		SUBC		TEMP
		SACL		DTA23 
		SACH		DTA22   
		LACL        DTA23
		BCND        P_TIME2,NEQ
		SPLK        #17,DTA23
P_TIME2:
		SPLK        #19,DTA21
		RET
**********************************
TIME_ADD:
        LDP         #5 
        SPLK        #1,TIME_RST
        LACL        TIME_CNT
        SUB         #1
        BCND        ADD_1,EQ
        SUB         #1
        BCND        ADD_2,EQ
        SUB         #1
        BCND        ADD_3,EQ  
        RET    
ADD_1:   
        LACL        QIAO
        ADD         #1
        SACL        QIAO
        SUB         #24
        BCND        END,LT
        SPLK        #0,QIAO
        RET
ADD_2:   
        LACL        FEN
        ADD         #1
        SACL        FEN
        SUB         #59
        BCND        END,LEQ
        SPLK        #0,FEN
        RET
ADD_3:
        RET           
**********************************
TIME_SUB:
        LDP         #5
        SPLK        #1,TIME_RST
        LACL        TIME_CNT
        SUB         #1
        BCND        SUB_1,EQ
        SUB         #1
        BCND        SUB_2,EQ
        SUB         #1
        BCND        SUB_3,EQ  
        RET    
SUB_1: 
        LACL        QIAO
        SUB         #1
        SACL        QIAO
        BCND        END,GEQ
        SPLK        #23,QIAO
        RET
SUB_2:   
        LACL        FEN
        SUB         #1
        SACL        FEN
        BCND        END,GEQ
        SPLK        #59,FEN
        RET
SUB_3:   
        RET       
**********************************
TIME_INT:
        LDP         #5
        SPLK        #0,TIME_CNT  
        LACL        TIME_RST
        BCND        TIME_INT_END,EQ
        SPLK        #0,MIAO
        SPLK        #0,MIAO_ERR 
        SPLK        #0,TIME_RST
TIME_INT_END:        
        RET
**********************************
TIME_CNT_ADD:
        LDP         #5
        LACL        TIME_CNT
        ADD         #1
        SACL        TIME_CNT
        SUB         #3
        BCND        END,LEQ
        SPLK        #3,TIME_CNT
        RET
**********************************
TIME_CNT_SUB:
        LDP         #5
        LACL        TIME_CNT
        SUB         #1
        SACL        TIME_CNT
        BCND        END,GT
        SPLK        #1,TIME_CNT  
        RET
END:    
        LDP         #6
        SPLK        #50,FMDAT2
        RET
**********************************
P_TIME_1:
        LDP         #5
        LACL        TIME_CNT 
        LDP         #6
        SACL		DTA1 
        SPLK        #17,DTA2
        RET
**********************************         
        .end