Source Code
|
This is a reconstructed version of Luminary 130, the initial AGC program released
in November 1969 for the Apollo 13 LM. Three more releases
followed before the flown revision was finally manufactured in February 1970.
This reconstruction was created from a previous transcription of the original listing of
Luminary 131, combined with Luminary memo #129 which describes the small difference
between the Luminary 130 and 131. The reconstructed source code was verified by
matching memory-bank checksums to those listed for Luminary 130 in drawing 2021152G.
In this source code, program comments from the original (Luminary 131) code are
prefixed with '#', while those added later by the Virtual AGC project are prefixed
with '##'.
|
013679,000002: ## Copyright: Public domain.
013680,000003: ## Filename: IMU_COMPENSATION_PACKAGE.agc
013681,000004: ## Purpose: A section of the reconstructed source code for Luminary 130.
013682,000005: ## This was the original program released for the Apollo 13 LM,
013683,000006: ## although several more revisions would follow. It has been
013684,000007: ## reconstructed from a listing of Luminary 131, from which it
013685,000008: ## differs on only two lines in P70-P71. The difference is
013686,000009: ## described in detail in Luminary memo #129, which was used
013687,000010: ## to perform the reconstruction. This file is intended to be a
013688,000011: ## faithful reconstruction, except that the code format has been
013689,000012: ## changed to conform to the requirements of the yaYUL assembler
013690,000013: ## rather than the original YUL assembler.
013691,000014: ## Reference: pp. 328-339
013692,000015: ## Contact: Ron Burkey <info@sandroid.org>.
013693,000016: ## Website: www.ibiblio.org/apollo/index.html
013694,000017: ## Mod history: 05/10/03 RSB. Began transcribing.
013695,000018: ## 05/14/05 RSB Corrected website reference above.
013696,000019: ## 2016-12-30 RSB Backported BYRO->GYRO from Colossus 237.
013697,000020: ## (There's lots more that needs to be backported,
013698,000021: ## but I found this one particularly annoying.)
013699,000022: ## 2017-01-06 RSB Page numbers now agree with those on the
013700,000023: ## original harcopy, as opposed to the PDF page
013701,000024: ## numbers in 1701.pdf.
013702,000025: ## 2017-02-23 RSB Proofed comment text using octopus/ProoferComments.
013703,000026: ## 2017-03-07 RSB Comment-text fixes noted in proofing Luminary 116.
013704,000027: ## 2018-09-04 MAS Copied from Luminary 131 for Luminary 130.
013705,000028:
|
|
Page 328
|
013707,000030: 07,2666 BANK 7
013708,000031: 06,2000 SETLOC IMUCOMP
013709,000032: 06,2000 BANK
013710,000033:
013711,000034: 06,3271 E3,1460 EBANK= NBDX
013712,000035:
013713,000036: 06,3271 COUNT* $$/ICOMP
013714,000037: 06,3271 33537 1/PIPA CAF LGCOMP # SAVE EBANK OF CALLING PROGRAM
013715,000038: 06,3272 56003 XCH EBANK
013716,000039: 06,3273 54163 TS MODE
013717,000040:
013718,000041: 06,3274 11477 CCS GCOMPSW # BYPASS IF GCOMPSW NEGATIVE
013719,000042: 06,3275 13300 TCF +3
013720,000043: 06,3276 13300 TCF +2
013721,000044: 06,3277 13361 TCF IRIG1 # RETURN
013722,000045:
013723,000046: 06,3300 34751 1/PIPA1 CAF FOUR # PIPAZ, PIPAY, PIPAX
013724,000047: 06,3301 54132 TS BUF +2
013725,000048:
013726,000049: 06,3302 50132 INDEX BUF +2
013727,000050: 06,3303 31453 CA PIPASCF # (P.P.M.) X 2(-9)
013728,000051: 06,3304 00006 EXTEND
013729,000052: 06,3305 50132 INDEX BUF +2
013730,000053: 06,3306 70324 MP DELVX # (PP) X 2(+14) NOW (PIPA PULSES) X 2(+5)
013731,000054: 06,3307 54002 TS Q # SAVE MAJOR PART
013732,000055:
013733,000056: 06,3310 30001 CA L # MINOR PART
013734,000057: 06,3311 00006 EXTEND
013735,000058: 06,3312 74746 MP BIT6 # SCALE 2(+9) SHIFT RIGHT 9
013736,000059:
013737,000060: 06,3313 50132 INDEX BUF +2
013738,000061: 06,3314 54325 TS DELVX +1 # FRACTIONAL PIPA PULSES SCALED 2(+14)
013739,000062:
013740,000063: 06,3315 30002 CA Q # MAJOR PART
013741,000064: 06,3316 00006 EXTEND
013742,000065: 06,3317 74746 MP BIT6 # SCALE 2(+9) SHIFT RIGHT 9
013743,000066: 06,3320 50132 INDEX BUF +2
013744,000067: 06,3321 20325 DAS DELVX # (PIPAI) + (PIPAI)(SFE)
013745,000068:
013746,000069: 06,3322 50132 INDEX BUF +2
013747,000070: 06,3323 41452 CS PIPABIAS # (PIPA PULSES)/(CS) X 2(-3) *
013748,000071: 06,3324 00006 EXTEND
013749,000072: 06,3325 71074 MP 1/PIPADT # (CS) X 2(+8) NOW (PIPA PULSES) X 2(+5) *
013750,000073: 06,3326 00006 EXTEND
013751,000074: 06,3327 74746 MP BIT6 # SCALE 2(+9) SHIFT RIGHT 9 *
013752,000075: 06,3330 50132 INDEX BUF +2
013753,000076: 06,3331 20325 DAS DELVX # (PIPAI) + (PIPAI)(SFE) - (BIAS)(DELTAT)
013754,000077:
013755,000078: 06,3332 10132 CCS BUF +2 # PIPAZ, PIPAY, PIPAX
013756,000079: 06,3333 67752 AD NEG1
013757,000080: 06,3334 13301 TCF 1/PIPA1 +1
|
|
Page 329
|
013759,000082: 06,3335 13336 NOOP # LESS THAN ZERO IMPOSSIBLE
013760,000083:
|
|
Page 330
|
013762,000085: 06,3336 55477 IRIGCOMP TS GCOMPSW # INDICATE COMMANDS 2 PULSES OR LESS.
013763,000086: 06,3337 54130 TS BUF # INDEX COUNTER. IRIGX, IRIGY, IRIGZ.
013764,000087:
013765,000088: 06,3340 03364 TC IRIGX # COMPENSATE ACCELERATION TERMS
013766,000089:
013767,000090: 06,3341 41460 CS NBDX # (GYRO PULSES)/(CS) X 2(-5)
013768,000091: 06,3342 03462 TC DRIFTSUB # -(NBOX)(DELTAT) (GYRO PULSES) X 2(+14)
013769,000092:
013770,000093: 06,3343 03401 TC IRIGY # COMPENSATE ACCELERATION TERMS
013771,000094:
013772,000095: 06,3344 41461 CS NBDY # (GYRO PULSES)/(CS) X 2(-5)
013773,000096: 06,3345 03462 TC DRIFTSUB # -(NBDY)(DELTAT) (GYRO PULSES) X 2(+14)
013774,000097:
013775,000098: 06,3346 03416 TC IRIGZ # COMPENSATE ACCELERATION TERMS
013776,000099:
013777,000100: 06,3347 31462 CA NBDZ # (GYRO PULSES)/(CS) X 2(-5)
013778,000101: 06,3350 03462 TC DRIFTSUB # +(NBDZ)(DELTAT) (GYRO PULSES) X 2(+14)
013779,000102:
013780,000103: 06,3351 11477 CCS GCOMPSW # ARE GYRO COMMANDS GREATER THAN 2 PULSES
013781,000104: 06,3352 13354 TCF +2 # YES SEND OUT GYRO TORQUING COMMANDS.
013782,000105: 06,3353 13361 TCF IRIG1 # NO RETURN
013783,000106:
013784,000107: 06,3354 35031 CA PRIO21 # PRIO GREATER THAN SERVICER
013785,000108: 06,3355 05072 TC NOVAC # SEND OUT GYRO TORQUING COMMANDS.
013786,000109: 06,3356 E3,1460 EBANK= NBDX
013787,000110: 06,3356 03515 14063 2CADR 1/GYRO
013788,000111:
013789,000112: 06,3360 00003 RELINT
013790,000113: 06,3361 30163 IRIG1 CA MODE # RESTORE CALLER S EBANK
013791,000114: 06,3362 54003 TS EBANK
013792,000115: 06,3363 14631 TCF SWRETURN
013793,000116:
|
|
Page 331
|
013795,000118: 06,3364 00006 IRIGX EXTEND
013796,000119: 06,3365 22156 QXCH MPAC +2 # SAVE Q
013797,000120: 06,3366 00006 EXTEND
013798,000121: 06,3367 40325 DCS DELVX # (PIPA PULSES) X 2(+14)
013799,000122: 06,3370 52155 DXCH MPAC
013800,000123: 06,3371 31463 CA ADIAX # (GYRO PULSES)/(PIPA PULSE) X 2(-6) *
013801,000124: 06,3372 03433 TC GCOMPSUB # -(ADIAX)(PIPAX) (GYRO PULSES) X 2(+14)
013802,000125:
013803,000126: 06,3373 00006 EXTEND #
013804,000127: 06,3374 40327 DCS DELVY # (PIPA PULSES) X 2(+14)
013805,000128: 06,3375 52155 DXCH MPAC #
013806,000129: 06,3376 41466 CS ADSRAX # (GYRO PULSES)/(PIPA PULSE) X 2(-6) *
013807,000130: 06,3377 03433 TC GCOMPSUB # -(ADSRAX)(PIPAY) (GYRO PULSES) X 2(+14)
013808,000131:
013809,000132: # EXTEND ***
013810,000133: # DCS DELVZ *** (PIPA PULSES) X 2(+14)
013811,000134: # DXCH MPAC ***
013812,000135: # CA ADOAX *** (GYRO PULSES)/(PIPA PULSE) X 2(-6) *
013813,000136: # TC GCOMPSUB *** -(ADOAX)(PIPAZ) (GYRO PULSES) X 2(+14)
013814,000137:
013815,000138: 06,3400 00156 TC MPAC +2
013816,000139:
013817,000140: 06,3401 00006 IRIGY EXTEND
013818,000141: 06,3402 22156 QXCH MPAC +2 # SAVE Q
013819,000142: 06,3403 00006 EXTEND
013820,000143: 06,3404 40327 DCS DELVY # (PIPA PULSES) X 2(+14)
013821,000144: 06,3405 52155 DXCH MPAC
013822,000145: 06,3406 31464 CA ADIAY # (GYRO PULSES)/(PIPA PULSE) X 2(-6) *
013823,000146: 06,3407 03433 TC GCOMPSUB # -(ADIAY)(PIPAY) (GYRO PULSES) X 2(+14)
013824,000147:
013825,000148: 06,3410 00006 EXTEND
013826,000149: 06,3411 40331 DCS DELVZ # (PIPA PULSES) X 2(+14)
013827,000150: 06,3412 52155 DXCH MPAC
013828,000151: 06,3413 41467 CS ADSRAY # (GYRO PULSES)/(PIPA PULSE) X 2(-6) *
013829,000152: 06,3414 03433 TC GCOMPSUB # +(ADSRAY)(PIPAZ) (GYRO PULSES) X 2(+14)
013830,000153:
013831,000154: # EXTEND ***
013832,000155: # DCS DELVX *** (PIPA PULSES) X 2(+14)
013833,000156: # DXCH MPAC ***
013834,000157: # CA ADOAY *** (GYRO PULSES)/(PIPA PULSE) X 2(-6) *
013835,000158: # TC GCOMPSUB *** -(ADOAY)(PIPAX) (GYRO PULSES) X 2(+14)
013836,000159:
013837,000160: 06,3415 00156 TC MPAC +2
013838,000161:
013839,000162: 06,3416 00006 IRIGZ EXTEND
013840,000163: 06,3417 22156 QXCH MPAC +2 # SAVE Q
013841,000164: 06,3420 00006 EXTEND
013842,000165: 06,3421 40327 DCS DELVY # (PIPA PULSES) X 2(+14)
013843,000166: 06,3422 52155 DXCH MPAC
013844,000167: 06,3423 31470 CA ADSRAZ # (GYRO PULSES)/(PIPA PULSE) X 2(-6) *
|
|
Page 332
|
013846,000169: 06,3424 03433 TC GCOMPSUB # -(ADSRAZ)(PIPAY) (GYRO PULSES) X 2(+14)
013847,000170:
013848,000171: 06,3425 00006 EXTEND
013849,000172: 06,3426 40331 DCS DELVZ # (PIPA PULSES) X 2(+14)
013850,000173: 06,3427 52155 DXCH MPAC
013851,000174: 06,3430 31465 CA ADIAZ # (GYRO PULSES)/(PIPA PULSE) X 2(-6) *
013852,000175: 06,3431 03433 TC GCOMPSUB # -(ADIAZ)(PIPAZ) (GYRO PULSES) X 2(+14)
013853,000176:
013854,000177: # EXTEND ***
013855,000178: # DCS DELVX *** (PIPA PULSE) X 2(+14)
013856,000179: # DXCH MPAC ***
013857,000180: # CS ADOAZ *** (GYRO PULSES)/(PIPA PULSE) X 2(-6) *
013858,000181: # TC GCOMPSUB *** +(ADOAZ)(PIPAX) (GYRO PULSES) X 2(+14)
013859,000182:
013860,000183: 06,3432 00156 TC MPAC +2
013861,000184:
|
|
Page 333
|
013863,000186: 06,3433 56154 GCOMPSUB XCH MPAC # ADIA OR ADSRA COEFFICIENT ARRIVES IN A
013864,000187: 06,3434 00006 EXTEND # C(MPAC) = (PIPA PULSES) X 2(+14)
013865,000188: 06,3435 70154 MP MPAC # (GYRO PULSES)/(PIPA PULSE) X 2(-6) *
013866,000189: 06,3436 52123 DXCH VBUF # NOW = (GYRO PULSES) X 2(+8) *
013867,000190:
013868,000191: 06,3437 30155 CA MPAC +1 # MINOR PART PIPA PULSES
013869,000192: 06,3440 00006 EXTEND
013870,000193: 06,3441 70154 MP MPAC # ADIA OR ADSRA
013871,000194: 06,3442 54001 TS L
013872,000195: 06,3443 34755 CAF ZERO
013873,000196: 06,3444 20123 DAS VBUF # NOW = (GYRO PULSES) X 2(+8) *
013874,000197:
013875,000198: 06,3445 30122 CA VBUF # PARTIAL RESULT - MAJOR
013876,000199: 06,3446 00006 EXTEND
013877,000200: 06,3447 74743 MP BIT9 # SCALE 2(+6) SHIFT RIGHT 6 *
013878,000201: 06,3450 50130 INDEX BUF # RESULT = (GYRO PULSES) X 2(+14)
013879,000202: 06,3451 21472 DAS GCOMP # HI(ADIA)(PIPAI) OR HI(ADSRA)(PIPAI)
013880,000203:
013881,000204: 06,3452 30123 CA VBUF +1 # PARTIAL RESULT - MINOR
013882,000205: 06,3453 00006 EXTEND
013883,000206: 06,3454 74743 MP BIT9 # SCALE 2(+6) SHIFT RIGHT 6 *
013884,000207: 06,3455 54001 TS L
013885,000208: 06,3456 34755 CAF ZERO
013886,000209: 06,3457 50130 INDEX BUF # RESULT = (GYRO PULSES) X 2(+14)
013887,000210: 06,3460 21472 DAS GCOMP # (ADIA)(PIPAI) OR (ADSRA)(PIPAI)
013888,000211:
013889,000212: 06,3461 00002 TC Q
013890,000213:
|
|
Page 334
|
013892,000215: 06,3462 00006 DRIFTSUB EXTEND
013893,000216: 06,3463 22131 QXCH BUF +1
013894,000217:
013895,000218: 06,3464 00006 EXTEND # C(A) = NBD (GYRO PULSES)/(CS) X 2(-5)
013896,000219: 06,3465 71074 MP 1/PIPADT # (CS) X 2(+8) NOW (GYRO PULSES) X 2(+3)
013897,000220: 06,3466 22155 LXCH MPAC +1 # SAVE FOR FRACTIONAL COMPENSATION
013898,000221: 06,3467 00006 EXTEND
013899,000222: 06,3470 74750 MP BIT4 # SCALE 2(+11) SHIFT RIGHT 11
013900,000223: 06,3471 50130 INDEX BUF
013901,000224: 06,3472 21472 DAS GCOMP # HI(NBD)(DELTAT) (GYRO PULSES) X 2(+14)
013902,000225:
013903,000226: 06,3473 30155 CA MPAC +1 # NOW MINOR PART
013904,000227: 06,3474 00006 EXTEND
013905,000228: 06,3475 74750 MP BIT4 # SCALE 2(+11) SHIFT RIGHT 11
013906,000229: 06,3476 54001 TS L
013907,000230: 06,3477 34755 CAF ZERO
013908,000231: 06,3500 50130 INDEX BUF # ADD IN FRACTIONAL COMPENSATION
013909,000232: 06,3501 21472 DAS GCOMP # (NBD)(DELTAT) (GYRO PULSES) X 2(+14)
013910,000233:
013911,000234: 06,3502 34752 DRFTSUB2 CAF TWO # PIPAX, PIPAY, PIPAZ
013912,000235: 06,3503 60130 AD BUF
013913,000236: 06,3504 56130 XCH BUF
013914,000237: 06,3505 50000 INDEX A
013915,000238: 06,3506 11471 CCS GCOMP # ARE GYRO COMMANDS 1 PULSE OR GREATER
013916,000239: 06,3507 13511 TCF +2 # YES
013917,000240: 06,3510 00131 TC BUF +1 # NO
013918,000241:
013919,000242: 06,3511 73561 MASK COMPCHK # DEC -1
013920,000243: 06,3512 10000 CCS A # ARE GYRO COMMANDS GREATER THAN 2 PULSES
013921,000244: 06,3513 55477 TS GCOMPSW # YES - SET GCOMPSW POSITIVE
013922,000245: 06,3514 00131 TC BUF +1 # NO
013923,000246:
|
|
Page 335
|
013925,000248: 06,3515 34751 1/GYRO CAF FOUR # PIPAZ, PIPAY, PIPAX
013926,000249: 06,3516 54130 TS BUF
013927,000250:
013928,000251: 06,3517 50130 INDEX BUF # SCALE GYRO COMMANDS FOR IMUPULSE
013929,000252: 06,3520 31472 CA GCOMP +1 # FRACTIONAL PULSES
013930,000253: 06,3521 00006 EXTEND
013931,000254: 06,3522 74744 MP BIT8 # SHIFT RIGHT 7
013932,000255: 06,3523 50130 INDEX BUF
013933,000256: 06,3524 55472 TS GCOMP +1 # FRACTIONAL PULSES SCALED
013934,000257:
013935,000258: 06,3525 34755 CAF ZERO # SET GCOMP = 0 FOR DAS INSTRUCTION
013936,000259: 06,3526 50130 INDEX BUF
013937,000260: 06,3527 57471 XCH GCOMP # GYRO PULSES
013938,000261: 06,3530 00006 EXTEND
013939,000262: 06,3531 74744 MP BIT8 # SHIFT RIGHT 7
013940,000263: 06,3532 50130 INDEX BUF
013941,000264: 06,3533 21472 DAS GCOMP # ADD THESE TO FRACTIONAL PULSES ABOVE
013942,000265:
013943,000266: 06,3534 10130 CCS BUF # PIPAZ, PIPAY, PIPAX
013944,000267: 06,3535 67752 AD NEG1
013945,000268: 06,3536 13516 TCF 1/GYRO +1
013946,000269: 06,3537 01471 LGCOMP ECADR GCOMP # LESS THAN ZERO IMPOSSIBLE
013947,000270:
013948,000271: 06,3540 33537 CAF LGCOMP
013949,000272: 06,3541 04616 TC BANKCALL
013950,000273: 06,3542 17314 CADR IMUPULSE # CALL GYRO TORQUING ROUTINE
013951,000274: 06,3543 04616 TC BANKCALL
013952,000275: 06,3544 17707 CADR IMUSTALL # WAIT FOR PULSES TO GET OUT
013953,000276: 06,3545 15155 TCF ENDOFJOB # TEMPORARY
013954,000277:
013955,000278: 06,3546 34751 GCOMP1 CAF FOUR # PIPAZ, PIPAY, PIPAX
013956,000279: 06,3547 54130 TS BUF
013957,000280:
013958,000281: 06,3550 50130 INDEX BUF # RESCALE
013959,000282: 06,3551 31472 CA GCOMP +1
013960,000283: 06,3552 00006 EXTEND
013961,000284: 06,3553 74744 MP BIT8 # SHIFT MINOR PART LEFT 7 - MAJOR PART = 0
013962,000285: 06,3554 50130 INDEX BUF
013963,000286: 06,3555 23472 LXCH GCOMP +1 # BITS 8-14 OF MINOR PART WERE = 0
013964,000287:
013965,000288: 06,3556 10130 CCS BUF # PIPAZ, PIPAY, PIPAX
013966,000289: 06,3557 67752 AD NEG1
013967,000290: 06,3560 13547 TCF GCOMP1 +1
013968,000291: 06,3561 77776 COMPCHK DEC -1 B-14 # LESS THAN ZERO IMPOSSIBLE
013969,000292: 06,3562 15155 TCF ENDOFJOB
013970,000293:
|
|
Page 336
|
013972,000295: 06,3563 11477 NBDONLY CCS GCOMPSW # BYPASS IF GCOMPSW NEGATIVE
013973,000296: 06,3564 13567 TCF +3
013974,000297: 06,3565 13567 TCF +2
013975,000298: 06,3566 15155 TCF ENDOFJOB
013976,000299:
013977,000300: 06,3567 00004 INHINT
013978,000301: 06,3570 10076 CCS FLAGWRD2 # PREREAD T3RUPT MAY COINCIDE
013979,000302: 06,3571 15155 TCF ENDOFJOB
013980,000303: 06,3572 15155 TCF ENDOFJOB
013981,000304: 06,3573 13574 TCF +1
013982,000305:
013983,000306: 06,3574 30104 CA FLAGWRD8 # IF SURFACE FLAG IS SET, SET TEM1
013984,000307: 06,3575 74744 MASK BIT8 # POSITIVE SO THAT THE ACCELERATION TERMS
013985,000308: 06,3576 54141 TS TEM1 # WILL BE COMPENSATED.
013986,000309: 06,3577 00006 EXTEND
013987,000310: 06,3600 13603 BZF +3 # ARE WE ON THE SURFACE
013988,000311:
013989,000312: 06,3601 04674 TC IBNKCALL # ON THE SURFACE
013990,000313: 06,3602 77541 CADR PIPASR +3 # READ PIPAS, BUT DO NOT SCALE THEM
013991,000314:
013992,000315: 06,3603 30025 CA TIME1 # (CS) X 2(+14)
013993,000316: 06,3604 57074 XCH 1/PIPADT # PREVIOUS TIME
013994,000317: 06,3605 00003 RELINT
013995,000318: 06,3606 40000 COM
013996,000319: 06,3607 61074 AD 1/PIPADT # PRESENT TIME - PREVIOUS TIME
013997,000320: 06,3610 64736 NBD2 AD HALF # CORRECT FOR POSSIBLE TIME1 TICK
013998,000321: 06,3611 64736 AD HALF
013999,000322: 06,3612 56001 XCH L # IF TIME1 DID NOT TICK, REMOVE RESULTING
014000,000323: 06,3613 56001 XCH L # OVERFLOW.
014001,000324:
014002,000325: 06,3614 00006 NBD3 EXTEND # C(A) = DELTAT (CS) X 2(+14)
014003,000326: 06,3615 74742 MP BIT10 # SHIFT RIGHT 5
014004,000327: 06,3616 52125 DXCH VBUF +2
014005,000328:
014006,000329: 06,3617 34755 CA ZERO
014007,000330: 06,3620 55477 TS GCOMPSW # INDICATE COMMANDS 2 PULSES OR LESS.
014008,000331: 06,3621 54130 TS BUF # INDEX X, Y, Z.
014009,000332:
014010,000333: 06,3622 10141 CCS TEM1 # IF SURFACE FLAG IS SET,
014011,000334: 06,3623 03364 TC IRIGX # COMPENSATE ACCELERATION TERMS.
014012,000335:
014013,000336: 06,3624 00006 EXTEND
014014,000337: 06,3625 30125 DCA VBUF +2
014015,000338: 06,3626 52155 DXCH MPAC # DELTAT NOW SCALED (CS) X 2(+19)
014016,000339:
014017,000340: 06,3627 41460 CS NBDX # (GYRO PULSES)/(CS) X 2(-5)
014018,000341: 06,3630 03652 TC FBIASSUB # -(NBOX)(DELTAT) (GYRO PULSES) X 2(+14)
014019,000342:
014020,000343: 06,3631 10141 CCS TEM1 # IF SURFACE FLAG IS SET,
014021,000344: 06,3632 03401 TC IRIGY # COMPENSATE ACCELERATION TERMS.
|
|
Page 337
|
014023,000346: 06,3633 00006 EXTEND
014024,000347: 06,3634 40125 DCS VBUF +2
014025,000348: 06,3635 52155 DXCH MPAC # DELTAT SCALED (CS) X 2(+19)
014026,000349: 06,3636 31461 CA NBDY # (GYRO PULSES)/(CS) X 2(-5)
014027,000350: 06,3637 03652 TC FBIASSUB # -(NBDY)(DELTAT) (GYRO PULSES) X 2(+14)
014028,000351:
014029,000352: 06,3640 10141 CCS TEM1 # IF SURFACE FLAG IS SET,
014030,000353: 06,3641 03416 TC IRIGZ # COMPENSATE ACCELERATION TERMS
014031,000354:
014032,000355: 06,3642 00006 EXTEND
014033,000356: 06,3643 40125 DCS VBUF +2
014034,000357: 06,3644 52155 DXCH MPAC # DELTAT SCALED (CS) X 2(+19)
014035,000358: 06,3645 41462 CS NBDZ # (GYRO PULSES)/(CS) X 2(-5)
014036,000359: 06,3646 03652 TC FBIASSUB # +(NBDZ)(DELTAT) (GYRO PULSES) X 2(+14)
014037,000360:
014038,000361: 06,3647 11477 CCS GCOMPSW # ARE GYRO COMMANDS GREATER THAN 2 PULSES
014039,000362: 06,3650 13515 TCF 1/GYRO # YES
014040,000363: 06,3651 15155 TCF ENDOFJOB # NO
014041,000364:
|
|
Page 338
|
014043,000366: 06,3652 56002 FBIASSUB XCH Q
014044,000367: 06,3653 54131 TS BUF +1
014045,000368:
014046,000369: 06,3654 30002 CA Q # NBD SCALED (GYRO PULSES)/(CS) X 2(-5)
014047,000370: 06,3655 00006 EXTEND
014048,000371: 06,3656 70154 MP MPAC # DELTAT SCALED (CS) X 2(+19)
014049,000372: 06,3657 50130 INDEX BUF
014050,000373: 06,3660 21472 DAS GCOMP # HI(NBD)(DELTAT) (GYRO PULSES) X 2(+14)
014051,000374:
014052,000375: 06,3661 30002 CA Q # NOW FRACTIONAL PART
014053,000376: 06,3662 00006 EXTEND
014054,000377: 06,3663 70155 MP MPAC +1
014055,000378: 06,3664 54001 TS L
014056,000379: 06,3665 34755 CAF ZERO
014057,000380: 06,3666 50130 INDEX BUF
014058,000381: 06,3667 21472 DAS GCOMP # (NBD)(DELTAT) (GYRO PULSES) X 2(+14)
014059,000382:
014060,000383: 06,3670 13502 TCF DRFTSUB2 # CHECK MAGNITUDE OF COMPENSATION
014061,000384:
014062,000385: 06,3671 04616 LASTBIAS TC BANKCALL
014063,000386: 06,3672 17270 CADR PIPUSE1
014064,000387:
014065,000388: 06,3673 11477 CCS GCOMPSW
014066,000389: 06,3674 13677 TCF +3
014067,000390: 06,3675 13677 TCF +2
014068,000391: 06,3676 15155 TCF ENDOFJOB
014069,000392:
014070,000393: 06,3677 30104 CA FLAGWRD8 # IF SURFACE FLAG IS SET, SET TEM1
014071,000394: 06,3700 74744 MASK SURFFBIT # POSITIVE SO THAT THE ACCELERATION TERMS
014072,000395: 06,3701 54141 TS TEM1 # WILL BE COMPENSATED.
014073,000396:
014074,000397: 06,3702 37721 CAF PRIO31 # 2 SECONDS SCALED (CS) X 2(+8)
014075,000398: 06,3703 57074 XCH 1/PIPADT
014076,000399: 06,3704 40000 COM
014077,000400: 06,3705 61234 AD PIPTIME +1
014078,000401: 06,3706 13610 TCF NBD2
014079,000402:
014080,000403: 06,3707 33537 GCOMPZER CAF LGCOMP # ROUTINE TO ZERO GCOMP BEFORE FIRST
014081,000404: 06,3710 56003 XCH EBANK # CALL TO 1/PIPA
014082,000405: 06,3711 54163 TS MODE
014083,000406:
014084,000407: 06,3712 34755 CAF ZERO
014085,000408: 06,3713 55477 TS GCOMPSW
014086,000409: 06,3714 55471 TS GCOMP
014087,000410: 06,3715 55472 TS GCOMP +1
014088,000411: 06,3716 55473 TS GCOMP +2
014089,000412: 06,3717 55474 TS GCOMP +3
014090,000413: 06,3720 55475 TS GCOMP +4
|
|
Page 339
|
014092,000415: 06,3721 55476 TS GCOMP +5
014093,000416:
014094,000417: 06,3722 13361 TCF IRIG1 # RESTORE EBANK AND RETURN
014095,000418:
End of include-file IMU_COMPENSATION_PACKAGE.agc. Parent file is MAIN.agc