hardware.asm

直流电机转速测控

F_SP_SACM_S480_Init_:
        r1 = 0x0000						
        [P_SystemClock]=r1          	
        r1=0x0030                       
        [P_TimerA_Ctrl]=r1				
        
        r1 = 0xfced					
        [P_TimerA_Data]=r1
        r1 = 0x00A8						
        [P_DAC_Ctrl] = r1				
        
        r1 = 0xffff
        [P_INT_Clear] = r1          	

        r1 = [P_INT_Mask]				
        r1 |= C_FIQ_TMA					
       
        [R_InterruptStatus] = r1		
        [P_INT_Ctrl] = r1			
        
        RETF


F_SP_SACM_S240_Init_:	
		r1=0x0020;	
		[P_SystemClock]=r1
		r1 = 0x00A8;					
		[P_DAC_Ctrl]= r1
		r1 = 0x0030;               	
        [P_TimerA_Ctrl] = r1;
		r1 = 0xfe00;                    
    	[P_TimerA_Data] = r1;		
        r1 = 0xffff
        [P_INT_Clear] = r1          	

        r1 = [P_INT_Mask]				
        r1 |= C_FIQ_TMA					
        [R_InterruptStatus] = r1	
        [P_INT_Ctrl] = r1				
        RETF


F_SP_SACM_MS01_Init_:	
		r1 = 0x0000;                   
        [P_SystemClock] = r1;        	
        r1 = 0x0030;                    
        [P_TimerA_Ctrl] = r1		
        
        
        r1 = 0x0000						
        [P_TimerB_Ctrl] = r1;			
        
           
        r1 = 0xFA00				
        [P_TimerB_Data] = r1		
        
		r1 = 0xffff
        [P_INT_Clear] = r1          	
        RETF


F_SP_PlayMode0_:						
		r1 = 0x0006
        [P_DAC_Ctrl] = r1
        r1 = 0xFE00
        [P_TimerA_Data] = r1 			
        r1 = [P_INT_Mask]				
        r1 |= C_FIQ_PWM+C_IRQ2_TMB+C_IRQ4_1KHz
        [R_InterruptStatus] = r1 		
        [P_INT_Ctrl] = r1				
        RETF

F_SP_PlayMode1_:						
		r1 = 0x00A8
        [P_DAC_Ctrl] = r1
        r1 = 0xFE00
        [P_TimerA_Data] = r1 			
        r1 = [P_INT_Mask]				
        r1 |= C_FIQ_TMA+C_IRQ2_TMB+C_IRQ4_1KHz
        [R_InterruptStatus] = r1 		
        [P_INT_Ctrl] = r1				
        RETF


F_SP_PlayMode2_:	 						
		r1 = 0x00A8
        [P_DAC_Ctrl] = r1
        r1 = 0xFD9A
        [P_TimerA_Data] = r1 				
        r1 = [P_INT_Mask]				
        r1 |= C_FIQ_TMA+C_IRQ2_TMB+C_IRQ4_1KHz
        [R_InterruptStatus] = r1 			
        [P_INT_Ctrl] = r1					
        RETF

      
F_SP_PlayMode3_:								
		r1 = 0x00A8
        [P_DAC_Ctrl] = r1
        r1 = 0xFD00
        [P_TimerA_Data] = r1 					
        r1 = [P_INT_Mask]				
        r1 |= C_FIQ_TMA+C_IRQ2_TMB+C_IRQ4_1KHz
	    [R_InterruptStatus] = r1 				
        [P_INT_Ctrl] = r1						
        RETF
        

