Proof ANGLFIND (#192) (#339)

pull/342/head
cai 2018-05-28 21:41:56 +08:00 committed by James Harris
parent be9b33edb1
commit 624a548983
1 changed files with 16 additions and 16 deletions

View File

@ -339,7 +339,7 @@ READCDUK INHINT # LOAD T(MPAC) WITH THE CURRENT CDU ANGLES
CDUTODCM AXT,1 SSP # SUBROUTINE TO COMPUTE DIRECTION COSINE
OCT 3 # MATRIX RELATING S/C AXES TO STABLE
S1 # MEMBER AXES FROM 3 CDU ANGLES IN T(MPAC)
OCT 1 # SET XR1, S1, AND PD FOR LOOP
OCT 1 # SET XR1, S1 AND PD FOR LOOP
STORE 7
SETPD
0
@ -427,7 +427,7 @@ ENDOCM EQUALS
SETLOC KALCMON1
BANK
# CALCULATION OF THE MATRIX DEL.......
# CALCULATION OF THE MATRIX DEL......
#
# * * --T *
# DEL = (IDMATRIX)COS(A)+UU (1-COS(A))+UX SIN(A) SCALED 1
@ -514,7 +514,7 @@ DELCOMP SETPD PUSH # MPAC CONTAINS THE ANGLE A
BDSU SL2
BOVB
SIGNMPAC
STODL DEL +12D # UX UZ (U-COS(A))-UY SIGN(A)
STODL DEL +12D # UX UZ (U-COS(A))-UY SIN(A)
COF +2
DMP DMP
COF +4
@ -543,9 +543,9 @@ DELCOMP SETPD PUSH # MPAC CONTAINS THE ANGLE A
#
# C =COS(THETA)COS(PSI)
# 0
# C =-COS(THETA)SIN(PSI)COS(PHI)+SIN(THETA)SIN(PHI)
# C =-COS(THETA)SIN(PSI)COS(PHI)+SI (THETA)SIN(PHI)
# 1
# C =COS(THETA)SIN(PSI)SIN(PHI)+SIN(THETA)COS(PHI)
# C =COS(THETA)SIN(PSI)SIN(PHI) + S N(THETA)COS(PHI)
# 2
# C =SIN(PSI)
# 3
@ -555,7 +555,7 @@ DELCOMP SETPD PUSH # MPAC CONTAINS THE ANGLE A
# 5
# C =-SIN(THETA)COS(PSI)
# 6
# C =SIN(THETA)SIN(PSI)COS(PHI)+COS(THETA)SIN(PHI)
# C =SIN(THETA)SIN(PSI)COS(PHI)+COS THETA)SIN(PHI)
# 7
# Page 410
# C =-SIN(THETA)SIN(PSI)SIN(PHI)+COS(THETA)COS(PHI)
@ -611,7 +611,7 @@ VECOFANG VDEF RVQ
NOGOM2 INHINT # THIS LOCATION ACCESSED BY A BZMF NOGO -2
TC BANKCALL
CADR ZEROERROR
CADR ZEROEROR
NOGO INHINT
TC STOPRATE