kjodle/Apollo-11
1
0
Fork 0
Code Issues Pull Requests Projects Releases Wiki Activity

Proof ANGLFIND (#192) (#339)

Browse Source
This commit is contained in:
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
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

32
Comanche055/ANGLFIND.agc
View File

@ -249,7 +249,7 @@ OKU31 DLOAD BPL
MFISYM +10D # UY UZ MFISYM +10D # UY UZ
LOCSKIRT LOCSKIRT
DLOAD DCOMP DLOAD DCOMP
COF +2 # SIGN OF UY OPPOSITE TO UZ COF +2 # SIGN OF UY OPPOSITE TO UZ
STORE COF +2 STORE COF +2
GOTO GOTO
LOCSKIRT LOCSKIRT
@ -272,7 +272,7 @@ MXM3 SETPD # MXM3 MULTIPLIES 2 3X3 MATRICES
2,2 2,2
VDEF MXV* # DEFINE VECTOR M2(COL 2) VDEF MXV* # DEFINE VECTOR M2(COL 2)
0,1 0,1
PDDL* PDDL* # M1XM2(COL2) IN PD PDDL* PDDL* # M1XM2(COL 2) IN PD
16D,2 16D,2
10D,2 10D,2
PDDL* VDEF # DEFINE VECTOR M2(COL 3) PDDL* VDEF # DEFINE VECTOR M2(COL 3)
@ -281,7 +281,7 @@ MXM3 SETPD # MXM3 MULTIPLIES 2 3X3 MATRICES
0,1 0,1
GOTO GOTO
TRNSPSPD # REVERSE ROWS AND COLS IN PD AND TRNSPSPD # REVERSE ROWS AND COLS IN PD AND
# RETURN WITH M1XM2 IN PD LIST # RETURN WITH M1XM2 IN PD LIST
TRANSPOS SETPD VLOAD* # TRANSPOS TRANSPOSES A 3X3 MATRIX TRANSPOS SETPD VLOAD* # TRANSPOS TRANSPOSES A 3X3 MATRIX
0 # AND LEAVES RESULT IN PD LIST 0 # AND LEAVES RESULT IN PD LIST
@ -319,7 +319,7 @@ MAXANG DEC .472222
SD DEC .433015 # = SIN(D) $2 SD DEC .433015 # = SIN(D) $2
K3S1 DEC .86603 # = SIN(D) $2 K3S1 DEC .86603 # = SIN(D) $2
K4 DEC -.25 # = -COS(D) $2 K4 DEC -.25 # = - COS(D) $2
K4SQ DEC .125 # = COS(D)COS(D) $2 K4SQ DEC .125 # = COS(D)COS(D) $2
SNGLCD DEC .008725 # = SIN(NGL)COS(D) $2 SNGLCD DEC .008725 # = SIN(NGL)COS(D) $2
CNGL DEC .499695 # = COS(NGL) $2 CNGL DEC .499695 # = COS(NGL) $2
@ -339,7 +339,7 @@ READCDUK INHINT # LOAD T(MPAC) WITH THE CURRENT CDU ANGLES
CDUTODCM AXT,1 SSP # SUBROUTINE TO COMPUTE DIRECTION COSINE CDUTODCM AXT,1 SSP # SUBROUTINE TO COMPUTE DIRECTION COSINE
OCT 3 # MATRIX RELATING S/C AXES TO STABLE OCT 3 # MATRIX RELATING S/C AXES TO STABLE
S1 # MEMBER AXES FROM 3 CDU ANGLES IN T(MPAC) 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 STORE 7
SETPD SETPD
0 0
@ -427,7 +427,7 @@ ENDOCM EQUALS
SETLOC KALCMON1 SETLOC KALCMON1
BANK BANK
# CALCULATION OF THE MATRIX DEL....... # CALCULATION OF THE MATRIX DEL......
# #
# * * --T * # * * --T *
# DEL = (IDMATRIX)COS(A)+UU (1-COS(A))+UX SIN(A) SCALED 1 # DEL = (IDMATRIX)COS(A)+UU (1-COS(A))+UX SIN(A) SCALED 1
@ -501,9 +501,9 @@ DELCOMP SETPD PUSH # MPAC CONTAINS THE ANGLE A
DMP DMP DMP DMP
COF +4 COF +4
4 4
SL1 PDDL # D6 UX UZ (1-COS A ) $ 4 SL1 PDDL # D6 UX UZ (1-COS A ) $ 4
COF +2 COF +2
DMP PUSH # D8 UY SIN(A) DMP PUSH # D8 UY SIN(A)
0 0
DAD SL2 DAD SL2
6 6
@ -514,14 +514,14 @@ DELCOMP SETPD PUSH # MPAC CONTAINS THE ANGLE A
BDSU SL2 BDSU SL2
BOVB BOVB
SIGNMPAC 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 COF +2
DMP DMP DMP DMP
COF +4 COF +4
4 4
SL1 PDDL # D6 UY UZ (1-COS(A)) $ 4 SL1 PDDL # D6 UY UZ (1-COS(A)) $ 4
COF COF
DMP PUSH # D6 UX SIN(A) DMP PUSH # D6 UX SIN(A)
0 0
DAD SL2 DAD SL2
6 6
@ -531,7 +531,7 @@ DELCOMP SETPD PUSH # MPAC CONTAINS THE ANGLE A
BDSU SL2 BDSU SL2
BOVB BOVB
SIGNMPAC SIGNMPAC
STORE DEL +10D # UY UZ(1-COS(A)) -UX SIN(A) STORE DEL +10D # UY UZ (1-COS(A)) -UX SIN(A)
RVQ RVQ
# DIRECTION COSINE MATRIX TO CDU ANGLE ROUTINE # DIRECTION COSINE MATRIX TO CDU ANGLE ROUTINE
@ -543,9 +543,9 @@ DELCOMP SETPD PUSH # MPAC CONTAINS THE ANGLE A
# #
# C =COS(THETA)COS(PSI) # C =COS(THETA)COS(PSI)
# 0 # 0
# C =-COS(THETA)SIN(PSI)COS(PHI)+SIN(THETA)SIN(PHI) # C =-COS(THETA)SIN(PSI)COS(PHI)+SI (THETA)SIN(PHI)
# 1 # 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 # 2
# C =SIN(PSI) # C =SIN(PSI)
# 3 # 3
@ -555,7 +555,7 @@ DELCOMP SETPD PUSH # MPAC CONTAINS THE ANGLE A
# 5 # 5
# C =-SIN(THETA)COS(PSI) # C =-SIN(THETA)COS(PSI)
# 6 # 6
# C =SIN(THETA)SIN(PSI)COS(PHI)+COS(THETA)SIN(PHI) # C =SIN(THETA)SIN(PSI)COS(PHI)+COS THETA)SIN(PHI)
# 7 # 7
# Page 410 # Page 410
# C =-SIN(THETA)SIN(PSI)SIN(PHI)+COS(THETA)COS(PHI) # 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 NOGOM2 INHINT # THIS LOCATION ACCESSED BY A BZMF NOGO -2
TC BANKCALL TC BANKCALL
CADR ZEROERROR CADR ZEROEROR
NOGO INHINT NOGO INHINT
TC STOPRATE TC STOPRATE