Source Code

038270,000001: # Copyright: Public domain. 038271,000002: # Filename: FINDCDUW--GUIDAP_INTERFACE.agc 038272,000003: # Purpose: A section of Luminary 1C, revision 131. 038273,000004: # It is part of the source code for the Lunar Module's (LM) 038274,000005: # Apollo Guidance Computer (AGC) for Apollo 13 and Apollo 14. 038275,000006: # This file is intended to be a faithful transcription, except 038276,000007: # that the code format has been changed to conform to the 038277,000008: # requirements of the yaYUL assembler rather than the 038278,000009: # original YUL assembler. 038279,000010: # Reference: pp. 907-925 of 1729.pdf. 038280,000011: # Contact: Ron Burkey <info@sandroid.org>. 038281,000012: # Website: www.ibiblio.org/apollo/index.html 038282,000013: # Mod history: 05/28/03 RSB. Began transcribing. 038283,000014: # 05/14/05 RSB Corrected website reference above. 038284,000015: 038285,000016: # Page 907 038286,000017: # PROGRAM NAME: FINDCDUW 038287,000018: # MOD NUMBER: 1 68-07-15 038288,000019: # MOD AUTHOR: KLUMPP 038289,000020: 038290,000021: # OBJECTS OF MOD: 1. TO SUPPLY COMMANDED GIMBAL ANGLES FOR NOUN 22. 038291,000022: # 2. TO MAINTAIN CORRECT AND CURRENT THRUST 038292,000023: # DIRECTION DATA IN ALL MODES. THIS IS DONE BY 038293,000024: # FETCHING FOR THE THRUST DIRECTION FILTER THE 038294,000025: # CDUD'S IN PNGCS-AUTO, THE CDU'S IN ALL OTHER 038295,000026: # MODES. 038296,000027: # 3. TO SUBSTITUDE A STOPRATE FOR THE NORMAL 038297,000028: # AUTOPILOT COMMANDS WHENEVER 038298,000029: # 1) NOT IN PNGCS-AUTO, OR 038299,000030: # 2) ENGINE IS OFF. 038300,000031: 038301,000032: # FUNCTIONAL DESCRIPTION: 038302,000033: 038303,000034: # FINDCDUW PROVIDES THE INTERFACES BETWEEN THE VARIOUS POWERED FLITE GUIDANCE PROGRAMS 038304,000035: # AND THE DIGITAL AUTOPILOT. THE INPUTS TO FINDCDUW ARE THE THRUST COMMAND VECTOR 038305,000036: # AND THE WINDOW COMMAND VECTOR, AND THE OUTPUTS ARE THE GIMBAL ANGLE 038306,000037: # INCRMENTS, THE COMMANDED ATTITUDE ANGLE RATES, AND THE COMMANDED 038307,000038: # ATTITUDE LAG ANGLES (WHICH ACCOUNT FOR TH ANGLES BY WHICH THE BODY WILL 038308,000039: # LAG BEHIND A RAMP COMMAND IN ATTITUDE ANGLE DUE TO THE FINITE ANGULAR 038309,000040: # ACCELERATIONS AVAILABLE). 038310,000041: 038311,000042: # FINDCDUW ALIGNS THE ESTIMATED THRUST VECTOR FROM THE THRUST DIRECTION 038312,000043: # FILTER WITH THE THRUST COMMAND VECTOR, AND, WHEN XDVINHIB SET, 038313,000044: # ALIGNS THE +Z HALF OF THE LM ZX PLANE WITH THE WINDOW COMMAND VECTOR. 038314,000045: 038315,000046: # Page 908 038316,000047: # SPECIFICATIONS: 038317,000048: 038318,000049: # INITIALIZATION: A SINGLE INTERPRETIVE CALL TO INITCDUW IS REQUIRED 038319,000050: # BEFORE EACH GUIDED MANEUVER USING FINDCDUW. 038320,000051: 038321,000052: # CALL: INTERPRETIVE CALL TO FINDCDUW WITH THE THRUST COMMAND 038322,000053: # VECTOR IN MPAC. INTERPRETIVE CALL TO FINDCDUW -2 WITH 038323,000054: # THE THRUST COMMAND VECTOR IN UNFC/2 AND NOT IN MPAC. 038324,000055: 038325,000056: # RETURNS: NORMAL INTERPRETIVE IN ALL CASES 038326,000057: # 1. NORMALLY ALL AUTOPILOT CMDS ARE ISSUED. 038327,000058: # 2. IF NOT PNGCS AUTO, DO STOPRATE AND RETURN 038328,000059: # WITHOUT ISSUING AUTOPILOT CMDS. 038329,000060: # 3. IF ENGINE OFF, DO STOPRATE AND RETURN WITHOUT 038330,000061: # ISSUING AUTOPILOT CMDS. 038331,000062: 038332,000063: # ALARMS: 00401 IF INPUTS DETERMINE AN ATTITUDE IN GIMBAL LOCK. 038333,000064: # FINDCDUW DRIVES CDUXD AND CDUYD TO THE RQD VALUES, 038334,000065: # BUT DRIVES CDUZD ONLY TO THE GIMBAL LOCK CONE. 038335,000066: 038336,000067: # 00402 IF UNFC/2 OR UNWC/2 PRODUCE OVERFLOW WHEN 038337,000068: # UNITIZED USING NORMUNIT. FINDCDUW ISSUES 038338,000069: # STOPRATE AS ONLY INPUT TO AUTOPILOT. 038339,000070: 038340,000071: # INPUTS: UNFC/2 THRUST COMMAND VECTOR, NEED NOT BE SEMI-UNIT. 038341,000072: # UNWC/2 WINDOW COMMAND VECTOR, NEED NOT BE SEMI-UNIT. 038342,000073: # OGABIAS POSSIBLE BIAS FOR OUTER GIMBAL ANGLE (ZEROED IN INITCDUW), UNITS OF PI. 038343,000074: # XOVINHIB FLAG DENOTING X AXIS OVERRIDE INHIBITED. 038344,000075: # CSMDOCKD FLAG DENOTING CSM DOCKED. 038345,000076: # STEERSW FLAG DENOTING INSUFF THRUST FOR THRUST DIR FLTR. 038346,000077: 038347,000078: # OUTPUTS: DCDUX,Y,Z 038348,000079: # OMEGAPD,+1,+2 038349,000080: # DELPEROR,+1,+2 038350,000081: # CPHI,+1,+2 FOR NOUN22 038351,000082: 038352,000083: # DEBRIS: FINDCDUW DESTROYS SINCDUX,Y,Z AND COSCDUX,Y,Z BY 038353,000084: # WRITING INTO THESE LOCATIONS THE SINES AND COSINES 038354,000085: # OF THE CDUD'S IN PNGCS-AUTO, OF THE CDU'S OTHERWISE. 038355,000086: 038356,000087: # Page 909 038357,000088: # INITIALIZATION FOR FINDCDUW 038358,000089: 038359,000090: 30,3071 BANK 30 038360,000091: 30,2000 SETLOC FCDUW 038361,000092: 30,2000 BANK 038362,000093: 038363,000094: 30,3071 E6,1645 EBANK= ECDUW 038364,000095: 30,3071 COUNT* $$/FCDUW 038365,000096: 038366,000097: 30,3071 77331 INITCDUW SSP VLOAD 038367,000098: 30,3072 03300 OGABIAS 038368,000099: 30,3073 00000 0 038369,000100: 30,3074 06522 UNITX 038370,000101: 30,3075 03267 STORE UNFV/2 038371,000102: 30,3076 03261 STORE UNWC/2 038372,000103: 30,3077 77616 RVQ 038373,000104: 038374,000105: # FINDCDUW PRELIMINARIES 038375,000106: 038376,000107: 30,3100 77775 VLOAD # FINDCDUW -2: ENTRY WHEN UNFC/2 PRE-STORD 038377,000108: 30,3101 03253 UNFC/2 # INPUT VECTORS NEED NOT BE SEMI-UNIT 038378,000109: 30,3102 40200 FINDCDUW BOV SETPD # FINDCDUW: ENTRY WHEN UNFC/2 IN MPAC 038379,000110: 30,3103 61102 FINDCDUW # INTERPRETER NOW INITIALIZED 038380,000111: 30,3104 00023 22 # LOCS 0 THRU 21 FOR DIRECTION COSINE MAT 038381,000112: 30,3105 77420 STQ EXIT 038382,000113: 30,3106 03246 QCDUWUSR # SAVE RETURN ADDRESS 038383,000114: 038384,000115: # MORE HAUSKEEPING 038385,000116: 30,3107 33752 CA ECDUWL 038386,000117: 30,3110 56003 XCH EBANK # SET EBANK 038387,000118: 30,3111 55645 TS ECDUWUSR # SAVE USER'S EBANK 038388,000119: 038389,000120: 30,3112 30111 CA DAPBOOLS 038390,000121: 30,3113 74737 MASK CSMDOCKD # CSMDOCKD MUST NOT BE BIT15 038391,000122: 30,3114 10000 CCS A 038392,000123: 30,3115 34753 CA ONE # INDEX IF CSM DOCKED 038393,000124: 30,3116 55647 TS NDXCDUW 038394,000125: 038395,000126: 30,3117 34743 CA XOVINHIB # XOVINHIB MUST NOT BE BIT15 038396,000127: 30,3120 55651 TS FLPAUTNO # SET TO POS-NON-ZERO FLAG PNGCS AUTO NOT 038397,000128: 038398,000129: 30,3121 70111 MASK DAPBOOLS 038399,000130: 30,3122 55650 TS FLAGOODW # FLAG0ODW = ANY PNZ NUMBER IF XOV INHIBTD 038400,000131: 038401,000132: # Page 910 038402,000133: # FETCH BASIC DATA 038403,000134: 30,3123 00004 INHINT # RELINT AT PAUTNO (TC INTPRET) 038404,000135: 038405,000136: 30,3124 30032 CA CDUX # FETCH CDUX,CDUY,CDUZ IN ALL CASES, BUT 038406,000137: 30,3125 54771 TS CDUSPOTX # REPLACE BELOW IF PNGCS AUTO 038407,000138: 30,3126 30033 CA CDUY 038408,000139: 30,3127 54765 TS CDUSPOTY 038409,000140: 30,3130 30034 CA CDUZ 038410,000141: 30,3131 54767 TS CDUSPOTZ 038411,000142: 038412,000143: 30,3132 34742 CA BIT10 # PNGCS CONTROL BIT 038413,000144: 30,3133 00006 EXTEND 038414,000145: 30,3134 02030 RAND CHAN30 038415,000146: 30,3135 10000 CCS A 038416,000147: 30,3136 13153 TCF PAUTNO # NOT PNGCS (BITS INVERTED) 038417,000148: 038418,000149: 30,3137 34736 CA BIT14 # AUTO MODE BIT 038419,000150: 30,3140 00006 EXTEND 038420,000151: 30,3141 02031 RAND CHAN31 038421,000152: 30,3142 10000 CCS A 038422,000153: 30,3143 13153 TCF PAUTNO # NOT AUTO (BITS INVERTED) 038423,000154: 038424,000155: 30,3144 55651 TS FLPAUTNO # RESET FLAG PNGCS AUTO NOT 038425,000156: 038426,000157: 30,3145 31634 CA CDUXD # PNGCS AUTO: FETCH CDUXD,CDUYD,CDUZD 038427,000158: 30,3146 54771 TS CDUSPOTX 038428,000159: 30,3147 31635 CA CDUYD 038429,000160: 30,3150 54765 TS CDUSPOTY 038430,000161: 30,3151 31636 CA CDUZD 038431,000162: 30,3152 54767 TS CDUSPOTZ 038432,000163: 038433,000164: # Page 911 038434,000165: # FETCH INPUTS 038435,000166: 30,3153 06042 PAUTNO TC INTPRET # ENTERING THRUST CMD STILL IN MPAC 038436,000167: 30,3154 77634 RTB 038437,000168: 30,3155 21727 NORMUNIT 038438,000169: 30,3156 24001 STOVL UNX/2 # SEMI-UNIT THRUST CMD AS INITIAL UNX/2 038439,000170: 30,3157 03261 UNWC/2 038440,000171: 30,3160 47034 RTB RTB 038441,000172: 30,3161 21727 NORMUNIT 038442,000173: 30,3162 47617 QUICTRIG # ALWAYS RQD TO OBTAIN TRIGS OF CDUD'S 038443,000174: 30,3163 24015 STOVL UNZ/2 # SEMI-UNIT WINDOW CMD AS INITIAL UNZ/2 038444,000175: 30,3164 00325 DELV 038445,000176: 30,3165 53404 BOVB UNIT 038446,000177: 30,3166 61741 NOATTCNT # AT LEAST ONE ENTERING CMD VCT ZERO 038447,000178: 30,3167 45000 BOV CALL 038448,000179: 30,3170 61204 AFTRFLTR # IF UNIT DELV OVERFLOWS SKIP FILTER 038449,000180: 30,3171 47673 *SMNB* # YIELDS UNIT(DELV) IN VEH COORDS FOR FLTR 038450,000181: 038451,000182: # THRUST DIRECTION FILTER 038452,000183: 038453,000184: 30,3172 77776 EXIT 038454,000185: 038455,000186: 30,3173 31670 CA UNFVY/2 # FOR RESTARTS, UNFV/2 ALWAYS INTACT, MPAC 038456,000187: 30,3174 22157 LXCH MPAC +3 # RENEWD AFTER RETURN FROM CALLER, 038457,000188: 30,3175 03474 TC FLTRSUB # TWO FILTER UPDATES MAY BE DONE. 038458,000189: 30,3176 55670 TS UNFVY/2 # UNFV/2 NEED NOT BE EXACTLY SEMI-UNIT. 038459,000190: 038460,000191: 30,3177 31672 CA UNFVZ/2 038461,000192: 30,3200 22161 LXCH MPAC +5 038462,000193: 30,3201 03474 TC FLTRSUB 038463,000194: 30,3202 55672 TS UNFVZ/2 038464,000195: 038465,000196: 30,3203 06042 TC INTPRET # COMPLETES FILTER 038466,000197: 038467,000198: # Page 912 038468,000199: # FIND A SUITABLE WINDOW POINTING VECTOR 038469,000200: 038470,000201: 30,3204 46135 AFTRFLTR SLOAD BHIZ # IF XOV NOT INHIBITED, GO FETCH ZNB 038471,000202: 30,3205 03251 FLAGOODW 038472,000203: 30,3206 61212 FETCHZNB 038473,000204: 30,3207 45175 VLOAD CALL 038474,000205: 30,3210 00015 UNZ/2 038475,000206: 30,3211 61514 UNWCTEST 038476,000207: 038477,000208: 30,3212 77775 FETCHZNB VLOAD 038478,000209: 30,3213 02162 ZNBPIP 038479,000210: 30,3214 34015 STCALL UNZ/2 038480,000211: 30,3215 61514 UNWCTEST 038481,000212: 038482,000213: 30,3216 57575 VLOAD VCOMP # Z AND -X CAN'T BOTH PARALLEL UNFC/2 038483,000214: 30,3217 02146 XNBPIP 038484,000215: 30,3220 00015 STORE UNZ/2 038485,000216: 038486,000217: # COMPUTE THE REQUIRED DIRECTION COSINE MATRIX 038487,000218: 038488,000219: 30,3221 47375 DCMCL VLOAD VXV 038489,000220: 30,3222 00015 UNZ/2 038490,000221: 30,3223 00001 UNX/2 038491,000222: 30,3224 41456 UNIT PUSH # UNY/2 FIRST ITERATION 038492,000223: 30,3225 76435 VXV VSL1 038493,000224: 30,3226 00001 UNX/2 038494,000225: 30,3227 00015 STORE UNZ/2 # -UNZ/2 FIRST ITERATION 038495,000226: 30,3230 63361 VXSC PDVL # EXCHANGE -UNFVZ/2 UNZ/2 FOR UNY/2 038496,000227: 30,3231 03273 UNFVZ/2 # MUST BE SMALL 038497,000228: 30,3232 51361 VXSC BVSU # YIELDS -UNFVY/2 UNY/2-UNFVZ/2 UNZ/2 038498,000229: 30,3233 03271 UNFVY/2 # MUST BE SMALL 038499,000230: 30,3234 53372 VSL1 VAD 038500,000231: 30,3235 00001 UNX/2 038501,000232: 30,3236 77656 UNIT # TOTALLY ELIMINATES THRUST POINTING ERROR 038502,000233: 30,3237 00001 STORE UNX/2 # UNX/2 038503,000234: 30,3240 76435 VXV VSL1 038504,000235: 30,3241 00015 UNZ/2 # -UNZ/2 WAS STORED HERE REMEMBER 038505,000236: 30,3242 00007 STORE UNY/2 # UNY/2 038506,000237: 30,3243 47276 VCOMP VXV 038507,000238: 30,3244 00001 UNX/2 038508,000239: 30,3245 77772 VSL1 038509,000240: 30,3246 00015 STORE UNZ/2 # UNZ/2 038510,000241: 038511,000242: # Page 913 038512,000243: # COMPUTES THE REQUIRED GIMBAL ANGLES 038513,000244: 038514,000245: 30,3247 77624 CALL 038515,000246: 30,3250 61524 NB2CDUSP # YIELDS THE RQD GIMBAL ANGLES, 2'S, PI 038516,000247: 30,3251 77776 EXIT 038517,000248: 038518,000249: # BIAS OUTER GIMBAL ANGLE 038519,000250: 038520,000251: 30,3252 31677 CA OGABIAS 038521,000252: 30,3253 26154 ADS MPAC 038522,000253: 038523,000254: # LIMIT THE MIDDLE GIMBAL ANGLE & COMPUTE THE UNLIMITED GIMBAL ANGLE CHGS 038524,000255: 038525,000256: 30,3254 30156 CA MPAC +2 # LIMIT THE MGA 038526,000257: 30,3255 54001 TS L # CAN'T LXCH: NEED UNLIMITED MGA FOR ALARM 038527,000258: 30,3256 33764 CA CDUZDLIM 038528,000259: 30,3257 03720 TC LIMITSUB # YIELDS LIMITED MGA. 1 BIT ERROR POSSIBLE 038529,000260: 30,3260 56156 XCH MPAC +2 # BECAUSE USING 2'S COMP. WHO CARES? 038530,000261: 30,3261 00006 EXTEND 038531,000262: 30,3262 20156 MSU MPAC +2 # THIS BETTER YIELD ZERO 038532,000263: 30,3263 00006 EXTEND 038533,000264: 30,3264 13266 BZF +2 038534,000265: 30,3265 13747 TCF ALARMMGA 038535,000266: 038536,000267: 30,3266 00004 MGARET INHINT # RELINT AT TC INTPRET AFTER TCQCDUW 038537,000268: 038538,000269: 30,3267 22007 ZL 038539,000270: 30,3270 34752 CA TWO 038540,000271: 30,3271 54142 DELGMBLP TS TEM2 038541,000272: 038542,000273: 30,3272 30001 CA L # TO PREVENT FALSE STARTS ABOUT X, ZERO 038543,000274: 30,3273 00006 EXTEND # FLAGOODW IF DELGMBZ OR Y TOO BIG. 038544,000275: 30,3274 70000 SQUARE 038545,000276: 30,3275 64350 AD HI5 # WITHIN 1 BIT OF -(45 DEG SQUARED) 038546,000277: 30,3276 00006 EXTEND 038547,000278: 30,3277 63302 BZMF +3 038548,000279: 30,3300 34755 CA ZERO 038549,000280: 30,3301 55650 TS FLAGOODW 038550,000281: 038551,000282: 30,3302 50142 INDEX TEM2 038552,000283: 30,3303 30154 CA MPAC 038553,000284: 30,3304 50142 INDEX TEM2 038554,000285: 30,3305 54321 TS CPHI # OUTPUTS TO NOUN22 038555,000286: 30,3306 00006 EXTEND 038556,000287: 30,3307 50142 INDEX TEM2 038557,000288: 30,3310 21634 MSU CDUXD 038558,000289: 30,3311 40000 COM 038559,000290: 30,3312 50142 INDEX TEM2 038560,000291: 30,3313 55674 TS -DELGMB # -UNLIMITED GIMBAL ANGLE CHGS, 1'S, PI 038561,000292: 30,3314 54001 TS L # FOR PRECEDING TEST ON NEXT LOOP PASS 038562,000293: # Page 914 038563,000294: 30,3315 10142 CCS TEM2 038564,000295: 30,3316 13271 TCF DELGMBLP 038565,000296: 038566,000297: # Page 915 038567,000298: # BRANCHES TO NOATTCNT 038568,000299: 30,3317 11651 CCS FLPAUTNO 038569,000300: 30,3320 13743 TCF NOATTCNT +2 # NO PNGCS AUTO 038570,000301: 038571,000302: 30,3321 30101 CA FLAGWRD5 038572,000303: 30,3322 74745 MASK ENGONBIT 038573,000304: 30,3323 00006 EXTEND 038574,000305: 30,3324 13743 BZF NOATTCNT +2 # ENGINE NOT ON 038575,000306: 038576,000307: # Page 916 038577,000308: # LIMIT THE ATTITUDE ANGLE CHANGES 038578,000309: 038579,000310: # THIS SECTION LIMITS THE ATTITUDE ANGLE CHANGES ABOUT A SET OF ORTHOGONAL VEHICLE AXES X,YPRIME,ZPRIME, 038580,000311: # THESE AXES COINCIDE WITH THE COMMANDED VEHICLE AXES IF AND ONLY IF CDUXD IS ZERO. THE PRIME SYSTEM IS 038581,000312: # THE COMMANDED VEHICLE SYSTEM ROTATED ABOUT THE X AXIS TO BRING THE Z AXIS INTO ALIGNMENT WITH THE MIDDLE GIMBAL 038582,000313: # AXIS. ATTITUDE ANGLE CHANGES IN THE PRIME SYSTEM ARE RELATED TO SMALL GIMBAL ANGLE CHANGES BY: 038583,000314: 038584,000315: # [ -DELATTX ] [ 1 SIN(CDUZD) 0 ] [ -DELGMBX ] 038585,000316: # [ ] [ ] [ ] 038586,000317: # [ -DELATTYPRIME ] = [ 0 COS(CDUZD) 0 ] [ -DELGMBY ] 038587,000318: # [ ] [ ] [ ] 038588,000319: # [ -DELATTZPRIME ] [ 0 0 1 ] [ -DELGMBZ ] 038589,000320: 038590,000321: 30,3325 23676 LXCH -DELGMB +2 # SAME AS -DELATTZPRIME UNLIMITED 038591,000322: 30,3326 51647 INDEX NDXCDUW 038592,000323: 30,3327 33760 CA DAZMAX 038593,000324: 30,3330 03720 TC LIMITSUB 038594,000325: 30,3331 55676 TS -DELGMB +2 # -DELGMBZ 038595,000326: 038596,000327: 30,3332 31675 CA -DELGMB +1 038597,000328: 30,3333 00006 EXTEND 038598,000329: 30,3334 70745 MP COSCDUZ # YIELDS -DELATTYPRIME/2 UNLIMITED 038599,000330: 30,3335 54001 TS L 038600,000331: 30,3336 51647 INDEX NDXCDUW 038601,000332: 30,3337 33762 CA DAY/2MAX 038602,000333: 30,3340 03720 TC LIMITSUB 038603,000334: 30,3341 00006 EXTEND 038604,000335: 30,3342 10745 DV COSCDUZ 038605,000336: 30,3343 57675 XCH -DELGMB +1 # -DELGMBY, FETCHING UNLIMITED VALUE 038606,000337: 038607,000338: 30,3344 00006 EXTEND 038608,000339: 30,3345 70737 MP SINCDUZ 038609,000340: 30,3346 20001 DDOUBL 038610,000341: 30,3347 40000 COM 038611,000342: 30,3350 00006 EXTEND # YIELDS +DELATTX UNLIMITD, MAG < 180 DEG. 038612,000343: 30,3351 21674 MSU -DELGMB # BASED ON UNLIMITED DELGMBV. 038613,000344: 30,3352 54001 TS L # ONE BIT ERROR IF OPERANDS IN MSU 038614,000345: 30,3353 51647 INDEX NDXCDUW # OF MIXED SIGNS. WHO CARES? 038615,000346: 30,3354 33760 CA DAXMAX 038616,000347: 30,3355 03720 TC LIMITSUB 038617,000348: 30,3356 55674 TS -DELGMB # SAVE LIMITED +DELATTX 038618,000349: 30,3357 11650 CCS FLAGOODW 038619,000350: 30,3360 41674 CS -DELGMB # FETCH IT BACK CHNING SIGN IF WINDOW GOOD 038620,000351: 30,3361 55674 TS -DELGMB # OTHERWISE USE ZERO FOR -DELATTX 038621,000352: 30,3362 41675 CS -DELGMB +1 038622,000353: 30,3363 00006 EXTEND 038623,000354: 30,3364 70737 MP SINCDUZ 038624,000355: 30,3365 20001 DDOUBL # YIELDS -CNTRIB TO -DELATTX FROM -DELGMBY 038625,000356: 30,3366 27674 ADS -DELGMB # -DELGMBX. NO OVERFLOW SINCE LIMITED TO 038626,000357: # 20DEG(1+SIN(70DEG)/COS(70DEG)) < 180DEG 038627,000358: 038628,000359: # Page 917 038629,000360: # COMPLTE COMMANDED ATTITUDE RATES 038630,000361: 038631,000362: # [ OMEGAPD ] [ -2 -4 SINCDUZ +0 ] [ -DELGMBZ ] 038632,000363: # [ ] [ ] [ ] 038633,000364: # [ OMEGAQD ] = [ +0 -8 COSCDUZ COSCDUX -4 SINCDUX ] [ -DELGMBY ] 038634,000365: # [ ] [ ] [ ] 038635,000366: # [ OMEGARD ] [ +0 +9 COSCDUZ SINCDUX -4 COSCDUX ] [ -DELGMBZ ] 038636,000367: 038637,000368: # ATTITUDE ANGLE RATES IN UNITS OF PI/4 RAD/SEC = K TRIG FCNS IN UNITS OF 2 X GIMBAL ANGLE RATES IN UNITS OF 038638,000369: # PI/2 RAD/SEC. THE CONSTANTS ARE BASED ON DELGMB BEING THE GIMBAL ANGLE CHANGES IN UNITS OF PI RADIANS, 038639,000370: # AND 2 SECONDS BEING THE COMPUTATION PERIOD (THE PERIOD BETWEEN SUCCESSIVE PASSES THRU FINDCDUW). 038640,000371: 038641,000372: 30,3367 41674 CS -DELGMB 038642,000373: 30,3370 55642 TS OMEGAPD 038643,000374: 30,3371 41675 CS -DELGMB +1 038644,000375: 30,3372 00006 EXTEND 038645,000376: 30,3373 70737 MP SINCDUZ 038646,000377: 30,3374 20001 DDOUBL 038647,000378: 30,3375 27642 ADS OMEGAPD 038648,000379: 30,3376 27642 ADS OMEGAPD 038649,000380: 038650,000381: 30,3377 41675 CS -DELGMB +1 038651,000382: 30,3400 00006 EXTEND 038652,000383: 30,3401 70747 MP COSCDUX 038653,000384: 30,3402 20001 DDOUBL 038654,000385: 30,3403 00006 EXTEND 038655,000386: 30,3404 70745 MP COSCDUZ 038656,000387: 30,3405 55643 TS OMEGAQD 038657,000388: 30,3406 41676 CS -DELGMB +2 038658,000389: 30,3407 00006 EXTEND 038659,000390: 30,3410 70741 MP SINCDUX 038660,000391: 30,3411 27643 ADS OMEGAQD 038661,000392: 30,3412 27643 ADS OMEGAQD 038662,000393: 30,3413 27643 ADS OMEGAQD 038663,000394: 038664,000395: 30,3414 31675 CA -DELGMB +1 038665,000396: 30,3415 00006 EXTEND 038666,000397: 30,3416 70741 MP SINCDUX 038667,000398: 30,3417 20001 DDOUBL 038668,000399: 30,3420 00006 EXTEND 038669,000400: 30,3421 70745 MP COSCDUZ 038670,000401: 30,3422 55644 TS OMEGARD 038671,000402: 30,3423 41676 CS -DELGMB +2 038672,000403: 30,3424 00006 EXTEND 038673,000404: 30,3425 70747 MP COSCDUX 038674,000405: 30,3426 27644 ADS OMEGARD 038675,000406: 30,3427 27644 ADS OMEGARD 038676,000407: 30,3430 27644 ADS OMEGARD 038677,000408: 038678,000409: # Page 918 038679,000410: # FINAL TRANSFER 038680,000411: 038681,000412: 30,3431 34752 CA TWO 038682,000413: 30,3432 54142 CDUWXFR TS TEM2 038683,000414: 30,3433 50142 INDEX TEM2 038684,000415: 30,3434 31674 CA -DELGMB 038685,000416: 30,3435 00006 EXTEND 038686,000417: 30,3436 73765 MP DT/DELT # RATIO OF DAP INTERVAL TC CDUW INTERVAL 038687,000418: 30,3437 03734 TC ONESTO2S 038688,000419: 30,3440 50142 INDEX TEM2 038689,000420: 30,3441 55637 TS DELCDUX # ANGLE INTERFACE 038690,000421: 038691,000422: 30,3442 50142 INDEX TEM2 038692,000423: 30,3443 11642 CCS OMEGAPD 038693,000424: 30,3444 64753 AD ONE 038694,000425: 30,3445 13447 TCF +2 038695,000426: 30,3446 64753 AD ONE 038696,000427: 30,3447 00006 EXTEND # WE NOW HAVE ABS(OMEGAPD,QD,RD) 038697,000428: 30,3450 50142 INDEX TEM2 038698,000429: 30,3451 71642 MP OMEGAPD 038699,000430: 30,3452 00006 EXTEND 038700,000431: 30,3453 74741 MP BIT11 # 1/16 038701,000432: 30,3454 00006 EXTEND 038702,000433: 30,3455 50142 INDEX TEM2 # 2 038703,000434: 30,3456 11530 DV 1JACC # UNITS P/4 RAD/SEC 038704,000435: 30,3457 54001 TS L 038705,000436: 30,3460 33762 CA DELERLIM 038706,000437: 30,3461 03720 TC LIMITSUB 038707,000438: 30,3462 50142 INDEX TEM2 038708,000439: 30,3463 55274 TS DELPEROR # LAG ANGLE = OMEGA ABS(OMEGA)/2 ACCEL 038709,000440: 30,3464 10142 CCS TEM2 038710,000441: 30,3465 13432 TCF CDUWXFR 038711,000442: 038712,000443: # HAUSKEEPING AND RETURN 038713,000444: 038714,000445: 30,3466 31645 TCQCDUW CA ECDUWUSR 038715,000446: 30,3467 54003 TS EBANK # RETURN USER'S EBANK 038716,000447: 038717,000448: 30,3470 06042 TC INTPRET 038718,000449: 30,3471 52001 SETPD GOTO 038719,000450: 30,3472 00001 0 038720,000451: 30,3473 03246 QCDUWUSR # NORMAL AND ABNORMAL RETURN TO USER 038721,000452: 038722,000453: # Page 919 038723,000454: # THRUST VECTOR FILTER SUBROUTINE 038724,000455: 038725,000456: 30,3474 00006 FLTRSUB EXTEND 038726,000457: 30,3475 22142 QXCH TEM2 038727,000458: 30,3476 54143 TS TEM3 # SAVE ORIGINAL OFFSET 038728,000459: 30,3477 40000 COM # ONE MCT, NO WDS, CAN BE SAVED IF NEG OF 038729,000460: 30,3500 60001 AD L # ORIG OFFSET ARRIVES IN A, BUT IT'S 038730,000461: 30,3501 00006 EXTEND # NOT WORTH THE INCREASED OBSCURITY. 038731,000462: 30,3502 51647 INDEX NDXCDUW 038732,000463: 30,3503 73753 MP GAINFLTR 038733,000464: 30,3504 54001 TS L # INCR TO OFFSET, UNLIMITED 038734,000465: 30,3505 33755 CA DUNFVLIM # SAME LIMIT FOR Y AND Z 038735,000466: 30,3506 03720 TC LIMITSUB # YIELDS INCR TO OFFSET, LIMITED 038736,000467: 30,3507 60143 AD TEM3 # ORIGINAL OFFSET 038737,000468: 30,3510 54001 TS L # TOTAL OFFSET, UNLIMITED 038738,000469: 30,3511 33756 CA UNFVLIM # SAME LIMIT FOR Y AND Z 038739,000470: 30,3512 03720 TC LIMITSUB # YIELDS TOTAL OFFSET, LIMITED 038740,000471: 30,3513 00142 TC TEM2 038741,000472: 038742,000473: # SUBR TO TEST THE ANGLE BETWEEN THE PROPOSED WINDOW AND THRUST CMD VCTS 038743,000474: 038744,000475: 30,3514 63441 UNWCTEST DOT DSQ 038745,000476: 30,3515 00001 UNX/2 038746,000477: 30,3516 50025 DSU BMN 038747,000478: 30,3517 21760 DOTSWFMX 038748,000479: 30,3520 61221 DCMCL 038749,000480: 30,3521 43531 SSP RVQ # RVQ FOR ALT CHOICE IF DOT MAGN TOO LARGE 038750,000481: 30,3522 03251 FLAGOODW # ZEROING WINDOW GOOD FLAG 038751,000482: 30,3523 00000 0 038752,000483: 038753,000484: # Page 920 038754,000485: # NB2CDUSP RETURNS THE 2'S COMPLEMENT, PI, SP CDU ANGLES X,Y,Z IN MPAC,+1,+2 GIVEN THE MATRIX WHOSE ROW VECTORS 038755,000486: # ARE THE SEMI-UNIT NAV BASE VECTORS X,Y,X EXPRESSED IN STABLE MEMBER COORDINATES, LOCATED AT 0 IN THE PUSH LIST. 038756,000487: # NB2CDUSP USES THE ARCTRGSP WHICH HAS A MAXIMUM ERROR OF +-4 BITS. 038757,000488: 038758,000489: 30,3524 63545 NB2CDUSP DLOAD DSQ 038759,000490: 30,3525 00003 2 038760,000491: 30,3526 51021 BDSU BPL 038761,000492: 30,3527 06514 DP1/4TH 038762,000493: 30,3530 61533 +3 038763,000494: 30,3531 77745 DLOAD 038764,000495: 30,3532 06524 ZEROVECS # IN CASE SIN WAS SLIGHTLY > 1/2 038765,000496: 30,3533 77566 SQRT EXIT # YIELDS COS(CDUZ) IN UNITS OF 2 038766,000497: 038767,000498: 30,3534 00006 EXTEND 038768,000499: 30,3535 30155 DCA MPAC 038769,000500: 30,3536 20001 DDOUBL 038770,000501: 30,3537 54145 TS TEM5 038771,000502: 30,3540 13543 TCF +3 038772,000503: 30,3541 34733 CA POSMAX # OVERFLOW. FETCH POSMAX, MPAC ALWAYS POS 038773,000504: 30,3542 54145 TS TEM5 # COS(CDUZ) IN TEM5, UNITS 1 038774,000505: 038775,000506: 30,3543 50120 INDEX FIXLOC 038776,000507: 30,3544 30002 CA 2 038777,000508: 30,3545 22154 LXCH MPAC 038778,000509: 30,3546 03613 TC ARCTRGSP 038779,000510: 30,3547 54156 TS MPAC +2 # CDUZ 038780,000511: 038781,000512: 30,3550 34755 CA ZERO 038782,000513: 30,3551 03571 TC DVBYCOSM 038783,000514: 30,3552 34751 CA FOUR 038784,000515: 30,3553 03571 TC DVBYCOSM 038785,000516: 30,3554 40141 CS TEM1 038786,000517: 30,3555 03613 TC ARCTRGSP 038787,000518: 30,3556 54155 TS MPAC +1 # CDUY 038788,000519: 038789,000520: 30,3557 34750 CA BIT4 038790,000521: 30,3560 03571 TC DVBYCOSM 038791,000522: 30,3561 33570 CA 16OCT 038792,000523: 30,3562 03571 TC DVBYCOSM 038793,000524: 30,3563 40141 CS TEM1 038794,000525: 30,3564 03613 TC ARCTRGSP 038795,000526: 30,3565 54154 TS MPAC # CDUX 038796,000527: 038797,000528: 30,3566 06042 TC INTPRET 038798,000529: 30,3567 77616 RVQ 038799,000530: 038800,000531: 30,3570 00016 16OCT OCT 16 038801,000532: 038802,000533: # Page 921 038803,000534: # THE ELEMENTS OF THE NAV BASE MATRIX WHICH WE MUST DIVIDE BY COS(MGA) 038804,000535: # ALREADY CONTAIN COS(MGA)/2 AS A FACTOR. THEREFORE THE QUOTIENT SHOULD 038805,000536: # ORDINARILY NEVER EXCEED 1/2 IN MAGNITUDE. BUT IF THE MGA IS NEAR PI/2 038806,000537: # THEN COS(MGA) IS NEAR ZERO, AND THERE MAY BE SOME CHAFF IN THE OTHER 038807,000538: # ELEMENTS OF THE MATRIX WHICH WOULD PRODUCE CHAOS UNDER DIVISION. 038808,000539: # BEFORE DIVIDING WE MAKE SURE COS(MGA) IS AT LEAST ONE BIT LARGER 038809,000540: # THAN THE MAGNITUDE OF THE HIGH ORDER PART OF THE OPERAND. 038810,000541: 038811,000542: # IF ONE OR MORE DIVIDES CANNOT BE PERFORMED, THIS MEANS THAT THE 038812,000543: # REQUIRED MGA IS VERY NEARLY +-PI/2 AND THEREFORE THE OTHER GIMBAL 038813,000544: # ANGLES ARE INDETERMINATE. THE INNER AND OUTER GIMBAL ANGLES RETURNED 038814,000545: # IN THIS CASE WILL BE RANDOM MULTIPLES OF PI/2. 038815,000546: 038816,000547: 30,3571 60120 DVBYCOSM AD FIXLOC 038817,000548: 30,3572 54116 TS ADDRWD # ADRES OF OPERAND 038818,000549: 038819,000550: 30,3573 50116 INDEX ADDRWD # FETCH NEG ABS OF OPERAND, AD TEM5, AND 038820,000551: 30,3574 30000 CA 0 # SKIP DIVIDE IF RESULT NEG OR ZERO 038821,000552: 30,3575 00006 EXTEND 038822,000553: 30,3576 63600 BZMF +2 038823,000554: 30,3577 40000 COM 038824,000555: 30,3600 60145 AD TEM5 # C(A) ZERO OR NEG, C(TEM5) ZERO OR POS 038825,000556: 30,3601 00006 EXTEND 038826,000557: 30,3602 63610 BZMF TSL&TCQ # DIFFERENCE ALWAYS SMALL IF BRANCH 038827,000558: 038828,000559: 30,3603 00006 EXTEND # TEM5 EXCEEDS ABS HIGH ORDER PART OF 038829,000560: 30,3604 50116 INDEX ADDRWD # OPERAND BY AT LEAST ONE BIT. 038830,000561: 30,3605 30001 DCA 0 # THEREFORE IT EXCEEDS THE DP OPERAND 038831,000562: 30,3606 00006 EXTEND # AND DIVISION WILL ALWAYS SUCCEED. 038832,000563: 30,3607 10145 DV TEM5 038833,000564: 30,3610 54001 TSL&TCQ TS L 038834,000565: 30,3611 22141 LXCH TEM1 038835,000566: 30,3612 00002 TC Q 038836,000567: 038837,000568: # Page 922 038838,000569: # ARCTRGSP RETURNS THE 2'S COMPLEMENT, PI, SP ANGLE IN THE A REGISTER GIVEN ITS SINE IN A AND ITS COSINE IN L IN 038839,000570: # UNITS OF 2. THE RESULT IS AN UNAMBIGUOUS ANGLE ANYWHERE IN THE CIRCLE, WITH A MAXIMUM ERROR OF +-4 BITS. 038840,000571: # THE ERROR IS PRODUCED BY THE SUBROUTINE SPARCSIN WHICH IS USED ONLY IN THE REGION +-45 DEGREES. 038841,000572: 038842,000573: 30,3613 00006 ARCTRGSP EXTEND 038843,000574: 30,3614 13656 BZF SINZERO # TO AVOID DIVIDING BY ZERO 038844,000575: 038845,000576: 30,3615 00006 EXTEND 038846,000577: 30,3616 22144 QXCH TEM4 038847,000578: 30,3617 54142 TS TEM2 038848,000579: 30,3620 30001 CA L 038849,000580: 30,3621 54143 TS TEM3 038850,000581: 30,3622 34755 CA ZERO 038851,000582: 30,3623 00006 EXTEND 038852,000583: 30,3624 10142 DV TEM2 038853,000584: 30,3625 00006 EXTEND 038854,000585: 30,3626 13645 BZF USECOS 038855,000586: 038856,000587: 30,3627 10143 CCS TEM3 # SIN IS SMALLER OR EQUAL 038857,000588: 30,3630 34755 CA ZERO 038858,000589: 30,3631 13635 TCF +4 038859,000590: 30,3632 40142 CS TEM2 # IF COS NEG, REVERSE SIGN OF SIN, 038860,000591: 30,3633 54142 TS TEM2 # ANGLE = PI-ARCSIN(SIN) 038861,000592: 30,3634 34735 CA NEGMAX # PICK UP PI, 2'S COMPLEMENT 038862,000593: 30,3635 54143 TS TEM3 # WE NO LONGER NEED COS 038863,000594: 30,3636 30142 CA TEM2 038864,000595: 30,3637 03663 TC SPARCSIN -1 038865,000596: 30,3640 03734 TC ONESTO2S 038866,000597: 30,3641 00006 EXTEND 038867,000598: 30,3642 20143 MSU TEM3 038868,000599: 30,3643 03734 1TO2&TCQ TC ONESTO2S 038869,000600: 30,3644 00144 TC TEM4 038870,000601: 038871,000602: 30,3645 40143 USECOS CS TEM3 # COS IS SMALLER 038872,000603: 30,3646 03663 TC SPARCSIN -1 # ANGLE = SIGN(SIN)(FI/2-ARCSIN(COS)) 038873,000604: 30,3647 64736 AD HALF 038874,000605: 30,3650 54143 TS TEM3 # WE NO LONGER NEED COS 038875,000606: 30,3651 10142 CCS TEM2 038876,000607: 30,3652 30143 CA TEM3 038877,000608: 30,3653 13643 TCF 1TO2&TCQ 038878,000609: 30,3654 40143 CS TEM3 038879,000610: 30,3655 13643 TCF 1TO2&TCQ 038880,000611: 038881,000612: 30,3656 10001 SINZERO CCS L 038882,000613: 30,3657 34755 CA ZERO 038883,000614: 30,3660 00002 TC Q 038884,000615: 30,3661 34735 CA NEGMAX # PI, 2'S COMP 038885,000616: 30,3662 00002 TC Q 038886,000617: 038887,000618: # Page 923 038888,000619: # SPARCSIN TAKES AN ARGUMENT SCALED UNITY IN A AND RETURNS AN ANGLE SCALED 038889,000620: # 180 DEGREES IN A. IT HAS BEEN UNIT TESTED IN THE REGION +-.94 (+-70 038890,000621: # DEGREES) AND THE MAXIMUM ERROR IS +-5 BITS WITH AN AVERAGE TIME OF 038891,000622: # 450 MICROSECONDS. SPARCSIN -1 TAKES THE ARGUMENT SCALED TWO. (BOB CRISP) 038892,000623: 038893,000624: 30,3663 60000 DOUBLE 038894,000625: 30,3664 54021 SPARCSIN TS SR 038895,000626: 30,3665 13671 TCF +4 038896,000627: 30,3666 50000 INDEX A 038897,000628: 30,3667 44734 CS LIMITS 038898,000629: 30,3670 54021 TS SR 038899,000630: 30,3671 00006 EXTEND 038900,000631: 30,3672 70000 MP A 038901,000632: 30,3673 54141 TS TEM1 038902,000633: 30,3674 00006 EXTEND 038903,000634: 30,3675 73717 MP DPL9 038904,000635: 30,3676 63716 AD DPL7 038905,000636: 30,3677 00006 EXTEND 038906,000637: 30,3700 70141 MP TEM1 038907,000638: 30,3701 63715 AD DPL5 038908,000639: 30,3702 00006 EXTEND 038909,000640: 30,3703 70141 MP TEM1 038910,000641: 30,3704 63714 AD DPL3 038911,000642: 30,3705 00006 EXTEND 038912,000643: 30,3706 70141 MP TEM1 038913,000644: 30,3707 63713 AD DPL1 038914,000645: 30,3710 00006 EXTEND 038915,000646: 30,3711 70021 MP SR 038916,000647: 30,3712 00002 TC Q 038917,000648: 30,3713 24406 DPL1 DEC 10502 B-14 038918,000649: 30,3714 00660 DPL3 DEC 432 B-14 038919,000650: 30,3715 16204 DPL5 DEC 7300 B-14 038920,000651: 30,3716 50744 DPL7 DEC -11803 B-14 038921,000652: 30,3717 20315 DPL9 DEC 8397 B-14 038922,000653: 038923,000654: # Page 924 038924,000655: # LIMITSUB LIMITS THE MAGNITUDE OF THE POSITIVE OR NEGATIVE VARIABLE 038925,000656: # ARRIVING IN L TO THE POSITIVE LIMIT ARRIVING IN A. 038926,000657: # THE SIGNED LIMITED VARIABLE IS RETURNED IN A. 038927,000658: 038928,000659: # VERSION COUTESY HUGH BLAIR-SMITH 038929,000660: 038930,000661: 30,3720 54141 LIMITSUB TS TEM1 038931,000662: 30,3721 34755 CA ZERO 038932,000663: 30,3722 00006 EXTEND 038933,000664: 30,3723 10141 DV TEM1 038934,000665: 30,3724 10000 CCS A 038935,000666: 30,3725 22141 LXCH TEM1 038936,000667: 30,3726 13730 TCF +2 038937,000668: 30,3727 13732 TCF +3 038938,000669: 30,3730 30001 CA L 038939,000670: 30,3731 00002 TC Q 038940,000671: 30,3732 40141 CS TEM1 038941,000672: 30,3733 00002 TC Q 038942,000673: 038943,000674: # SUBROUTINE TO CONVERT 1'S COMP SP TO 2'S COMP 038944,000675: 038945,000676: 30,3734 10000 ONESTO2S CCS A 038946,000677: 30,3735 64753 AD ONE 038947,000678: 30,3736 00002 TC Q 038948,000679: 30,3737 40000 CS A 038949,000680: 30,3740 00002 TC Q 038950,000681: 038951,000682: # NO ATTITUDE CONTROL 038952,000683: 038953,000684: 30,3741 05567 NOATTCNT TC ALARM 038954,000685: 30,3742 00402 OCT 00402 # NO ATTITUDE CONTROL 038955,000686: 038956,000687: 30,3743 00004 +2 INHINT # COME HERE FOR NOATTCNT WITHOUT ALARM 038957,000688: 30,3744 04674 TC IBNKCALL # RELINT AT TC INTPRET AFTER TCQCDUW 038958,000689: 30,3745 40166 FCADR STOPRATE 038959,000690: 30,3746 13466 TCF TCQCDUW # RETURN TO USER SKIPPING AUTOPILOT CMDS 038960,000691: 038961,000692: # MIDDLE GIMBAL ANGLE ALARM 038962,000693: 038963,000694: 30,3747 05567 ALARMMGA TC ALARM 038964,000695: 30,3750 00401 OCT 00401 038965,000696: 30,3751 13266 TCF MGARET 038966,000697: 038967,000698: # Page 925 038968,000699: # ****************************************************************** 038969,000700: # CONSTANTS 038970,000701: # ****************************************************************** 038971,000702: 038972,000703: # ADDRESS CONSTANTS 038973,000704: 038974,000705: 30,3752 03245 ECDUWL ECADR ECDUW 038975,000706: 038976,000707: # THRUST DIRECTION FILTER CONSTANTS 038977,000708: 038978,000709: 30,3753 06315 GAINFLTR DEC .2 # GAIN FILTER SANS CSM 038979,000710: 30,3754 03146 DEC .1 # GAIN FILTER WITH CSM 038980,000711: 038981,000712: 30,3755 00071 DUNFVLIM DEC .007 B-1 # 7 MR MAX CHG IN F DIR IN VEH IN 2 SECS. 038982,000713: # THIS DOES NOT ALLOW FOR S/C ROT RATE. 038983,000714: 038984,000715: 30,3756 02041 UNFVLIM DEC .129 B-1 # 129 MR MAX THRUST OFFSET. 105 MR TRAVEL 038985,000716: # +10MR DEFL+5MR MECH MOUNT+9MR ABLATION. 038986,000717: 038987,000718: # CONSTANT RELATED TO GIMBAL ANGLE COMPUTATIONS 038988,000719: 038989,000720: 30,3757 01673 DOTSWFMX DEC .93302 B-4 # LIM COLNRTY OF UNWC/W & UNFC/2 TO 85 DEG 038990,000721: # LOWER PART COMES FROM NEXT CONSTANT 038991,000722: 038992,000723: 30,3760 03434 DAXMAX DEC .11111111111 # DELATTX LIM TO 20 DEG IN 2 SECS, 1'S, PI 038993,000724: 30,3761 00266 DEC .0111111111 # 2 DEG WHEN CSM DOCKED 038994,000725: 038995,000726: 30,3762 01616 DAY/2MAX DEC .05555555555 # LIKEWISE FOR DELATTY 038996,000727: 30,3763 00133 DEC .0055555555 038997,000728: 038998,000729: 30,3764 30,3760 DAZMAX = DAXMAX # LIKEWISE FOR DELATTZ 038999,000730: 039000,000731: 30,3764 14344 CDUZDLIM DEC .3888888888 # 70 DEG LIMIT FOR MGA, 1'S, PI 039001,000732: 039002,000733: # CONSTANTS FOR DATA TRANSFER 039003,000734: 039004,000735: 30,3765 01463 DT/DELT DEC .05 # .1 SEC/2 SEC WHICH IS THE AUTOPILOT 039005,000736: # CONTROL SAMPLE PERIOD/COMPUTATION PERIOD 039006,000737: 039007,000738: 30,3766 30,3762 DELERLIM = DAY/2MAX # 0 DEG LIMIT FOR LAG ANGLES, 1'S, PI 039008,000739: 039009,000740: # *** END OF FLY .153 *** End of include-file FINDCDUW--GUIDAP_INTERFACE.agc. Parent file is MAIN.agc