Source Code

058712,000001: # Copyright: Public domain. 058713,000002: # Filename: INFLIGHT_ALIGNMENT_ROUTINES.agc 058714,000003: # Purpose: Part of the source code for Colossus 2A, AKA Comanche 055. 058715,000004: # It is part of the source code for the Command Module's (CM) 058716,000005: # Apollo Guidance Computer (AGC), for Apollo 11. 058717,000006: # Assembler: yaYUL 058718,000007: # Contact: Ron Burkey <info@sandroid.org>. 058719,000008: # Website: www.ibiblio.org/apollo. 058720,000009: # Pages: 1355-1364 058721,000010: # Mod history: 2009-05-14 RSB Adapted from the Colossus249/ file of the 058722,000011: # same name, using Comanche055 page images. 058723,000012: 058724,000013: # This source code has been transcribed or otherwise adapted from digitized 058725,000014: # images of a hardcopy from the MIT Museum. The digitization was performed 058726,000015: # by Paul Fjeld, and arranged for by Deborah Douglas of the Museum. Many 058727,000016: # thanks to both. The images (with suitable reduction in storage size and 058728,000017: # consequent reduction in image quality as well) are available online at 058729,000018: # www.ibiblio.org/apollo. If for some reason you find that the images are 058730,000019: # illegible, contact me at info@sandroid.org about getting access to the 058731,000020: # (much) higher-quality images which Paul actually created. 058732,000021: 058733,000022: # Notations on the hardcopy document read, in part: 058734,000023: 058735,000024: # Assemble revision 055 of AGC program Comanche by NASA 058736,000025: # 2021113-051. 10:28 APR. 1, 1969 058737,000026: 058738,000027: # This AGC program shall also be referred to as 058739,000028: # Colossus 2A 058740,000029: 058741,000030: # Page 1355 058742,000031: 22,3510 BANK 22 058743,000032: 23,2000 SETLOC INFLIGHT 058744,000033: 23,2000 BANK 058745,000034: 058746,000035: 23,3205 E5,1671 EBANK= XSM 058747,000036: 058748,000037: # CALCGTA COMPUTES THE GYRO TORQUE ANGLES REQUIRED TO BRING THE STABLE MEMBER INTO THE DESIRED ORIENTATION. 058749,000038: 058750,000039: # THE INPUT IS THE DESIRED STABLE MEMBER COORDINATES REFERRED TO PRESENT STABLE MEMBER COORDINATES. THE THREE 058751,000040: # HALF-UNIT VECTORS ARE STORED AT XDC, YDC, AND ZDC. 058752,000041: 058753,000042: # THE OUTPUTS ARE THE THREE GYRO TORQUE ANGLES TO BE APPLIED TO THE Y, Z, AND X GYROS AND ARE STORED DP AT IGC, 058754,000043: # MGC, AND OGC RESPECTIVELY. 058755,000044: 058756,000045: 23,3205 COUNT 23/INFLT 058757,000046: 058758,000047: 23,3205 71220 CALCGTA ITA DLOAD # PUSHDOWN 00-03, 16D-27D, 34D-37D 058759,000048: 23,3206 00051 S2 # XDC = (XD1 XD2 XD3) 058760,000049: 23,3207 02714 XDC # YDC = (YD1 YD2 YD3) 058761,000050: 23,3210 65325 PDDL PDDL # ZDC = (ZD1 ZD2 ZD3) 058762,000051: 23,3211 15335 HI6ZEROS 058763,000052: 23,3212 02720 XDC +4 058764,000053: 23,3213 55476 DCOMP VDEF 058765,000054: 23,3214 77656 UNIT 058766,000055: 23,3215 14027 STODL ZPRIME # ZP = UNIT(-XD3 0 XD1) = (ZP1 ZP2 ZP3) 058767,000056: 23,3216 00027 ZPRIME 058768,000057: 058769,000058: 23,3217 77742 SR1 058770,000059: 23,3220 14023 STODL SINTH # SIN(IGC) = ZP1 058771,000060: 23,3221 00033 ZPRIME +4 058772,000061: 23,3222 77742 SR1 058773,000062: 23,3223 34021 STCALL COSTH # COS(IGC) = ZP3 058774,000063: 23,3224 47256 ARCTRIG 058775,000064: 058776,000065: 23,3225 16762 STODL IGC # Y GYRO TORQUING ANGLE FRACTION OF REV. 058777,000066: 23,3226 02716 XDC +2 058778,000067: 23,3227 77742 SR1 058779,000068: 23,3230 14023 STODL SINTH # SIN(MGC) = XD2 058780,000069: 23,3231 00027 ZPRIME 058781,000070: 058782,000071: 23,3232 65205 DMP PDDL 058783,000072: 23,3233 02720 XDC +4 # PD00 = (ZP1)(XD3) 058784,000073: 23,3234 00033 ZPRIME +4 058785,000074: 058786,000075: 23,3235 45205 DMP DSU 058787,000076: 23,3236 02714 XDC # MPAC = (ZP3)(XD1) 058788,000077: 23,3237 77626 STADR 058789,000078: 23,3240 43756 STCALL COSTH # COS(MGC) = MPAC - PD00 058790,000079: 23,3241 47256 ARCTRIG 058791,000080: # Page 1356 058792,000081: 23,3242 26764 STOVL MGC # Z GYRO TORQUING ANGLE FRACTION OF REV. 058793,000082: 23,3243 00027 ZPRIME 058794,000083: 23,3244 77641 DOT 058795,000084: 23,3245 02730 ZDC 058796,000085: 23,3246 24021 STOVL COSTH # COS(OGC) = ZP . ZDC 058797,000086: 23,3247 00027 ZPRIME 058798,000087: 23,3250 77641 DOT 058799,000088: 23,3251 02722 YDC 058800,000089: 23,3252 34023 STCALL SINTH # SIN(OGC) = ZP . YDC 058801,000090: 23,3253 47256 ARCTRIG 058802,000091: 058803,000092: 23,3254 36760 STCALL OGC # X GYRO TORQUING ANGLE FRACTION OF REV. 058804,000093: 23,3255 00051 S2 058805,000094: 058806,000095: # Page 1357 058807,000096: # ARCTRIG COMPUTES AN ANGLE GIVEN THE SINE AND COSINE OF THIS ANGLE. 058808,000097: 058809,000098: # THE INPUTS ARE SIN/4 AND COS/4 STORED DP AT SINTH AND COSTH. 058810,000099: 058811,000100: # THE OUTPUT IS THE CALCULATED ANGLE BETWEEN +.5 AND -.5 REVOLUTIONS AND STORED AT THETA. THE OUTPUT IS ALSO 058812,000101: # AVAILABLE AT MPAC. 058813,000102: 058814,000103: 23,3256 51545 ARCTRIG DLOAD ABS # PUSHDOWN 16D-21D 058815,000104: 23,3257 00023 SINTH 058816,000105: 23,3260 50025 DSU BMN 058817,000106: 23,3261 07474 QTSN45 # ABS(SIN/4) - SIN(45)/4 058818,000107: 23,3262 47271 TRIG1 # IF (-45,45) OR (135,-135) 058819,000108: 058820,000109: 23,3263 72545 DLOAD SL1 # (45,135) OR (-135,-45) 058821,000110: 23,3264 00021 COSTH 058822,000111: 23,3265 75326 ACOS SIGN 058823,000112: 23,3266 00023 SINTH 058824,000113: 23,3267 00025 STORE THETA # X = ARCCOS(COS) WITH SIGN(SIN) 058825,000114: 23,3270 77616 RVQ 058826,000115: 058827,000116: 23,3271 72545 TRIG1 DLOAD SL1 # (-45,45) OR (135,-135) 058828,000117: 23,3272 00023 SINTH 058829,000118: 23,3273 77736 ASIN 058830,000119: 23,3274 14025 STODL THETA # X = ARCSIN(SIN) WITH SIGN(SIN) 058831,000120: 23,3275 00021 COSTH 058832,000121: 23,3276 77640 BMN 058833,000122: 23,3277 47302 TRIG2 # IF (135,-135) 058834,000123: 058835,000124: 23,3300 43545 DLOAD RVQ 058836,000125: 23,3301 00025 THETA # X = ARCSIN(SIN) (-45,45) 058837,000126: 058838,000127: 23,3302 75345 TRIG2 DLOAD SIGN # (135,-135) 058839,000128: 23,3303 15333 HIDPHALF 058840,000129: 23,3304 00023 SINTH 058841,000130: 23,3305 77625 DSU 058842,000131: 23,3306 00025 THETA 058843,000132: 23,3307 00025 STORE THETA # X = .5 WITH SIGN(SIN) - ARCSIN(SIN) 058844,000133: 23,3310 77616 RVQ # (+) - (+) OR (-) - (-) 058845,000134: 058846,000135: # Page 1358 058847,000136: # SMNB, NBSM, AND AXISROT, WHICH USED TO APPEAR HERE, HAVE BEEN 058848,000137: # COMBINED IN A ROUTINE CALLED AX*SR*T, WHICH APPEARS AMONG THE POWERED 058849,000138: # FLIGHT SUBROUTINES. 058850,000139: 058851,000140: # Page 1359 058852,000141: # CALCGA COMPUTES THE CDU DRIVING ANGLES REQUIRED TO BRING THE STABLE MEMBER INTO THE DESIRED ORIENTATION. 058853,000142: 058854,000143: # THE INPUTS ARE 1) THE NAVIGATION BASE COORDINATES REFERRED TO ANY COORDINATE SYSTEM. THE THREE HALF-UNIT 058855,000144: # VECTORS ARE STORED AT XNB, YNB, AND ZNB. 2) THE DESIRED STABLE MEMBER COORDINATES REFERRED TO THE SAME 058856,000145: # COORDINATE SYSTEM ARE STORED AT XSM, YSM, AND ZSM. 058857,000146: 058858,000147: # THE OUTPUTS ARE THE THREE CDU DRIVING ANGLES AND ARE STORED SP AT THETAD, THETAD +1, AND THETAD +2. 058859,000148: 058860,000149: 23,3311 77601 CALCGA SETPD # PUSHDOWN 00-05, 16D-21D, 34D-37D 058861,000150: 23,3312 00001 0 058862,000151: 23,3313 47375 VLOAD VXV 058863,000152: 23,3314 02714 XNB # XNB = OGA (OUTER GIMBAL AXIS) 058864,000153: 23,3315 02700 YSM # YSM = IGA (INNER GIMBAL AXIS) 058865,000154: 23,3316 41456 UNIT PUSH # PD0 = UNIT(OGA X IGA) = MGA 058866,000155: 058867,000156: 23,3317 44041 DOT ITA 058868,000157: 23,3320 02730 ZNB 058869,000158: 23,3321 00051 S2 058870,000159: 23,3322 24021 STOVL COSTH # COS(OG) = MGA . ZNB 058871,000160: 23,3323 00001 0 058872,000161: 23,3324 77641 DOT 058873,000162: 23,3325 02722 YNB 058874,000163: 23,3326 34023 STCALL SINTH # SIN(OG) = MGA . YNB 058875,000164: 23,3327 47256 ARCTRIG 058876,000165: 23,3330 26760 STOVL OGC 058877,000166: 23,3331 00001 0 058878,000167: 058879,000168: 23,3332 50235 VXV DOT # PROVISION FOR MG ANGLE OF 90 DEGREES 058880,000169: 23,3333 02714 XNB 058881,000170: 23,3334 02700 YSM 058882,000171: 23,3335 77752 SL1 058883,000172: 23,3336 24021 STOVL COSTH # COS(MG) = IGA . (MGA X OGA) 058884,000173: 23,3337 02700 YSM 058885,000174: 23,3340 77641 DOT 058886,000175: 23,3341 02714 XNB 058887,000176: 23,3342 34023 STCALL SINTH # SIN(MG) = IGA . OGA 058888,000177: 23,3343 47256 ARCTRIG 058889,000178: 23,3344 02764 STORE MGC 058890,000179: 058891,000180: 23,3345 45246 ABS DSU 058892,000181: 23,3346 07476 .166... 058893,000182: 23,3347 77644 BPL 058894,000183: 23,3350 47371 GIMLOCK1 # IF ANGLE GREATER THAN 60 DEGREES 058895,000184: 058896,000185: 23,3351 50375 CALCGA1 VLOAD DOT 058897,000186: 23,3352 02706 ZSM 058898,000187: 23,3353 00001 0 058899,000188: 23,3354 24021 STOVL COSTH # COS(IG) = ZSM . MGA 058900,000189: 23,3355 02672 XSM 058901,000190: # Page 1360 058902,000191: 23,3356 45441 DOT STADR 058903,000192: 23,3357 43754 STCALL SINTH # SIN(IG) = XSM . MGA 058904,000193: 23,3360 47256 ARCTRIG 058905,000194: 058906,000195: 23,3361 26762 STOVL IGC 058907,000196: 23,3362 02760 OGC 058908,000197: 23,3363 43034 RTB BONCLR 058909,000198: 23,3364 45552 V1STO2S 058910,000199: 23,3365 00200 CPHIFLAG 058911,000200: 23,3366 00051 S2 058912,000201: 23,3367 35156 STCALL THETAD 058913,000202: 23,3370 00051 S2 058914,000203: 058915,000204: 23,3371 77776 GIMLOCK1 EXIT 058916,000205: 23,3372 05650 TC ALARM 058917,000206: 23,3373 00401 OCT 00401 058918,000207: 23,3374 05546 TC UPFLAG # GIMBAL LOCK HAS OCCURRED 058919,000208: 23,3375 00056 ADRES GLOKFAIL 058920,000209: 058921,000210: 23,3376 06006 TC INTPRET 058922,000211: 23,3377 77650 GOTO 058923,000212: 23,3400 47351 CALCGA1 058924,000213: 058925,000214: # Page 1361 058926,000215: # AXISGEN COMPUTES THE COORDINATES OF ONE COORDINATE SYSTEM REFERRED TO ANOTHER COORDINATE SYSTEM. 058927,000216: 058928,000217: # THE INPUTS ARE 1) THE STAR1 VECTOR REFERRED TO COORDINATE SYSTEM A STORED AT STARAD. 2) THE STAR2 VECTOR 058929,000218: # REFERRED TO COORDINATE SYSTEM A STORED AT STARAD +6. 3) THE STAR1 VECTOR REFERRED TO COORDINATE SYSTEM B STORED 058930,000219: # AT LOCATION 6 OF THE VAC AREA. 4) THE STAR2 VECTOR REFERRED TO COORDINATE SYSTEM B STORED AT LOCATION 12D OF 058931,000220: # THE VAC AREA. 058932,000221: 058933,000222: # THE OUTPUT DEFINES COORDINATE SYSTEM A REFERRED TO COORDINATE SYSTEM B. THE THREE HALF-UNIT VECTORS ARE STORED 058934,000223: # AT LOCATIONS XDC, XDC +6, XDC +12D, AND STARAD, STARAD +6, STARAD +12D. 058935,000224: 058936,000225: 23,3401 66370 AXISGEN AXT,1 SSP # PUSHDOWN 00-30D, 34D-37D 058937,000226: 23,3402 02743 STARAD +6 058938,000227: 23,3403 00051 S1 058939,000228: 23,3404 02727 STARAD -6 058940,000229: 058941,000230: 23,3405 77601 SETPD 058942,000231: 23,3406 00001 0 058943,000232: 23,3407 46773 AXISGEN1 VLOAD* VXV* # 06D UA = S1 058944,000233: 23,3410 02752 STARAD +12D,1 # STARAD +00D UB = S1 058945,000234: 23,3411 02760 STARAD +18D,1 058946,000235: 23,3412 77656 UNIT # 12D VA = UNIT(S1 X S2) 058947,000236: 23,3413 06760 STORE STARAD +18D,1 # STARAD +06D VB = UNIT(S1 X S2) 058948,000237: 23,3414 77773 VLOAD* 058949,000238: 23,3415 02752 STARAD +12D,1 058950,000239: 058951,000240: 23,3416 76433 VXV* VSL1 058952,000241: 23,3417 02760 STARAD +18D,1 # 18D WA = UA X VA 058953,000242: 23,3420 06766 STORE STARAD +24D,1 # STARAD +12D WB = UB X VB 058954,000243: 058955,000244: 23,3421 77700 TIX,1 058956,000245: 23,3422 47407 AXISGEN1 058957,000246: 058958,000247: 23,3423 66160 AXC,1 SXA,1 058959,000248: 23,3424 00006 6 058960,000249: 23,3425 00036 30D 058961,000250: 058962,000251: 23,3426 66370 AXT,1 SSP 058963,000252: 23,3427 00022 18D 058964,000253: 23,3430 00051 S1 058965,000254: 23,3431 00006 6 058966,000255: 058967,000256: 23,3432 66374 AXT,2 SSP 058968,000257: 23,3433 00006 6 058969,000258: 23,3434 00052 S2 058970,000259: 23,3435 00002 2 058971,000260: 058972,000261: 23,3436 76720 AXISGEN2 XCHX,1 VLOAD* 058973,000262: 23,3437 00036 30D # X1=-6 X2=+6 X1=-6 X2=+4 X1=-6 X2=+2 058974,000263: 23,3440 00001 0,1 058975,000264: 058976,000265: # Page 1362 058977,000266: 23,3441 62757 VXSC* PDVL* # J=(UA)(UB1) J=(UA)(UB2) J=(UA)(UB3) 058978,000267: 23,3442 75033 STARAD +6,2 058979,000268: 23,3443 00007 6,1 058980,000269: 23,3444 77757 VXSC* 058981,000270: 23,3445 75025 STARAD +12D,2 058982,000271: 23,3446 30031 STOVL* 24D # K=(VA)(VB1) J=(VA)(VB2) J=(VA)(VB3) 058983,000272: 23,3447 00015 12D,1 058984,000273: 058985,000274: 23,3450 53357 VXSC* VAD 058986,000275: 23,3451 75017 STARAD +18D,2 # L=(WA)(WB1) J=(WA)(WB2) J=(WA)(WB3) 058987,000276: 23,3452 76455 VAD VSL1 058988,000277: 23,3453 00031 24D 058989,000278: 23,3454 53520 XCHX,1 UNIT 058990,000279: 23,3455 00036 30D 058991,000280: 23,3456 06736 STORE XDC +18D,1 # XDC = L+J+K YDC = L+J+K ZDC = L+J+K 058992,000281: 058993,000282: 23,3457 77700 TIX,1 058994,000283: 23,3460 47461 AXISGEN3 058995,000284: 058996,000285: 23,3461 77704 AXISGEN3 TIX,2 058997,000286: 23,3462 47436 AXISGEN2 058998,000287: 058999,000288: 23,3463 77775 VLOAD 059000,000289: 23,3464 02714 XDC 059001,000290: 23,3465 26736 STOVL STARAD 059002,000291: 23,3466 02722 YDC 059003,000292: 23,3467 26744 STOVL STARAD +6 059004,000293: 23,3470 02730 ZDC 059005,000294: 23,3471 02752 STORE STARAD +12D 059006,000295: 059007,000296: 23,3472 77616 RVQ 059008,000297: 059009,000298: # Page 1363 059010,000299: 23,3473 05520 26075 QTSN45 2DEC .1768 059011,000300: 23,3475 05252 25253 .166... 2DEC .1666666667 059012,000301: 059013,000302: # Page 1364 (empty page) 059014,000303: 059015,000304: End of include-file INFLIGHT_ALIGNMENT_ROUTINES.agc. Parent file is MAIN.agc