Source Code
|
These source-code files are part of a reconstructed copy of Luminary 97, the
second release of the Apollo 11 Lunar Module (LM) Apollo Guidance Computer
(AGC) software. It was created to fix two incorrect ephemeris constants in
Luminary 96, as described by anomaly report LNY-59.
The reconstruction began with source code of Luminary 99 revision 1 previously
transcribed from a digitized copy of that program. The code was then updated
by undoing changes described in original Luminary memos 83 and 85, using asterisks
indicating changed lines in the listing as a guide. The reconstruction was
verified by matching memory-bank checksums to those listed in drawing 2021152D.
Note that page numbers in the reconstructed code match those on the Luminary 099
revision 001 printout, although the added code would likely have changed page
numbers for a real Luminary 97 listing.
Comments from the original source code are prefixed with a single '#' symbol,
whereas comments added later are prefixed by "##" or "###". Report any errors
noted by creating an
issue report at the Virtual AGC
project's GitHub repository.
|
059540,000002: ## Copyright: Public domain.
059541,000003: ## Filename: DAPIDLER_PROGRAM.agc
059542,000004: ## Purpose: A section of Luminary revision 97.
059543,000005: ## It is part of the reconstructed source code for the
059544,000006: ## second release of the flight software for the Lunar
059545,000007: ## Module's (LM) Apollo Guidance Computer (AGC) for Apollo 11.
059546,000008: ## It was created to fix two incorrect ephemeris constants in
059547,000009: ## Luminary 96, as described by anomaly report LNY-59.
059548,000010: ## The code has been recreated from a copy of Luminary 99
059549,000011: ## revision 001, using asterisks indicating changed lines in
059550,000012: ## the listing and Luminary Memos #83 and #85, which list
059551,000013: ## changes between Luminary 97 and 98, and 98 and 99. The
059552,000014: ## code has been adapted such that the resulting bugger words
059553,000015: ## exactly match those specified for Luminary 97 in NASA drawing
059554,000016: ## 2021152D, which gives relatively high confidence that the
059555,000017: ## reconstruction is correct.
059556,000018: ## Reference: pp. 1410-1420
059557,000019: ## Assembler: yaYUL
059558,000020: ## Contact: Ron Burkey <info@sandroid.org>.
059559,000021: ## Website: www.ibiblio.org/apollo/index.html
059560,000022: ## Mod history: 2019-07-28 MAS Created from Luminary 99.
059561,000023:
|
|
Page 1410
|
059563,000025: # THE DAPIDLER PROGRAM IS STARTED BY FRESH START AND RESTART. THE DAPIDLER PROGRAM IS DONE 10 TIMES
059564,000026: # PER SECOND UNTIL THE ASTRONAUT DESIRES THE DAP TO WAKE UP, AND THE IMU AND CDUS ARE READY FOR USE BY THE DAP.
059565,000027: # THE NECESSARY INITIALIZATION OF THE DAP IS DONE BY THE DAPIDLER PROGRAM.
059566,000028:
059567,000029: 16,2000 BANK 16
059568,000030: 16,2000 SETLOC DAPS1
059569,000031: 16,2000 BANK
059570,000032:
059571,000033: 16,2000 E6,1537 EBANK= AOSQ
059572,000034:
059573,000035: 16,2000 COUNT* $$/DAPID
059574,000036:
059575,000037: 16,2000 00006 CHEKBITS EXTEND
059576,000038: 16,2001 00031 READ CHAN31 # IF BOTH BIT13 AND BIT14 ARE ONE, THEN
059577,000039: 16,2002 40000 COM # THE MODE SELECT SWITCH IS IN THE OFF
059578,000040: 16,2003 74355 MASK BIT13-14 # POSITION, AND SO THE DAP SHOULD BE OFF,
059579,000041: 16,2004 00006 EXTEND # WITH NO ATTITUDE ERROR DISPLAY.
059580,000042: 16,2005 12157 BZF MOREIDLE
059581,000043:
059582,000044: 16,2006 41303 CS IMODES33
059583,000045: 16,2007 74746 MASK BIT6
059584,000046: 16,2010 10000 CCS A
059585,000047: 16,2011 12206 TCF JUMPDSP
059586,000048: 16,2012 41273 CS RCSFLAGS # IMU NOT USABLE. SET UP INITIALIZATION
059587,000049: 16,2013 74751 MASK BIT3 # FLAG FOR ATT ERROR DISPLAY ROUTINE.
059588,000050: 16,2014 27273 ADS RCSFLAGS
059589,000051: 16,2015 12163 TCF SHUTDOWN
059590,000052:
059591,000053: 16,2016 34742 CHEKMORE CAF BIT10 # BIT 10 OF 30 IS PGNCS CONTROL OF S/C
059592,000054: 16,2017 00006 EXTEND
059593,000055: 16,2020 02030 RAND CHAN30 # BITS IN 30 ARE INVERTED
059594,000056: 16,2021 10000 CCS A
059595,000057: 16,2022 12157 TCF MOREIDLE
059596,000058:
059597,000059: 16,2023 00002 RETURN
059598,000060:
|
|
Page 1411
|
059600,000062: # DAPIDLER ENTRY.
059601,000063:
059602,000064: 16,2024 22016 DAPIDLER LXCH BANKRUPT # INTERRUPT LEAD INS (CONTINUED)
059603,000065: 16,2025 00006 EXTEND
059604,000066: 16,2026 22012 QXCH QRUPT
059605,000067:
059606,000068: 16,2027 31273 CA RCSFLAGS
059607,000069: 16,2030 74737 MASK BIT13
059608,000070: 16,2031 10000 CCS A # CHECK IF 1/ACCJOB HAS BEEN SET UP SINCE
059609,000071: 16,2032 12041 TCF CHECKUP # THE LAST FRESH START OR RESTART.
059610,000072: 16,2033 34737 CA BIT13
059611,000073: 16,2034 27273 ADS RCSFLAGS # BIT 13 IS 1.
059612,000074: 16,2035 37715 CAF PRIO27
059613,000075: 16,2036 05072 TC NOVAC # SET UP JOB TO DO A LITTLE INITIALIZATION
059614,000076: 16,2037 E6,1537 EBANK= AOSQ # AND EXECUTE 1/ACCS.
059615,000077: 16,2037 02447 40106 2CADR 1/ACCSET # (WILL BRANCH TO MOREIDLE ON ACCSOKAY)
059616,000078:
059617,000079: 16,2041 02000 CHECKUP TC CHEKBITS # CHECK TO SEE IF LM DAP IS TO GO ON AND
059618,000080: # DO ERROR DISPLAY.
059619,000081:
059620,000082: 16,2042 30111 CAE DAPBOOLS # IF 1/ACCS HAS NOT BEEN COMPLETED, IDLE.
059621,000083: 16,2043 74751 MASK ACCSOKAY # NOTE: ONLY FRESH START AND RESTART
059622,000084: 16,2044 00006 EXTEND # KNOCK THIS BIT DOWN.
059623,000085: 16,2045 12157 BZF MOREIDLE
059624,000086:
059625,000087: 16,2046 04674 STARTDAP TC IBNKCALL # ZERO ATTITUDE ERROR AND DESIRED RATES.
059626,000088: 16,2047 40153 FCADR ZATTEROR
059627,000089: 16,2050 34755 CAF ZERO # ********** INITIALIZE: **********
059628,000090: 16,2051 55524 TS TJP
059629,000091: 16,2052 55525 TS TJU
059630,000092: 16,2053 55526 TS TJV
059631,000093: 16,2054 55421 TS OMEGAP # RATES IN BODY (PILOT) COORDINATES.
059632,000094: 16,2055 55422 TS OMEGAQ
059633,000095: 16,2056 55423 TS OMEGAR
059634,000096: 16,2057 55430 TS TRAPEDP
059635,000097: 16,2060 55431 TS TRAPEDQ
059636,000098: 16,2061 55432 TS TRAPEDR
059637,000099: 16,2062 55537 TS AOSQ # OFFSET ACCELERATION ESTIMATES.
059638,000100: 16,2063 55540 TS AOSQ +1
059639,000101: 16,2064 55541 TS AOSR
059640,000102: 16,2065 55542 TS AOSR +1
059641,000103: 16,2066 55424 TS ALPHAQ # COPIES OF OFFSET ESTIMATES FOR DOWNLIST.
059642,000104: 16,2067 55425 TS ALPHAR
059643,000105: 16,2070 55501 TS NEGUQ
059644,000106: 16,2071 55503 TS NEGUR
059645,000107: 16,2072 55545 TS AOSQTERM # QRAXIS RATE DERIVATION TERMS AND KALMAN
059646,000108: 16,2073 55546 TS AOSRTERM # FILTER INITIALIZATION TERMS.
059647,000109: 16,2074 55510 TS QACCDOT # DESCENT ACCELERATION DERIVATIVE EST.
059648,000110: 16,2075 55512 TS RACCDOT
|
|
Page 1412
|
059650,000112: 16,2076 55502 TS ALLOWGTS # AOSTASK FLAG FOR QRAXIS RCS CONTROL USE.
059651,000113: 16,2077 55631 TS COTROLER # DO TRYGTS ON FIRST PASS (WILL GO TO RCS)
059652,000114: 16,2100 55633 TS INGTS # RECOGNIZE FIRST GTS PASS AS SUCH.
059653,000115: 16,2101 55632 TS QGIMTIMR # STOP GIMBAL DRIVES. (PROBABLY WOULD BE
059654,000116: 16,2102 55634 TS RGIMTIMR # GOOD ENOUGH JUST TO INACTIVATE TIMERS)
059655,000117: 16,2103 55460 TS OLDPMIN # MINIMUM IMPULSE MODE ERASABLES
059656,000118: 16,2104 55461 TS OLDQRMIN
059657,000119: 16,2105 55767 TS PJETCTR # INITIALIZE DOCKED JET INHIBITION
059658,000120: 16,2106 55770 TS UJETCTR # COUNTERS
059659,000121: 16,2107 55771 TS VJETCTR
059660,000122: 16,2110 4747 CALLGMBL EQUALS BIT5 # RCSFLAGS INITIALIZATION.
059661,000123: 16,2110 42202 CS MANFLAG
059662,000124: 16,2111 71273 MASK RCSFLAGS # NEGUQ(R) HAVE BEEN GENERATED.
059663,000125: 16,2112 55273 TS RCSFLAGS
059664,000126:
059665,000127: # SET UP "OLD" MEASURED CDU ANGLES:
059666,000128:
059667,000129: 16,2113 00006 EXTEND
059668,000130: 16,2114 30033 DCA CDUX # OLDXFORP AND OLDYFORP
059669,000131: 16,2115 53441 DXCH OLDXFORP
059670,000132: 16,2116 30034 CA CDUZ
059671,000133: 16,2117 55442 TS OLDZFORQ
059672,000134: 16,2120 41273 CS RCSFLAGS
059673,000135: 16,2121 74740 MASK BIT12
059674,000136: 16,2122 27273 ADS RCSFLAGS # BIT 12 SET TO 1.
059675,000137: 16,2123 34751 CA FOUR
059676,000138: 16,2124 55535 TS SKIPU
059677,000139: 16,2125 55536 TS SKIPV
059678,000140: 16,2126 34733 CA POSMAX
059679,000141: 16,2127 54031 TS TIME6
059680,000142: 16,2130 55466 TS T6NEXT
059681,000143: 16,2131 55470 TS T6FURTHA
059682,000144: 16,2132 34755 CA ZERO
059683,000145: 16,2133 55467 TS T6NEXT +1
059684,000146: 16,2134 55471 TS T6FURTHA +1
059685,000147: 16,2135 55465 TS NXT6ADR
059686,000148: 16,2136 55472 TS NEXTP
059687,000149: 16,2137 55473 TS NEXTU
059688,000150: 16,2140 55474 TS NEXTV
059689,000151: 16,2141 44363 CS TEN
059690,000152: 16,2142 55757 TS DAPZRUPT # JASK NOT IN PROGRESS, INITIALIZE NEG.
059691,000153: 16,2143 34752 CA TWO
059692,000154: 16,2144 55433 TS NPTRAPS
059693,000155: 16,2145 55434 TS NQTRAPS
059694,000156: 16,2146 55435 TS NRTRAPS
059695,000157: 16,2147 00006 EXTEND
059696,000158: 16,2150 32205 DCA PAXADIDL
059697,000159: 16,2151 53275 DXCH T5ADR
059698,000160: 16,2152 37727 SETTIME5 CAF MS100
059699,000161: 16,2153 54030 TS TIME5
|
|
Page 1413
|
059701,000163: 16,2154 15270 TCF RESUME
059702,000164: 16,2155 E6,1537 EBANK= AOSQ
059703,000165: 16,2155 02024 34106 IDLERADR 2CADR DAPIDLER
059704,000166:
059705,000167: 16,2157 04674 MOREIDLE TC IBNKCALL # CALCULATE Q,R-AXES ATTITUDE ERRORS.
059706,000168: 16,2160 36626 CADR QERRCALC
059707,000169:
059708,000170: 16,2161 04674 TC IBNKCALL
059709,000171: 16,2162 35446 CADR CALCPERR # CALCULATE P AXIS ATTITUDE ERRORS.
059710,000172:
059711,000173: 16,2163 00006 SHUTDOWN EXTEND
059712,000174: 16,2164 32156 DCA IDLERADR
059713,000175: 16,2165 53275 DXCH T5ADR
059714,000176:
059715,000177: 16,2166 34755 CAF ZERO # KILL ANY POSSIBLE JET REQUESTS
059716,000178: 16,2167 55472 TS NEXTP
059717,000179: 16,2170 55473 TS NEXTU
059718,000180: 16,2171 55474 TS NEXTV
059719,000181: 16,2172 00006 EXTEND # COMMAND JETS OFF.
059720,000182: 16,2173 01005 WRITE CHAN5
059721,000183: 16,2174 00006 EXTEND
059722,000184: 16,2175 01006 WRITE CHAN6
059723,000185: 16,2176 42203 CS BGIM23 # TURN TRIM GIMBAL OFF
059724,000186: 16,2177 00006 EXTEND
059725,000187: 16,2200 03012 WAND CHAN12
059726,000188: 16,2201 12152 TCF SETTIME5 # RETURN IN 100 MSEC.
059727,000189:
059728,000190: 16,2202 03021 MANFLAG OCT 03021
059729,000191: 16,2203 07400 BGIM23 OCTAL 07400
059730,000192: 16,2204 E6,1421 EBANK= OMEGAP
059731,000193: 16,2204 02213 34106 PAXADIDL 2CADR PAXIS
059732,000194:
059733,000195: 16,2206 7727 MS100 = OCT37766
059734,000196: 16,2206 0061 COSMG = ITEMP1
059735,000197: 16,2206 00006 JUMPDSP EXTEND # TRANSFER TO BANK 20
059736,000198: 16,2207 32212 DCA DSPCADR # FOR ATTITUDE ERROR DISPLAYS
059737,000199: 16,2210 52006 DTCB
059738,000200:
059739,000201: 16,2211 E6,1761 EBANK= AK
059740,000202: 16,2211 02226 40106 DSPCADR 2CADR ALTDSPLY
059741,000203:
|
|
Page 1414
|
059743,000205: 20,2226 BANK 20
059744,000206: 20,2000 SETLOC DAPS3
059745,000207: 20,2000 BANK
059746,000208: 20,2226 COUNT* $$/NEEDL
059747,000209:
059748,000210: # PROGRAM: ALTDSPLY
059749,000211: # MOD 0. 6 DEC 1967
059750,000212: # AUTHOR: CRAIG WORK, DON KEENE, MIT IL
059751,000213: # MOD 3 BY DON KEENE AUG 1, 1968 MOVED PROGRAM TO BANK 20
059752,000214:
059753,000215: # PROGRAM DESCRIPTION:
059754,000216: # ALTDSPLY REVERSES THE DSPLYALT BIT OF RCSFLAGS EACH TIME IT IS CALLED, WHICH IS PRESUMABLY EVERY 100 MS.
059755,000217: # IF THE REVERSED BIT IS ONE, NEEDLER IS CALLED TO DISPLAY ATTITUDE ERRORS. IF THE BIT IS ZERO, THE ATTITUDE ERR-
059756,000218: # ORS ARE CALCULATED AS 1) DAP FOLLOWING ERRORS, IF NEEDLFLG = 0, AND 2) TOTAL ATTITUDE ERRORS FOR NEEDLFLG = 1.
059757,000219:
059758,000220:
059759,000221: # WARNING: ALTDSPLY MAY ONLY BE CALLED WITH INTERRUPT INHIBITED.
059760,000222:
059761,000223: # WARNING: EBANK MUST BE SET TO 6 WHEN USING THIS ROUTINE.
059762,000224:
059763,000225: # INPUT: RCSFLAGS AND 1) IF NEEDLFLG = 0, INPUT PERROR, QERROR, RERROR.
059764,000226: # 2) IF NEEDLFLG = 1, INPUT CPHI,CTHETA,CPSI,CDUX,CDUY,CDUZ,M11,M21,M32,M22,M32. (GPMATRIX)
059765,000227:
059766,000228:
059767,000229: # OUTPUTS: RCSFLAGS WITH DSPLYALT REVERSED, AK, AK1, AK2, + NEEDLER OUTPUTS.
059768,000230:
059769,000231: # ENTRY: TCF ALTDSPLY
059770,000232:
059771,000233: # EXIT: TCF CHEKMORE
059772,000234:
059773,000235: # ALARM OR ABORT EXITS: NONE
059774,000236:
059775,000237: # SUBPROGRAMS CALLED: NEEDLER, OVERSUB2
059776,000238:
059777,000239: # DEBRIS: A, L, AND NEEDLER DEBRIS.
059778,000240:
059779,000241: 20,2226 31273 ALTDSPLY CA RCSFLAGS # INVERT THE DISPLAY ALTERNATION BIT.
059780,000242: 20,2227 54001 TS L
059781,000243: 20,2230 34750 CA DSPLYALT
059782,000244: 20,2231 00006 EXTEND
059783,000245: 20,2232 06001 RXOR LCHAN
059784,000246: 20,2233 55273 TS RCSFLAGS
059785,000247:
059786,000248: 20,2234 74750 MASK DSPLYALT
059787,000249: 20,2235 10000 CCS A # IS ALTERNATION FLAG ZERO?
059788,000250: 20,2236 12322 TCF NEEDLER
059789,000251:
059790,000252: 20,2237 30074 CAE FLAGWRD0 # NEEDLFLG WILL INDICATE TOTAL OR DAP AT-
|
|
Page 1415
|
059792,000254: 20,2240 74750 MASK NEEDLBIT # TITUDE ERROR DISPLAY REQUEST.
059793,000255: 20,2241 10000 CCS A
059794,000256: 20,2242 12252 TCF DSPLYTOT # TOTAL ERROR IS NEEDED IN AK, AK +1, AK +2
059795,000257:
059796,000258: 20,2243 41450 CS QERROR # YES. DISPLAY ATT ERRORS ON THE ,-BALL.
059797,000259: 20,2244 55762 TS AK +1 # ERROR COMPLEMENTS ARE INPUT TO NEEDLER.
059798,000260: 20,2245 41452 CS RERROR
059799,000261: 20,2246 55763 TS AK +2
059800,000262: 20,2247 41464 CS PERROR
059801,000263: 20,2250 57761 XCH AK
059802,000264:
059803,000265: 20,2251 12442 TCF RETNMORE # DISPLAY THESE THE NEXT TIME THROUGH
059804,000266:
059805,000267: # CALCULATE GIMBAL ANGLE TOTAL ERRORS, RESOLVE INTO PILOT AXES, STORE TOTAL ERRORS FOR NEEDLER. Q-AXIS FIRST.
059806,000268:
059807,000269: 20,2252 00006 DSPLYTOT EXTEND
059808,000270: 20,2253 22061 QXCH ITEMP1 # SAVE Q FOR CHEKBITS RETURN.
059809,000271:
059810,000272: 20,2254 30322 CA CTHETA # DESIRED ATTITUDE, Y-AXIS, 2'S COMP.
059811,000273: 20,2255 00006 EXTEND # SUBTRACT CURRENT ATTITUDE.
059812,000274: 20,2256 20033 MSU CDUY # DIFFERENCE SCALED AT PI, 1'S COMP.
059813,000275: 20,2257 55761 TS AK # SAVE FOR R-ERROR CALCULATION.
059814,000276: 20,2260 00006 EXTEND
059815,000277: 20,2261 71415 MP M21 # (CHTETA-CDUY)*M21 SCALED AT PI RADIANS.
059816,000278: 20,2262 57762 XCH AK +1 # STORE FIRST TERM OF Q ERROR.
059817,000279: 20,2263 30323 CA CPSI # DESIRED ATTITUDE, Z-AXIS, 2'S COMP.
059818,000280: 20,2264 00006 EXTEND # SUBTRACT CURRENT ATTITUDE.
059819,000281: 20,2265 20034 MSU CDUZ # DIFFERENCE SCALED AT PI, 1'S COMP.
059820,000282: 20,2266 55763 TS AK +2 # SAVE Z-AXIS TERM FOR R ERROR CALCULATION
059821,000283: 20,2267 00006 EXTEND
059822,000284: 20,2270 71417 MP M22 # (CPSI-CDUZ)*M22, SCALED AT PI RADIANS.
059823,000285: 20,2271 61762 AD AK +1 # Q ERROR COMPLETE , AT PI RAD.
059824,000286: 20,2272 02435 TC OVERSUB2 # PIN NEEDLES IN CASE OF OVERFLOW.
059825,000287: 20,2273 55762 TS AK +1
059826,000288:
059827,000289: # R ERROR CALCULATION NEXT.
059828,000290:
059829,000291: 20,2274 31761 CA AK # Y-AXIS DIFFERENCE STORED BY Q-AXIS CALC.
059830,000292: 20,2275 00006 EXTEND
059831,000293: 20,2276 71416 MP M31 # (CTHETA-CDUY)*M31, SCALED AT PI RADIANS.
059832,000294: 20,2277 57763 XCH AK +2 # FIRST TERM OF R ERROR.
059833,000295: # Z-AXIS DIFFERENCE, STORED BY A CALC. IS
059834,000296: 20,2300 00006 EXTEND # RECOVERED BY THE EXCHANGE.
059835,000297: 20,2301 71420 MP M32 # (CPSI-CDUZ)*M32, SCALED AT PI RADIANS.
059836,000298: 20,2302 61763 AD AK +2 # R ERROR COMPLETE , AT PI RAD.
059837,000299: 20,2303 02435 TC OVERSUB2 # PIN NEEDLES IN CASE OF OVERFLOW.
059838,000300: 20,2304 55763 TS AK +2
059839,000301:
059840,000302: # NOW CALCULATE P ERROR. (NOTE THAT M13 = 1, SCALED AT 1, SO THE MULTIPLICATION IS BY-PASSED.)
|
|
Page 1416
|
059842,000304: 20,2305 31761 CA AK # Y-AXIS DIFFERENCE STORED BY Q AXIS CALC.
059843,000305: 20,2306 00006 EXTEND
059844,000306: 20,2307 71414 MP M11 # (CTHETA-CDUY)*M11 SCALED AT PI RADIANS.
059845,000307: 20,2310 57761 XCH AK # FIRST TERM OF P ERROR IN AK, AT PI RAD.
059846,000308: 20,2311 30321 CAE CPHI # DESIRED ATTITUDE, X-AXIS, 2'S COMP.
059847,000309: 20,2312 00006 EXTEND # SUBTRACT CURRENT X ATTITUDE.
059848,000310: 20,2313 20032 MSU CDUX # X-AXIS DIFFERENCE, 1'S COMP, AT PI RAD.
059849,000311:
059850,000312: # M13 = 1, SO BYPASS THE MULTIPLICATION.
059851,000313: # EXTEND
059852,000314: # MP M13 (CPHI-CDUX)*M13 SCALED AT PI RADIANS.
059853,000315:
059854,000316: 20,2314 61761 AD AK # P ERROR COMPLETE , SCALED AT PI RAD
059855,000317: 20,2315 02435 TC OVERSUB2 # PIN NEEDLES IN CASE OF OVERFLOW.
059856,000318: 20,2316 55761 TS AK
059857,000319:
059858,000320: 20,2317 00006 EXTEND
059859,000321: 20,2320 22061 QXCH ITEMP1 # RESTORE Q FOR CHEKBITS RETURN.
059860,000322:
059861,000323: 20,2321 12442 TCF RETNMORE # DISPLAY THESE THE NEXT TIME THROUGH
059862,000324:
|
|
Page 1417
|
059864,000326: # FDAI ATTITUDE ERROR DISPLAY SUBROUTINE
059865,000327:
059866,000328: # PROGRAM DESCRIPTION: D. KEENE 5/24/67
059867,000329: # MOD 1 BY CRAIG WORK, 12 DEC 67
059868,000330: # MOD 2 BY CRAIG WORK, 6 APRIL 68 CONVERTS ATTITUDE ERROR DISPLAY SCALING FROM 16 7/8 DEG. TO 42 3/16 DEGREES.
059869,000331:
059870,000332: # THIS SUBROUTINE IS USED TO DISPLAY ATTITUDE ERRORS ON THE FDAI VIA THE DIGITAL TO ANALOG CONVERTERS (DACS)
059871,000333: # IN THE CDUS. CARE IS TAKEN TO METER OUT THE APPROPRIATE NUMBER OF PULSES TO THE IMU ERROR COUNTERS AND PREVENT
059872,000334: # OVERFLOW, TO CONTROL THE RELAY SEQUENCING, AND TO AVOID INTERFERENCE WITH THE COARSE ALIGN LOOP WHICH ALSO USES
059873,000335: # THE DACS.
059874,000336:
059875,000337: # CALLING SEQUENCE:
059876,000338: # DURING THE INITIALIZATION SECTION OF THE USER'S PROGRAM, BIT3 OF RCSFLAGS SHOULD BE SET TO INITIATE THE
059877,000339: # TURN-ON SEQUENCE WITHIN THE NEEDLES PROGRAM:
059878,000340: # CS RCSFLAGS IN EBANK6
059879,000341: # MASK BIT3
059880,000342: # ADS RCSFLAGS
059881,000343: # THEREAFTER, THE ATTITUDE ERRORS GENERATED BY THE USER SHOULD BE TRANSFERED TO THE FOLLOWING LOCATIONS IN EBANK6:
059882,000344: # AK SCALED 180 DEGREES NOTE: THESE LOCATIONS ARE SUBJECT
059883,000345: # AK1 SCALED 180 DEGREES TO CHANGE
059884,000346: # AK2 SCALED 180 DEGREES
059885,000347: # FULL SCALED DEFLECTION OF THE NEEDLES CORRESPONDS TO 5 1/16 DEGREES, WHILE 384 BITS IN THE IMU ERROR COUNTER
059886,000348: # CORRESPONDS TO 42 3/16 DEGREES. (DAC MAXIMUM CAPACITY IS 384 BITS.) 46 BITS EFFECTIVELY PIN THE NEEDLES.
059887,000349:
059888,000350: # A CALL TO NEEDLER WILL THEN UPDATE THE DISPLAY:
059889,000351: # INHINT
059890,000352: # TC IBNKCALL NOTE: EBANK SHOULD BE SET TO E6
059891,000353: # CADR NEEDLER
059892,000354: # RELINT
059893,000355: # THIS PROCESS SHOULD BE REPEATED EACH TIME THE ERRORS ARE UPDATED. AT LEAST 3 PASSES THRU THE PROGRAM ARE
059894,000356: # REQUIRED BEFORE ANYTHING IS ACTUALLY DISPLAYED ON THE ERROR METERS.
059895,000357: # NOTE: EACH CALL TO NEEDLER MUST BE SEPARATED BY AT LEAST 50 MS TO ASSURE PROPER RELAY SEQUENCING.
059896,000358:
059897,000359: # ERASABLE USED:
059898,000360: # AK CDUXCMD
059899,000361: # AK1 CDUYCMD
059900,000362: # AK2 CDUZCMD
059901,000363: # EDRIVEX A,L,Q
059902,000364: # EDRIVEY T5TEMP
059903,000365: # EDRIVEZ DINDX
|
|
Page 1418
|
059905,000367:
059906,000368: # SWITCHES: RCSFLAGS BITS 3,2
059907,000369:
059908,000370: # I/O CHANNELS: CHAN12 BIT 4 (COARSE ALIGN - READ ONLY)
059909,000371: # CHAN12 BIT 6 (IMU ERROR COUNTER ENABLE)
059910,000372: # CHAN14 BIT 13,14,15 (DAC ACTIVITY)
059911,000373:
059912,000374: # SIGN CONVENTION< AK = THETAC - THETA
059913,000375: # WHERE THETAC = COMMAND ANGLE
059914,000376: # THETA = PRESENT ANGLE
059915,000377:
059916,000378: 20,2322 31273 NEEDLER CA RCSFLAGS
059917,000379: 20,2323 76242 MASK SIX
059918,000380: 20,2324 00006 EXTEND
059919,000381: 20,2325 12362 BZF NEEDLES3
059920,000382: 20,2326 74751 MASK BIT3
059921,000383: 20,2327 00006 EXTEND
059922,000384: 20,2330 12353 BZF NEEDLER2 # BIT3 = 0, BIT2 = 1
059923,000385:
059924,000386: 20,2331 44746 CS BIT6 # FIRST PASS BIT3 = 1
059925,000387: 20,2332 00006 EXTEND # DISABLE IMU ERROR COUNTER TO ZERO DACS
059926,000388: 20,2333 03012 WAND CHAN12 # MUST WAIT AT LEAST 60 MS BEFORE
059927,000389: 20,2334 44755 NEEDLE11 CS ZERO # ENABLING COUNTERS.
059928,000390: 20,2335 55761 TS AK # ZERO THE INPUTS ON FIRST PASS
059929,000391: 20,2336 55762 TS AK1
059930,000392: 20,2337 55763 TS AK2
059931,000393: 20,2340 55764 TS EDRIVEX # ZERO THE DISPLAY REGISTERS
059932,000394: 20,2341 55765 TS EDRIVEY
059933,000395: 20,2342 55766 TS EDRIVEZ
059934,000396: 20,2343 54050 TS CDUXCMD # ZERO THE OUT COUNTERS
059935,000397: 20,2344 54051 TS CDUYCMD
059936,000398: 20,2345 54052 TS CDUZCMD
059937,000399: 20,2346 46242 CS SIX # RESET RCSFLAGS FOR PASS2
059938,000400: 20,2347 71273 MASK RCSFLAGS
059939,000401: 20,2350 64752 AD BIT2
059940,000402: 20,2351 55273 TS RCSFLAGS
059941,000403: 20,2352 12442 TCF RETNMORE
059942,000404:
059943,000405: 20,2353 34746 NEEDLER2 CAF BIT6 # ENABLE IMU ERROR COUNTERS
059944,000406: 20,2354 00006 EXTEND
059945,000407: 20,2355 05012 WOR CHAN12
059946,000408: 20,2356 46242 CS SIX # RESET RCSFLAGS TO DISPLAY ATTITUDE
059947,000409: 20,2357 71273 MASK RCSFLAGS # ERRORS WAIT AT LEAST 4 MS FOR
059948,000410: 20,2360 55273 TS RCSFLAGS # RELAY CLOSURE
059949,000411: 20,2361 12442 TCF RETNMORE
059950,000412:
059951,000413: 20,2362 34746 NEEDLES3 CAF BIT6 # CHECK TO SEE IF IMU ERROR COUNTER
059952,000414: 20,2363 00006 EXTEND # IS ENABLED
059953,000415: 20,2364 02012 RAND CHAN12
|
|
Page 1419
|
059955,000417: 20,2365 10000 CCS A # IF NOT, RE-INITIALIZE NEEDLER.
059956,000418: 20,2366 12373 TCF NEEDLES
059957,000419:
059958,000420: 20,2367 41273 CS RCSFLAGS # SET UP INITIALIZATION FLAG IN RCSFLAGS.
059959,000421: 20,2370 74751 MASK BIT3
059960,000422: 20,2371 27273 ADS RCSFLAGS
059961,000423: 20,2372 12442 TCF RETNMORE
059962,000424:
059963,000425: 20,2373 34752 NEEDLES CAF TWO
059964,000426: 20,2374 54063 DACLOOP TS DINDX
059965,000427: 20,2375 42434 CS ONETENTH # RESCALE INPUTS TO + OR - 1800 DEGREES.
059966,000428: 20,2376 00006 EXTEND
059967,000429: 20,2377 50063 INDEX DINDX
059968,000430: 20,2400 71761 MP AK
059969,000431: 20,2401 54001 TS L
059970,000432: 20,2402 10000 CCS A
059971,000433: 20,2403 32432 CA DACLIMIT
059972,000434: 20,2404 12406 TCF +2
059973,000435: 20,2405 42432 CS DACLIMIT
059974,000436: 20,2406 60001 AD L
059975,000437: 20,2407 54061 TS T5TEMP # OVFLO CHK
059976,000438: 20,2410 12414 TCF +4
059977,000439: 20,2411 50000 INDEX A # ON OVERFLOW LIMIT OUTPUT TO +-384
059978,000440: 20,2412 32432 CAF DACLIMIT
059979,000441: 20,2413 54001 TS L
059980,000442: 20,2414 50063 INDEX DINDX
059981,000443: 20,2415 41764 CS EDRIVEX # CURRENT VALUE OF DAC
059982,000444: 20,2416 60001 AD L
059983,000445: 20,2417 50063 INDEX DINDX
059984,000446: 20,2420 26050 ADS CDUXCMD
059985,000447: 20,2421 50063 INDEX DINDX
059986,000448: 20,2422 23764 LXCH EDRIVEX
059987,000449: 20,2423 10063 CCS DINDX
059988,000450: 20,2424 12374 TCF DACLOOP
059989,000451: 20,2425 37740 CAF 13,14,15
059990,000452: 20,2426 00006 EXTEND
059991,000453: 20,2427 05014 WOR CHAN14 # SET DAC ACTIVITY BITS
059992,000454: 20,2430 12442 TCF RETNMORE
059993,000455:
059994,000456: 20,2431 77177 DEC -384 B-14
059995,000457: 20,2432 37200 DACLIMIT DEC 16000 B-14
059996,000458: 20,2433 00600 DEC 384 B-14
059997,000459:
059998,000460: 20,2434 03146 ONETENTH OCT 03146 # DECIMAL +0.1, SCALED AT 1.
059999,000461: 20,2435 4750 DSPLYALT EQUALS BIT4 # 100 MS ALTERNATION BIT IN RCSFLAGS
060000,000462:
060001,000463: 20,2435 54007 OVERSUB2 TS 7 # RETURNS A UNCHANGED OR LIMITED TO
060002,000464: 20,2436 00002 TC Q # POSMAX OR NEGMAX IF A HAS OVERFLOW
060003,000465: 20,2437 50000 INDEX A
|
|
Page 1420
|
060005,000467: 20,2440 44734 CS LIMITS # DUPLICATE CODING IN BANK 16
060006,000468: 20,2441 00002 TC Q
060007,000469:
060008,000470: 20,2442 00006 RETNMORE EXTEND # RETURN TO CHEKMORE
060009,000471: 20,2443 32446 DCA MORECADR
060010,000472: 20,2444 52006 DTCB
060011,000473:
060012,000474: 20,2445 E6,1537 EBANK= AOSQ
060013,000475: 20,2445 02016 34106 MORECADR 2CADR CHEKMORE
060014,000476:
End of include-file DAPIDLER_PROGRAM.agc. Parent file is MAIN.agc