SUB_CAL_ANG:
		POPD	*+                                   
                          
        	CLRC    SXM 
        	LDP	#GPR_KX>>7                                                                                          
        	BLDD	#T1PR_BAK,GPR_KX     	;100000/FRQ_CARRIER
        	
        	SPM	0                                             
        	SPLK    #20000,GPR_GX		;5000                         
        	LDP	#FRQ_SYN>>7                          
        	LACC    FRQ_SYN,16                           
        	ABS                                          
        	LDP	#GPR_AX>>7                           
        	SACH    GPR_AX               
        	LT      GPR_AX                               
        	MPY     GPR_KX               	;TS             
        	PAC                                          
        	RPT     #15                                  
        	SUBC    GPR_GX                                  
        	SACL    GPR_AX                                
        	SACH    GPR_BX                             
        	                                             
        	LT      GPR_BX                               
        	LDP     #FRQ_MAX1>>7                         
        	MPY     FRQ_MAX1                             
        	PAC                                          
        	LDP     #GPR_GX>>7                           
        	RPT     #15                                  
        	SUBC    GPR_GX                               
        	SACL    GPR_CX                             
        	SACH    GPR_EX                             
        	                                             
        	LACL    GPR_CX                               
        	LT      GPR_AX                               
        	LDP     #FRQ_MAX1>>7                         
        	MPY     FRQ_MAX1                             
        	APAC                                       
        	LDP	#GPR_CX>>7                           
        	SACL    GPR_CX                                
        	SACH    GPR_DX                             
        	                                             
        	SPLK    #10000,GPR_BX                        
        	RPT     #15                                  
        	SUBC    GPR_BX                               
        	SACL    GPR_FX                           
        	SACH    GPR_AX                            
        	LACC    GPR_AX,16                            
        	RPT     #15                                  
        	SUBC    GPR_BX                               
        	SACL    GPR_DX                              
        	                                             
        	SPLK    #21990,GPR_AX                        
        	LT      GPR_EX                               
        	MPY     GPR_AX                               
        	PAC                                          
        	RPT     #15                                   
        	SFR                                          
        	SACH    GPR_EX                            
        	                                             
        	LACC    GPR_EX                               
        	ADD     GPR_DX                               
        	SACL    GPR_EX                              

		LACC	GPR_FX,16
		ADDS	GPR_EX
		SFL
		SFL             
		SACH	GPR_FX  
		SACL	GPR_EX  

        	                                             
        	LACL    GPR_FX                               
        	SFL                                       
        	NEG                                        
        	SACL    GPR_GX                            
        	                                             
        	LDP     #FRQ_SYN>>7                          
        	BIT     FRQ_SYN,BIT15                        
        	BCND    CAL_ANG_1,NTC                   
        	LDP	#GPR_FX>>7                           
        	LACC    GPR_FX,16                           
        	ADDS    GPR_EX                               
        	NEG                                          
        	SACH    GPR_FX                              
        	SACL    GPR_EX                              
        	LACC    GPR_GX                               
        	NEG                                          
        	SACL    GPR_GX                           
CAL_ANG_1:                                           
        	;SETC  	INTM                                 
        	LDP   	#T1PR_BAK>>7                         
        	;BLDD  	#GPR_KX,T1PR_BAK                     
        	BLDD  	#GPR_FX,DELTA_DQ_H                   
        	BLDD  	#GPR_EX,DELTA_DQ_L                   
        	BLDD  	#GPR_GX,DELTA_DQ2 
        	               
        	;CLRC  	INTM                                 
		CLRC	OVM
        	LDP	#T1PR>>7                               
        	BLDD	#T1PR_BAK,T1PR
		LDP   	#DELTA_DQ_L>>7                         
        	LACL  	DELTA_DQ_L                             
        	ADD   	DELTA_DQ_H,16                          
        	ADDS  	THTA_DQ_L                              
        	ADD   	THTA_DQ_H,16                           
        	SACL  	THTA_DQ_L                              
        	SACH  	THTA_DQ_H                              

		MAR   	*,AR1                                
		SBRK  	1                                    
		PSHD  	*                                    
                
        	RET