From 4e0940e2754666f86c4971d8ddcb6d10876c4d8c Mon Sep 17 00:00:00 2001 From: Glenn Dwiyatcita Date: Fri, 25 May 2018 21:37:33 +0200 Subject: [PATCH] Proof CSM_GEOMETRY (#199) (#338) MIME-Version: 1.0 Content-Type: text/plain; charset=UTF-8 Content-Transfer-Encoding: 8bit 🕵️ Proofread #199 --- Comanche055/CSM_GEOMETRY.agc | 95 +++++++++++++++++------------------- 1 file changed, 46 insertions(+), 49 deletions(-) diff --git a/Comanche055/CSM_GEOMETRY.agc b/Comanche055/CSM_GEOMETRY.agc index f5d7196..898f42f 100644 --- a/Comanche055/CSM_GEOMETRY.agc +++ b/Comanche055/CSM_GEOMETRY.agc @@ -32,19 +32,20 @@ SETLOC COMGEOM1 BANK -# THIS ROUTINE TAKES THE SHAFT AND TRUNNION ANGLES AS READ BY THE CM OPTICAL SYSTEM AND CONVERTS THEM INTO A UNIT +# THIS ROUTINE TAKES THE SHAFT AND TRUNNION ANGLES AS READ BY THE CM OPTICAL SYSTEM AND CONVERTS THEM INTO A UNIT # VECTOR REFERENCED TO THE NAVIGATION BASE COORDINATE SYSTEM AND COINCIDENT WITH THE SEXTANT LINE OF SIGHT. # -# THE INPUTS ARE: 1) THE SEXTANT SHAFT AND TRUNNION ANGLES ARE STORED SP IN LOCATIONS 3 AND 5 RESPECTIVELY OF THE +# THE INPUTS ARE 1) THE SEXTANT SHAFT AND TRUNNION ANGLES ARE STORED SP IN LOCATIONS 3 AND 5 RESPECTIVELY OF THE # MARK VAC AREA. 2) THE COMPLEMENT OF THE BASE ADDRESS OF THE MARK VAC AREA IS STORED SP AT LOCATION X1 OF YOUR # JOB VAC AREA. # # THE OUTPUT IS A HALF-UNIT VECTOR IN NAVIGATION BASE COORDINATES AND STORED AT LOCATION 32D OF THE VAC AREA. THE # OUTPUT IS ALSO AVAILABLE AT MPAC. + COUNT 23/GEOM -SXTNB SLOAD* RTB # PUSHDOWN 00,02,04,(17D-19D),32D-36D +SXTNB SLOAD* RTB # PUSHDOWN 00,02,04,(17D-19D),32D-36D 5,1 # TRUNNION = TA CDULOGIC RTB PUSH @@ -71,26 +72,27 @@ SXTNB SLOAD* RTB # PUSHDOWN 00,02,04,(17D-19D),32D-36D STORE 32D RVQ + SXTLOGIC CAF 10DEGS- # CORRECT FOR 19.775 DEGREE OFFSET ADS MPAC CAF QUARTER TC SHORTMP TC DANZIG - # Page 286 # CALCSXA COMPUTES THE SEXTANT SHAFT AND TRUNNION ANGLES REQUIRED TO POSITION THE OPTICS SUCH THAT A STAR LINE- # OF-SIGHT LIES ALONG THE STAR VECTOR. THE ROUTINE TAKES THE GIVEN STAR VECTOR AND EXPRESSES IT AS A VECTOR REF- -# ERENECED TO THE OPTICS COORDINATE SYSTEM. IN ADDITION IT SETS UP THREE UNIT VECTORS DEFINING THE X, Y, AND Z AXES +# ERENCED TO THE OPTICS COORDINATE SYSTEM. IN ADDITION IT SETS UP THREE UNIT VECTORS DEFINING THE X,Y, AND Z AXES # REFERENCED TO THE OPTICS COORDINATE SYSTEM. # -# THE INPUTS ARE: 1) THE STAR VECTOR REFERRED TO THE PRESENT STABLE MEMBER COORDINATES STORED AT STAR. 2) SAME ANGLE -# INPUT AS *SMNB*, I.E., SINES AND COSINES OF THE CDU ANGLES, IN THE ORDER Y Z X, AT SINCDU AND COSCDU. A CALL +# THE INPUTS ARE 1) THE STAR VECTOR REFERRED TO PRESENT STABLE MEMBER COORDINATES STORED AT STAR. 2) SAME ANGLE +# INPUT AS *SMNB*, I.E. SINES AND COSINES OF THE CDU ANGLES, IN THE ORDER Y Z X, AT SINCDU AND COSCDU. A CALL # TO CDUTRIG WILL PROVIDE THIS INPUT. # -# THE OUTPUT ARE THE SEXTANT SHAFT AND TRUNNION ANGLES STORED DP AT SAC AND PAC RESPECTIVELY. (LOW ORDER PART +# THE OUTPUTS ARE THE SEXTANT SHAFT AND TRUNNION ANGLES STORED DP AT SAC AND PAC RESPECTIVELY. (LOW ORDER PART # EQUAL TO ZERO). -CALCSXA ITA VLOAD # PUSHDOWN 00-26D, 28D, 30D, 32D-36D + +CALCSXA ITA VLOAD # PUSHDOWN 00-26D,28D,30D,32D-36D 28D STAR CALL @@ -105,19 +107,19 @@ CALCSXA ITA VLOAD # PUSHDOWN 00-26D, 28D, 30D, 32D-36D HIUNITZ STCALL ZNB1 SXTANG1 - # Page 287 # SXTANG COMPUTES THE SEXTANT SHAFT AND TRUNNION ANGLES REQUIRED TO POSITION THE OPTICS SUCH THAT A STAR LINE-OF- # SIGHT LIES ALONG THE STAR VECTOR. # -# THE INPUTS ARE: 1) THE STAR VECTOR REFERRED TO ANY COORDINATE SYSTEM STORED AT STAR. 2) THE NAVIGATION BASE +# THE INPUTS ARE 1) THE STAR VECTOR REFERRED TO ANY COORDINATE SYSTEM STORED AT STAR. 2) THE NAVIGATION BASE # COORDINATES REFERRED TO THE SAME COORDINATE SYSTEM. THESE THREE HALF-UNIT VECTORS ARE STORED AT XNB, YNB, AND # ZNB. # # THE OUTPUTS ARE THE SEXTANT SHAFT AND TRUNNION ANGLES STORED DP AT SAC AND PAC RESPECTIVELY. (LOW ORDER PART # EQUAL TO ZERO). -SXTANG ITA RTB # PUSHDOWN 16D,18D,22D-26D,28D + +SXTANG ITA RTB # PUSHDOWN 16D,18D,22D-26D,28D 28D TRANSP1 # EREF WRT NB2 VLOAD MXV @@ -179,7 +181,7 @@ SXTANG1 VLOAD VXV 28D SXTALARM SETGO # ALARM HAS BEEN REMOVED FROM THIS CULTFLAG - 28D # SUBROUTINE, ALARM WILL BE SET BY MPI + 28D # SUBROUTINE,ALARM WILL BE SET BY MPI ZNB=S1 DLOAD 270DEG STODL SAC @@ -188,12 +190,11 @@ ZNB=S1 DLOAD CLRGO CULTFLAG 28D - # Page 289 # THESE TWO ROUTINES COMPUTE THE ACTUAL STATE VECTOR FOR LM, CSM BY ADDING -# THE CONIC R,V AND THE DEVIATIONS R,V. THE STATE VECTORS ARE CONVERTED TO +# THE CONIC R,V AND THE DEVIATIONSR,V. THE STATE VECTORS ARE CONVERTED TO # METERS B-29 AND METERS/CSEC B-7 AND STORED APPROPRIATELY IN RN,VN OR -# R-OTHER, V-OTHER FOR DOWNLINK. THE ROUTINES NAMES ARE SWITCHED IN THE +# R-OTHER , V-OTHER FOR DOWNLINK. THE ROUTINES NAMES ARE SWITCHED IN THE # OTHER VEHICLES COMPUTER. # # INPUT @@ -208,6 +209,7 @@ ZNB=S1 DLOAD # OR # R(T) IN R-OTHER, V(T) IN V-OTHER (T IS DEFINED BY T-OTHER) + BANK 23 SETLOC COMGEOM2 BANK @@ -249,7 +251,6 @@ SVDWN2 VLOAD VSL* 0,2 STORE V-OTHER RVQ - # Page 291 # SUBROUTINE TO COMPUTE THE NATURAL LOG OF C(MPAC, MPAC +1). # @@ -258,7 +259,7 @@ SVDWN2 VLOAD VSL* # # SUBROUTINE RETURNS WITH -LOG IN DP MPAC. # -# EBANK IS ARBITRARY. +# EBANK IS ARBITRARY.. BANK 14 SETLOC POWFLIT2 @@ -269,7 +270,9 @@ LOG NORM BDSU # GENERATES LOG BY SHIFTING ARG MPAC +3 # UNTIL IT LIES BETWEEN .5 AND 1. NEARLY1 # THE LOG OF THIS PART IS FOUND AND THE EXIT # LOG OF THE SHIFTED PART IS COMPUTED + TC POLY # AND ADDED IN. SHIFT COUNT STORED + DEC 2 # (N-1, SUPPLIED BY SMERZH) 2DEC 0 # IN MPAC +3. 2DEC .031335467 @@ -299,29 +302,25 @@ NEARLY1 2DEC .999999999 CLOG2/32 2DEC .0216608494 # Page 293 -# SUBROUTINE NAME: EARTH ROTATOR (EARROT1 OR EARROT2) DATE: 15 FEB 67 -# MOD NO: N +1 LOG SECTION: POWERED FLIGHT SUBROS +# SUBROUTINE NAME: EARTH ROTATOR (EARROT1 OR EARROT2) DATE: 15 FEB 67 +# MOD NO: N +1 LOG SECTION: POWERED FLIGHT SUBROS # MOD BY: ENTRY GROUP (BAIRNSFATHER) -# -# FUNCTIONAL DESCRIPTION: THIS ROUTINE PROJECTS THE INITIAL EARTH TARGET VECTOR RTINIT AHEAD THROUGH +# FUNCTIONAL DESCRIPTION: THIS ROUTINE PROJECTS THE INITIAL EARTH TARGET VECTOR RTINIT AHEAD THROUGH # THE ESTIMATED TIME OF FLIGHT. INITIAL CALL RESOLVES THE INITIAL TARGET VECTOR RTINIT INTO EASTERLY -# AND NORMAL COMPONENTS RTEAST AND RTNORM. INITIAL AND SUBSEQUENT CALLS ROTATE THIS VECTOR -# ABOUT THE (FULL) UNIT POLAR AXIS UNITW THROUGH THE ANGLE WIE DTEAROT TO OBTAIN THE ROTATED -# TARGET VECTOR RT. ALL VECTORS EXCEPT UNITW ARE HALF UNIT. -# THE EQUATIONS ARE: -# _ _ _ _ +# AND NORMAL COMPONENTS RTEAST AND RTNORM . INITIAL AND SUBSEQUENT CALLS ROTATE THIS VECTOR +# ABOUT THE (FULL) UNIT POLAR AXIS UNITW THROUGH THE ANGLE WIE DTEAROT TO OBTAIN THE ROTATED +# TARGET VECTOR RT . ALL VECTORS EXCEPT UNITW ARE HALF UNIT. +# THE EQUATIONS ARE +# - - - - # RT = RTINIT + RTNORM (COS(WT) - 1) + RTEAST SIN(WT) -# # WHERE WT = WIE DTEAROT -# # RTINIT = INITIAL TARGET VECTOR -# _ _ _ -# RTEAST = UNITW * RTINIT -# _ _ _ -# RTNORM = RTEAST * UNITW +# - - - +# RTEAST = UNITW*RTINIT +# - - - +# RTNORM = RTEAST*UNITW # # FOR CONTINUOUS UPDATING, ONLY ONE ENTRY TO EARROT1 IS REQUIRED, WITH SUBSEQUENT ENTRIES AT EARROT2. -# # CALLING SEQUENCE: FIRST CALL SUBSEQUENT CALL # STCALL DTEAROT STCALL DTEAROT # EARROT1 EARROT2 @@ -329,21 +328,16 @@ CLOG2/32 2DEC .0216608494 # PUSHLOC = PDL+0, ARBITRARY. 6 LOCATIONS USED. # # SUBROUTINES USED: NONE -# # NORMAL EXIT MODES: RVQ -# # ALARMS: NONE -# -# OUTPUT: RTEAST (-1) .5 UNIT VECTOR EAST, COMPNT OF RTINIT LEFT BY FIRST CALL -# RTNORM (-1) .5 UNIT VECTOR NORML, COMPNT OF RTINIT LEFT BY FIRST CALL -# RT (-1) .5 UNIT TARGET VECTOR, ROTATED LEFT BY ALL CALLS -# DTEAROT (-28) CS MAY BE CHANGED BY EARROT2, IF OVER 1 DAY -# +# OUTPUT: RTEAST (-1) .5 UNIT VECTOR EAST, COMPNT OF RTINIT LEFT BY FIRST CALL +# RTNORM (-1) .5 UNIT VECTOR NORML, COMPNT OF RTINIT LEFT BY FIRST CALL +# RT (-1) .5 UNIT TARGET VECTOR, ROTATED LEFT BY ALL CALLS +# DTEAROT (-28) CS MAY BE CHANGED BY EARROT2, IF OVER 1 DAY # ERASABLE INITIALIZATION REQUIRED: -# UNITW (0) UNIT POLAR VECTOR PAD LOADED -# RTINIT (-1) .5 UNIT INITIAL TARGET VECTOR LEFT BY ENTRY -# DTEAROT (-28) CS TIME OF FLIGHT LEFT BY CALLER -# +# UNITW (0) UNIT POLAR VECTOR PAD LOADED +# RTINIT (-1) .5 UNIT INITIAL TARGET VECTOR LEFT BY ENTRY +# DTEAROT (-28) CS TIME OF FLIGHT LEFT BY CALLER # DEBRIS: QPRET, PDL+0 ... PDL+5 # Page 294 EBANK= RTINIT @@ -370,7 +364,7 @@ EARROT2 BOVB DDV SIN VXSC RTEAST # .5 UNIT VAD VSL1 - VAD UNIT # INSURE THAT RT IS "UNIT". + VAD UNIT # INSURE THAT RT IS 'UNIT'. RTINIT # .5 UNIT STORE RT # .5 UNIT TARGET VECTOR @@ -407,12 +401,15 @@ NB1NB2 2DEC +.8431756920 B-1 2DEC -.5376381241 B-1 2DEC 0 2DEC +.8431756920 B-1 + # Page 296 10DEGS- DEC 3600 -270DEG OCT 60000 # SHAFT 270 DEGREES 25 COMP. + +270DEG OCT 60000 # SHAFT 270 DEGREES 2S COMP. OCT 00000 + 20DEGS- DEC -07199 DEC -00000 + 20DEG- DEC 03600 DEC 00000 -