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
哪位大侠能帮我看下这段程序，用来求空间参考矢量的角度，20000，10000，21990这些数字用在这里是为什么？能解释下吗？谢谢！
