From a99c9d025794032de046e4965cb3193a2b56aced Mon Sep 17 00:00:00 2001 From: lewisjb Date: Wed, 27 Oct 2021 21:23:28 +1000 Subject: [PATCH] Proof ANGLFIND p405-409 --- Comanche055/ANGLFIND.agc | 38 +++++++++++++++++++------------------- 1 file changed, 19 insertions(+), 19 deletions(-) diff --git a/Comanche055/ANGLFIND.agc b/Comanche055/ANGLFIND.agc index e4c6bf6..80e38c9 100644 --- a/Comanche055/ANGLFIND.agc +++ b/Comanche055/ANGLFIND.agc @@ -317,12 +317,12 @@ MAXANG DEC .472222 # D = MGA CORRESPONDING TO GIMBAL LOCK = 60 DEGREES # NGL = BUFFER ANGLE (TO AVOID DIVISIONS BY ZERO) = 2 DEGREES -SD DEC .433015 # = SIN(D) $2 -K3S1 DEC .86603 # = SIN(D) $2 -K4 DEC -.25 # = - COS(D) $2 -K4SQ DEC .125 # = COS(D)COS(D) $2 -SNGLCD DEC .008725 # = SIN(NGL)COS(D) $2 -CNGL DEC .499695 # = COS(NGL) $2 +SD DEC .433015 # = SIN(D) $2 +K3S1 DEC .86603 # = SIN(D) $2 +K4 DEC -.25 # = - COS(D) $2 +K4SQ DEC .125 # = COS(D)COS(D) $2 +SNGLCD DEC .008725 # = SIN(NGL)COS(D) $2 +CNGL DEC .499695 # = COS(NGL) $2 READCDUK INHINT # LOAD T(MPAC) WITH THE CURRENT CDU ANGLES CA CDUZ TS MPAC +2 @@ -429,14 +429,14 @@ ENDOCM EQUALS # CALCULATION OF THE MATRIX DEL...... # -# * * --T * -# DEL = (IDMATRIX)COS(A)+UU (1-COS(A))+UX SIN(A) SCALED 1 +# * * --T * +# DEL = (IDMATRIX)COS(A)+UU (1-COS(A))+UX SIN(A) SCALED 1 # -# - -# WHERE U IS A UNIT VECTOR (DP SCALED 2) ALONG THE AXIS OF ROTATION. -# A IS THE ANGLE OF ROTATION (DP SCALED 2) -# - -# UPON ENTRY THE STARTING ADDRESS OF U IS COF, AND A IS IN MPAC +# - +# WHERE U IS A UNIT VECTOR (DP SCALED 2) ALONG THE AXIS OF ROTATION. +# A IS THE ANGLE OF ROTATION (DP SCALED 2) +# - +# UPON ENTRY THE STARTING ADDRESS OF U IS COF, AND A IS IN MPAC COUNT 22/KALC @@ -476,7 +476,7 @@ DELCOMP SETPD PUSH # MPAC CONTAINS THE ANGLE A 2 BOVB SIGNMPAC - STORE DEL +16D # UZ UZ(1-COS(A)) +COS(A) $1 + STORE DEL +16D # UZ UZ(1-COS(A)) +COS(A) $1 # COMPUTE THE OFF DIAGONAL TERMS OF DEL @@ -485,10 +485,10 @@ DELCOMP SETPD PUSH # MPAC CONTAINS THE ANGLE A COF +2 DMP SL1 4 - PDDL DMP # D6 UX UY (1-COS A) $ 4 + PDDL DMP # D6 UX UY (1-COS A) $ 4 COF +4 0 - PUSH DAD # D8 UZ SIN A $ 4 + PUSH DAD # D8 UZ SIN A $ 4 6 SL2 BOVB SIGNMPAC @@ -501,7 +501,7 @@ DELCOMP SETPD PUSH # MPAC CONTAINS THE ANGLE A DMP DMP COF +4 4 - SL1 PDDL # D6 UX UZ (1-COS A ) $ 4 + SL1 PDDL # D6 UX UZ (1-COS A ) $ 4 COF +2 DMP PUSH # D8 UY SIN(A) 0 @@ -519,9 +519,9 @@ DELCOMP SETPD PUSH # MPAC CONTAINS THE ANGLE A DMP DMP COF +4 4 - SL1 PDDL # D6 UY UZ (1-COS(A)) $ 4 + SL1 PDDL # D6 UY UZ (1-COS(A)) $ 4 COF - DMP PUSH # D6 UX SIN(A) + DMP PUSH # D8 UX SIN(A) 0 DAD SL2 6