Source Code

013250,000001: # Copyright: Public domain. 013251,000002: # Filename: LEM_GEOMETRY.agc 013252,000003: # Purpose: A section of Luminary 1C, revision 131. 013253,000004: # It is part of the source code for the Lunar Module's (LM) 013254,000005: # Apollo Guidance Computer (AGC) for Apollo 13 and Apollo 14. 013255,000006: # This file is intended to be a faithful transcription, except 013256,000007: # that the code format has been changed to conform to the 013257,000008: # requirements of the yaYUL assembler rather than the 013258,000009: # original YUL assembler. 013259,000010: # Reference: pp. 327-332 of 1729.pdf. 013260,000011: # Contact: Ron Burkey <info@sandroid.org>. 013261,000012: # Website: www.ibiblio.org/apollo/index.html 013262,000013: # Mod history: 05/10/03 RSB. Began transcribing. 013263,000014: # 05/14/05 RSB Corrected website reference above. 013264,000015: 013265,000016: # Page 327 013266,000017: 23,2041 BANK 23 013267,000018: 13,2000 SETLOC LEMGEOM 013268,000019: 13,2000 BANK 013269,000020: 013270,000021: 13,2070 30,2000 SBANK= LOWSUPER 013271,000022: 13,2070 E5,1642 EBANK= XSM 013272,000023: 013273,000024: # THESE TWO ROUTINES COMPUTE THE ACTUAL STATE VECTOR FOR LM,CSM BY ADDING 013274,000025: # THE CONIC R,V AND THE DEVIATIONS R,V. THE STATE VECTORS ARE CONVERTED TO 013275,000026: # METERS B-29 AND METERS/CSEC B-7 AND STORED APPROPIRATELY IN RN,VN OR 013276,000027: # R-OTHER,V-OTHER FOR DOWNLINK. THE ROUTINES' NAMES ARE SWITCHED IN THE 013277,000028: # OTHER VEHICLE'S COMPUTER. 013278,000029: 013279,000030: # INPUT 013280,000031: # STATE VECTOR IN TEMPORARY STORAGE AREA 013281,000032: # IF STATE VECTOR IS SCALED POS B27 AND VEL B5 013282,000033: # SET X2 TO +2 013283,000034: # IF STATE VECTOR IS SCALED POS B29 AND VEL B7 013284,000035: # SET X2 TO 0 013285,000036: 013286,000037: # OUTPUT 013287,000038: # R(T) IN RN, V(T) IN VN, T IN PIPTIME 013288,000039: # OR 013289,000040: # R(T) IN R-OTHER, V(T) IN V-OTHER (T IS DEFINED BY T-OTHER) 013290,000041: 013291,000042: 13,2070 COUNT* $$/GEOM 013292,000043: 13,2070 43414 SVDWN2 BOF RVQ # SW=1=AVETOMID DOING W-MATRIX INTEG. 013293,000044: 13,2071 04756 AVEMIDSW 013294,000045: 13,2072 26073 +1 013295,000046: 13,2073 53775 VLOAD VSL* 013296,000047: 13,2074 01521 TDELTAV 013297,000048: 13,2075 57605 0 -7,2 013298,000049: 13,2076 53655 VAD VSL* 013299,000050: 13,2077 01535 RCV 013300,000051: 13,2100 57576 0,2 013301,000052: 13,2101 25220 STOVL RN 013302,000053: 13,2102 01527 TNUV 013303,000054: 13,2103 53257 VSL* VAD 013304,000055: 13,2104 57602 0 -4,2 013305,000056: 13,2105 01543 VCV 013306,000057: 13,2106 77657 VSL* 013307,000058: 13,2107 57576 0,2 013308,000059: 13,2110 15226 STODL VN 013309,000060: 13,2111 01517 TET 013310,000061: 13,2112 01234 STORE PIPTIME 013311,000062: 13,2113 77616 RVQ 013312,000063: # Page 328 013313,000064: 13,2114 53775 SVDWN1 VLOAD VSL* 013314,000065: 13,2115 01521 TDELTAV 013315,000066: 13,2116 57605 0 -7,2 013316,000067: 13,2117 53655 VAD VSL* 013317,000068: 13,2120 01535 RCV 013318,000069: 13,2121 57576 0,2 013319,000070: 13,2122 25720 STOVL R-OTHER 013320,000071: 13,2123 01527 TNUV 013321,000072: 13,2124 53257 VSL* VAD 013322,000073: 13,2125 57602 0 -4,2 013323,000074: 13,2126 01543 VCV 013324,000075: 13,2127 77657 VSL* 013325,000076: 13,2130 57576 0,2 013326,000077: 13,2131 01726 STORE V-OTHER 013327,000078: 13,2132 77616 RVQ 013328,000079: 013329,000080: # Page 329 013330,000081: # THE FOLLOWING ROUTINE TAKES A HALF UNIT TARGET VECTOR REFERRED TO NAV BASE COORDINATES AND FINDS BOTH 013331,000082: # GIMBAL ORIENTATIONS AT WHICH THE RR MIGHT SIGHT THE TARGET. THE GIMBAL ANGLES CORRESPONDING TO THE PRESENT MODE 013332,000083: # ARE LEFT IN MODEA AND THOSE WHICH WOULD BE USED AFTER A REMODE IN MODEB. THIS ROUTINE ASSUMES MODE 1 IS TRUNNION 013333,000084: # ANGLE LESS THAN 90 DEGS IN ABS VALUE WITH ARBITRARY SHAFT, WITH A CORRESPONDING DEFINITION FOR MODE 2. MODE 013334,000085: # SELECTION AND LIMIT CHECKING ARE DONE ELSEWHERE. 013335,000086: 013336,000087: # THE MODE 1 CONFIGURATION IS CALCULATED FROM THE VECTOR AND THEN MODE 2 IS FOUND USING THE RELATIONS 013337,000088: 013338,000089: # S(2) = 180 + S(1) 013339,000090: # T(2) = 180 - T(1) 013340,000091: 013341,000092: # THE VECTOR ARRIVES IN MPAC WHERE TRG*SMNG OR *SMNB* WILL HAVE LEFT IT. 013342,000093: 013343,000094: 13,2133 00041 RRANGLES STORE 32D 013344,000095: 13,2134 57545 DLOAD DCOMP # SINCE WE WILL FIND THE MODE 1 SHAFT 013345,000096: 13,2135 00043 34D # ANGLE LATER, WE CAN FIND THE MODE 1 013346,000097: 13,2136 67401 SETPD ASIN # TRUNNION BY SIMPLY TAKING THE ARCSIN OF 013347,000098: 13,2137 00001 0 # THE Y COMPONENT, THE ASIN GIVIN AN 013348,000099: 13,2140 44206 PUSH BDSU # ANSWER WHOSE ABS VAL IS LESS THAN 90 DEG. 013349,000100: 13,2141 24005 LODPHALF 013350,000101: 13,2142 14005 STODL 4 # MODE 2 TRUNNION TO 4. 013351,000102: 13,2143 24007 LO6ZEROS 013352,000103: 13,2144 24043 STOVL 34D # UNIT THE PROJECTION OF THE VECTOR 013353,000104: 13,2145 00041 32D # IN THE X-Z PLANE 013354,000105: 13,2146 41056 UNIT BOVB # IF OVERFLOW, TARGET VECTOR IS ALONG Y 013355,000106: 13,2147 52432 LUNDESCH # CALL FOR MANEUVER UNLESS ON LUNAR SURF 013356,000107: 13,2150 14041 STODL 32D # PROJECTION VECTOR. 013357,000108: 13,2151 00041 32D 013358,000109: 13,2152 44142 SR1 STQ 013359,000110: 13,2153 00051 S2 013360,000111: 13,2154 14023 STODL SINTH # USE ARCTRIG SINCE SHAFT COULD BE ARG. 013361,000112: 13,2155 00045 36D 013362,000113: 13,2156 77742 SR1 013363,000114: 13,2157 34021 STCALL COSTH 013364,000115: 13,2160 47322 ARCTRIG 013365,000116: # Page 331 013366,000117: 13,2161 43206 PUSH DAD # MODE 1 SHAFT TO 2. 013367,000118: 13,2162 24005 LODPHALF 013368,000119: 13,2163 24007 STOVL 6 013369,000120: 13,2164 00005 4 013370,000121: 13,2165 77634 RTB # FIND MODE 2 CDU ANGLES. 013371,000122: 13,2166 21636 2V1STO2S 013372,000123: 13,2167 25111 STOVL MODEB 013373,000124: 13,2170 00001 0 013374,000125: 13,2171 77634 RTB # MODE 1 ANGLES TO MODE A. 013375,000126: 13,2172 21636 2V1STO2S 013376,000127: 13,2173 01107 STORE MODEA 013377,000128: 13,2174 77776 EXIT 013378,000129: 013379,000130: 13,2175 40110 CS RADMODES # SWAP MODEA AND MODEB IF RR IN MODE 2. 013380,000131: 13,2176 74740 MASK ANTENBIT 013381,000132: 13,2177 10000 CCS A 013382,000133: 13,2200 12204 TCF +4 013383,000134: 013384,000135: 13,2201 53107 DXCH MODEA 013385,000136: 13,2202 53111 DXCH MODEB 013386,000137: 13,2203 53107 DXCH MODEA 013387,000138: 013388,000139: 13,2204 06042 TC INTPRET 013389,000140: 13,2205 77650 GOTO 013390,000141: 13,2206 00051 S2 013391,000142: # Page 331 013392,000143: # GIVEN RR TRUNNION AND SHAFT (T,S) IN TANGNB,+1, FIND THE ASSOCIATED 013393,000144: # LINE OF SIGHT IN NAV BASE AXES. THE HALF UNIT VECTOR, .5(SIN(S)COS(T), 013394,000145: # -SIN(T),COS(S)COS(T)) IS LEFT IN MPAC AND 32D. 013395,000146: 013396,000147: 23,2000 SETLOC INFLIGHT 013397,000148: 23,2000 BANK 013398,000149: 013399,000150: 23,2041 COUNT* $$/GEOM 013400,000151: 013401,000152: 23,2041 47135 RRNB SLOAD RTB 013402,000153: 23,2042 03753 TANGNB 013403,000154: 23,2043 21577 CDULOGIC 013404,000155: 23,2044 41401 SETPD PUSH # TRUNNION ANGLE TO 0 013405,000156: 23,2045 00001 0 013406,000157: 23,2046 57556 SIN DCOMP 013407,000158: 23,2047 14043 STODL 34D # Y COMPONENT 013408,000159: 013409,000160: 23,2050 41546 COS PUSH # .5 COS(T) TO 0 013410,000161: 23,2051 47135 SLOAD RTB 013411,000162: 23,2052 03754 TANGNB +1 013412,000163: 23,2053 21577 CDULOGIC 013413,000164: 23,2054 71406 RRNB1 PUSH COS # SHAFT ANGLE TO 2 013414,000165: 23,2055 72405 DMP SL1 013415,000166: 23,2056 00001 0 013416,000167: 23,2057 14045 STODL 36D # Z COMPONENT 013417,000168: 013418,000169: 23,2060 41356 SIN DMP 013419,000170: 23,2061 77752 SL1 013420,000171: 23,2062 24041 STOVL 32D 013421,000172: 23,2063 00041 32D 013422,000173: 23,2064 77616 RVQ 013423,000174: 013424,000175: # THIS ENTRY TO RRNB REQUIRES THE TRUNNION AND SHAFT ANGLES IN MPAC AND MPAC +1 RESPECTIVELY 013425,000176: 013426,000177: 23,2065 14025 RRNBMPAC STODL 20D # SAVE SHAFT CDU IN 21. 013427,000178: 23,2066 00155 MPAC # SET MODE TO DP. (THE PRECEEDING STORE 013428,000179: # MAY BE DP, TP OR VECTOR.) 013429,000180: 23,2067 40234 RTB SETPD 013430,000181: 23,2070 21577 CDULOGIC 013431,000182: 23,2071 00001 0 013432,000183: 23,2072 73406 PUSH SIN # TRUNNION ANGLE TO 0 013433,000184: 23,2073 77676 DCOMP 013434,000185: 23,2074 14043 STODL 34D # Y COMPONENT 013435,000186: 23,2075 41546 COS PUSH # .5COS(T) TO 0 013436,000187: 23,2076 47135 SLOAD RTB # PICK UP CDU'S. 013437,000188: 23,2077 00026 21D 013438,000189: 23,2100 21577 CDULOGIC 013439,000190: 23,2101 77650 GOTO 013440,000191: 23,2102 46054 RRNB1 013441,000192: # Page 332 013442,000193: # (This page has nothing on it.) 013443,000194: 013444,000195: End of include-file LEM_GEOMETRY.agc. Parent file is MAIN.agc