F_SP_SACM_DVR_Init_:
        r1 = 0x0000;                    
        [P_SystemClock] = r1;           
        r1 = 0x0030;                    
        [P_TimerA_Ctrl] = r1;
        r1 = 0xfa00;                   
        
        [P_TimerA_Data] = r1;
        r1 = 0x0035;                    
        [P_ADC_Ctrl] = r1;
        r1 = 0x00A8;                    
        [P_DAC_Ctrl] = r1;
        
        r1 = 0xffff;
        [P_INT_Clear] = r1;          	
        
        r1 = [P_INT_Mask]				
        r1 |= C_FIQ_TMA					
        [R_InterruptStatus] = r1		
        [P_INT_Ctrl] = r1			
        
        RETF



F_SP_SACM_DVR_Rec_Init_:				
		r1 = 0x0035;  					
        
        [P_ADC_Ctrl] = r1;       		
        
        r1=0xfe00;                     	
        [P_TimerA_Data] = r1 
		RETF

F_SP_SACM_DVR_Play_Init_:
	    r1 = 0x0000					
        [P_ADC_Ctrl] = r1;       		
        
        r1 = 0xfd00;                
        [P_TimerA_Data] = r1;
        RETF





_SP_RampUpDAC1:	.PROC
F_SP_RampUpDAC1:
		push r1,r2 to [sp] 
        r1=[P_DAC1] 
        r1 &= ~0x003f 
        cmp     r1,0x8000
        jb     	L_RU_NormalUp
        je      L_RU_End
                
L_RU_DownLoop:
        call    F_Delay         
        r2 = 0x0001 
        [P_Watchdog_Clear] = r2 
        r1 -= 0x40 
        [P_DAC1] = r1 
        cmp     r1,0x8000 
        jne     L_RU_DownLoop   
L_RD_DownEnd:
        jmp     L_RU_End 

L_RU_NormalUp:
L_RU_Loop:
        call    F_Delay 
        r2 = 0x0001 
        [P_Watchdog_Clear] = r2 
        r1 += 0x40 
        [P_DAC1] = r1 
        cmp     r1, 0x8000 
        jne     L_RU_Loop 
L_RU_End:
		pop     r1,r2 from [sp] 
  		retf 
    	.ENDP
    

_SP_RampDnDAC1:	.PROC
F_SP_RampDnDAC1:
		push r1,r2 to [sp] 
  	
    	r1 = [P_DAC1] 
     	r1 &= ~0x003F 
      	jz      L_RD_End 
L_RD_Loop:                
        call    F_Delay         
        r2 = 0x0001 
        [P_Watchdog_Clear] = r2 
        r1 -= 0x40 
        [P_DAC1] = r1   
        jnz     L_RD_Loop 
L_RD_End:       
		
        pop     r1,r2 from [sp] 
        retf 
		.ENDP


_SP_RampUpDAC2:	.PROC
F_SP_RampUpDAC2:
		push r1,r2 to [sp] 
  		r1=[P_DAC2] 
    	r1 &= ~0x003f 
     	cmp     r1,0x8000
      	jb     	L_RU_NormalUp_   
       	je      L_RU_End 
                
L_RU_DownLoop_:
        call    F_Delay         
        r2 = 0x0001 
        [P_Watchdog_Clear] = r2 
        r1 -= 0x40 
        [P_DAC2] = r1 
        cmp     r1,0x8000 
        jne     L_RU_DownLoop_   
L_RD_DownEnd_:
        jmp     L_RU_End_ 

L_RU_NormalUp_:
L_RU_Loop_:
		call    F_Delay 
  		r2 = 0x0001 
    	[P_Watchdog_Clear] = r2 
        r1 += 0x40 
        [P_DAC2] = r1 
        cmp     r1, 0x8000 
        jne     L_RU_Loop_ 
L_RU_End_:
   		pop     r1,r2 from [sp] 
     	retf 
      	.ENDP

_SP_RampDnDAC2:	.PROC
F_SP_RampDnDAC2:
		
		push r1,r2 to [sp] 
                
        r1 = [P_DAC2] 
        r1 &= ~0x003F 
        jz      L_RD_End_ 
