From 1a797dbe095193dd29e355fab22321d0ad338d62 Mon Sep 17 00:00:00 2001 From: Sudhish2607 Date: Thu, 29 Oct 2020 02:00:47 -0500 Subject: [PATCH] fix: (Issue #569) page 0359 --- Luminary099/ATTITUDE_MANEUVER_ROUTINE.agc | 33 ++++++++++++----------- 1 file changed, 17 insertions(+), 16 deletions(-) diff --git a/Luminary099/ATTITUDE_MANEUVER_ROUTINE.agc b/Luminary099/ATTITUDE_MANEUVER_ROUTINE.agc index 93274c0..2df8f8b 100644 --- a/Luminary099/ATTITUDE_MANEUVER_ROUTINE.agc +++ b/Luminary099/ATTITUDE_MANEUVER_ROUTINE.agc @@ -805,34 +805,34 @@ LOOPSIN SLOAD* RTB # Page 359 DLOAD - DMP SL1 # (PUSH UP 7) + DMP SL1 # (PUSH UP 7) 8D - PDDL DMP # (PD7 COS(PHI)SIN(THETA)SIN(PSI)) SCALE 4 + PDDL DMP # (PD7 COS(PHI)SIN(THETA)SIN(PSI)) SCALE 4 6 0 - DAD SL1 # (PUSH UP 7) + DAD SL1 # (PUSH UP 7) STADR # C7=COS(PHI)SIN(THETA)SIN(PSI) - STORE 14D,2 # +COS(THETA)SIN(PHI) + STORE 14D,2 # +COS(THETA)SIN(PHI) DLOAD - DMP SL1 # (PUSH UP 6) + DMP SL1 # (PUSH UP 6) 8D - PDDL DMP # (PD6 SIN(THETA)SIN(PHI)SIN(PSI)) SCALE 4 + PDDL DMP # (PD6 SIN(THETA)SIN(PHI)SIN(PSI)) SCALE 4 6 2 - DSU SL1 # (PUSH UP 6) + DSU SL1 # (PUSH UP 6) STADR STORE 16D,2 # C8=-SIN(THETA)SIN(PHI)SIN(PSI) - RVQ # +COS(THETA)COS(PHI) + RVQ # +COS(THETA)COS(PHI) # CALCULATION OF THE MATRIX DEL...... # -# * * __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 +# * * --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 DELCOMP SETPD PUSH # MPAC CONTAINS THE ANGLE A 0 @@ -842,7 +842,7 @@ DELCOMP SETPD PUSH # MPAC CONTAINS THE ANGLE A BDSU BOVB DPHALF SIGNMPAC - PDDL # PDA = 1-COS(A) + PDDL # PD4 = 1-COS(A) # COMPUTE THE DIAGONAL COMPONENTS OF DEL @@ -853,6 +853,7 @@ DELCOMP SETPD PUSH # MPAC CONTAINS THE ANGLE A 2 BOVB SIGNMPAC + # Page 360 STODL KEL # UX UX(1-COS(A)) +COS(A) $1 COF +2