L_RD_Loop_:                
        call    F_Delay         
        r2 = 0x0001 
        [P_Watchdog_Clear] = r2 
        r1 -= 0x40 
        [P_DAC2] = r1   
        jnz     L_RD_Loop_ 
L_RD_End_:       
        pop     r1,r2 from [sp] 
        retf 
		.ENDP

				
F_Delay:
        push r1 to [sp] 
        r1 = C_RampDelayTime			
L_D_Loop:
        r1 -= 1 
        jnz     L_D_Loop  
        pop     r1 from [sp] 
        RETF	 




_SP_Init_IOA: .PROC
		PUSH bp TO [sp] 
        bp = sp + 1 
		PUSH r1 TO [sp] 
		r1 = [bp+3] 						
		[P_IOA_Dir] = r1 
		r1 = [bp+4] 
		[P_IOA_Data] = r1 
		r1 = [bp+5] 
		[P_IOA_Attrib] = r1 
		
		POP r1 FROM [sp] 
        POP bp FROM [sp] 
        RETF 
		.ENDP

   
_SP_Init_IOB: .PROC
		PUSH bp TO [sp] 
        bp = sp + 1 
		PUSH r1 TO [sp] 
		r1 = [bp+3] 					
		[P_IOB_Dir] = r1 
		r1 = [bp+4] 
		[P_IOB_Data] = r1 
		r1 = [bp+5] 
		[P_IOB_Attrib] = r1 
		
		POP r1 FROM [sp] 
        POP bp FROM [sp] 
        RETF 
		.ENDP


_SP_Import: .PROC
        PUSH bp TO [sp] 
        bp = sp + 1 
        
		r1 = [bp+3]  						
		r1 = [r1]  
				
        POP bp FROM [sp] 
        RETF 
		.ENDP

_SP_Export: .PROC
        PUSH bp,bp TO [sp] 
        sp = sp + 1 
		PUSH r1,r2 TO [sp] 
		r1 = [bp+3]  					
		r2 = [bp+4]  					
		[r1] = r2  
		POP r1,r2 FROM [sp] 
        POP bp,bp FROM [sp] 
        RETF         
 		.ENDP


 
_SP_GetResource:	.PROC
		push bp to [sp] 
		bp = sp + 1 
		
		r1 = [bp+3] 				
		r2 = [bp+4] 					
		
		r2 = r2 lsl 4 				
		r2 = r2 lsl 4 
		r2 = r2 lsl 2 
		
		sr &= 0x03f 					
        r2 |=sr 						
        sr = r2 						
  
  		r1 = D:[r1] 					
       
		pop	 bp from [sp] 
		retf 
		.ENDP 

F_SP_GetResource:
		r2 = r2 lsl 4 					
		r2 = r2 lsl 4 
		r2 = r2 lsl 2 
		
		sr &= 0x03f 					
        r2 |=sr 					
        sr = r2 					
  
  		r1 = D:[r1] 					
	  	retf


.PUBLIC	F_RampUpDAC1 
.PUBLIC	F_RampDnDAC1 
.PUBLIC	F_RampUpDAC2 
.PUBLIC	F_RampDnDAC2 
.PUBLIC	_STD_RampUpDAC1 
.PUBLIC	_STD_RampDnDAC1 
.PUBLIC	_STD_RampUpDAC2 
.PUBLIC	_STD_RampDnDAC2 

.DEFINE F_RampUpDAC1 F_SP_RampUpDAC1
.DEFINE F_RampDnDAC1 F_SP_RampDnDAC1
.DEFINE F_RampUpDAC2 F_SP_RampUpDAC2
.DEFINE F_RampDnDAC2 F_SP_RampDnDAC2
.DEFINE _STD_RampUpDAC1 _SP_RampUpDAC1
.DEFINE _STD_RampDnDAC1 _SP_RampDnDAC1
.DEFINE _STD_RampUpDAC2 _SP_RampUpDAC2
.DEFINE _STD_RampDnDAC2 _SP_RampDnDAC2