### FILE="Main.annotation" ## Copyright: Public domain. ## Filename: AOSTASK_AND_AOSJOB.agc ## Purpose: A section of Luminary revision 116. ## It is part of the source code for the Lunar Module's (LM) ## Apollo Guidance Computer (AGC) for Apollo 12. ## This file is intended to be a faithful transcription, except ## that the code format has been changed to conform to the ## requirements of the yaYUL assembler rather than the ## original YUL assembler. ## Reference: pp. 1475-1496 ## Assembler: yaYUL ## Contact: Ron Burkey . ## Website: www.ibiblio.org/apollo/index.html ## Mod history: 2017-01-22 MAS Created from Luminary 99. ## 2017-01-27 RRB Updated for Luminary 116. ## 2017-02-25 HG Add missing address setup ## BANK 20 ## SETLOC DAPS3 ## BANK ## COUNT* $$/DAPAO ## 2017-03-10 RSB Proofed comment text via 3-way diff vs ## Luminary 99 and 132 ... no problems found. ## 2017-03-14 RSB Comment-text fixes identified in 5-way ## side-by-side diff of Luminary 69/99/116/131/210. ## 2017-03-19 HG Replace .0125RS EQUALS BIT8 with .023R/S2 OCT 00356 ## Fix operand .0125RS --> .023R/S2 ## Update comments arround the change above ## Page 1475 # PROGRAM NAME: 1/ACCS # PROGRAM WRITTEN BY: BOB COVELLI AND MIKE HOUSTON # LAST MODIFICATION: FEB. 14, 1969 BY G. KALAN # PROGRAM DESCRIPTION: # 1/ACCS PROVIDES THE INTERFACE BETWEEN THE GUIDANCE PROGRAMS AND THE DIGITAL AUTOPILOT. WHENEVER THERE IS A # CHANGE IN THE MASS OF THE VEHICLE, IN THE DEADBAND SELECTED, IN THE VEHICLE CONFIGURATION (ASCENT-DESCENT- # DOCKED), AND DURING A FRESH START OR A RESTART, 1/ACCS IS CALLED TO COMMUNICATE THE DATA CHANGES TO THE DAP. # THE INPUTS TO 1/ACCS ARE MASS, ACCELERATION (ABDELV), DEADBAND (DB), OFFSET ACCELERATIONS (AOSQ AND AOSR), # STAGE VERIFY BIT (CHAN30, BIT2), DOCKED BIT (DAPBOOLS, BIT13), DRIFT BIT (DAPBOOLS, BIT8), USEQRJTS (DAPBOOLS, # BIT14), AND SURFACE FLAG (FLAGWRD8, BIT8), AND CH5MASK. # 1/ACCS COMPUTES THE JET ACCELERATIONS (1JACC, 1JACCQ, 1JACCR) AS FUNCTIONS OF MASS. 1JACCU AND 1JACCV ARE # FORMED BY RESOLVING 1JACCQ NAD 1JACCR. IN THE DESCENT CASE, THE DESCENT ENGINE MOMENT ARM (L, PVT-CG) IS ALSO # COMPUTED AS A FUNCTION OF MASS. THE RATE OF CHANGE OF ACCELERATION DUE TO ROTATION OF THE GIMBAL (ACCDOTQ, # ACCDOTR) IS ALSO COMPUTED IN THE DESCENT CASE. # AFTER THE ABOVE COMPUTATIONS, THE PROGRAM 1/ACCONT COMPUTES THE RECIPROCAL NET ACCELERATIONS ABOUT THE P, U, # AND V AXES (2 JETS FOR P AXIS, BOTH 1 AND 2 JETS FOR U AND V AXES), AND THE RECIPROCAL COAST ACCELERATIONS ABOUT # THE P, U, AND V AXES. THE ACCELERATION FUNCTIONS (ACCFCTZ1 AND ACCFCTZ5) ARE ALSO COMPUTED FOR THESE AXES. THE # FIRE AND COAST DEADBANDS AND AXISDIST ARE COMPUTED FOR EACH AXIS. FLAT AND ZONE3LIM, THE WIDTH AND HEIGHT OF THE # MINIMUM IMPULSE ZONE, ARE COMPUTED. 1/ACCONT ALSO SETS ACCSWU AND ACCSWV, WHICH INDICATE WHEN 1 JET ACCELERATION # IS NOT SUFFICIENT TO PRODUCE MINIMUM ACCELERATION. AT THE COMPLETION OF 1/ACCS, THE ACCSOKAY BIT IS SET. # SUBBOUTINES CALLED: # TIMEGMBL # MAKECADR # ROT45DEG # CALLING SEQUENCE: # TC BANKCALL (1/ACCS MUST BE CALL BY BANKCALL # CADR 1/ACCS # NORMAL EXIT: VIA BANKJUMP ALARM AND ABORT EXIT MODES: NONE. # INPUT/OUTPUT: SEE PROGRAM DESCRIPTION # DEBRIS: # ALL OF THE EXECUTIVE TEMPORARY REGISTERS, EXCEPT FIXLOC AND OVFIND, AND THE CORE SET AREA FROM MPAC TO BANKSET. # RESTRICTIONS: # 1/ACCS MUST BE CALLED BY BANKCALL # EBANK IS SET TO 6, BUT NOT RESTORED. ## Page 1476 BANK 21 SETLOC DAPS4 BANK COUNT* $$/DAPAO EBANK= AOSQ # ENTRY IS THROUGH 1/ACCJOB OR 1/ACCSET WHEN 1/ACCS IS TO BE DONE AS A SEPARATE NOVAC JOB. # IT IS POSSIBLE FOR MORE THAN ONE OF THESE JOBS TO BE SET UP CONCURRENTLY. HOWEVER, SINCE THERE IS NO CHECK OF # NEWJOB, A SECOND MANIFESTATION CANNOT BE STARTED UNTIL THE FIRST IS COMPLETED. 1/ACCSET CAF ZERO # ENTRY FROM FRESH START/RESTART CODING. TS AOSQ # NULL THE OFFSET ESTIMATES FOR 1/ACCS. TS AOSR TS ALPHAQ # NULL THE OFFSET ESTIMATES FOR DOWNLIST TS ALPHAR 1/ACCJOB TC BANKCALL # 1/ACCS ASSUMES ENTRY VIA BANKCALL. CADR 1/ACCS +2 # SKIP EBANK SETTING. TC ENDOFJOB BANK 20 SETLOC DAPS3 BANK COUNT* $$/DAPAO 1/ACCS CA EBANK6 # ***** EBANK SET BUT NOT RESTORED ***** TS EBANK TC MAKECADR # SAVE RETURN SO THAT BUF2 MAY BE USED TS ACCRETRN # DETERMINE MASS OF THE LEM. CA DAPBOOLS # IS CSM DOCKED MASK CSMDOCKD TS DOCKTEMP # STORE RECORD OF STATE IN TEMP (MPAC +3). CCS A CS CSMMASS # DOCKED: LEMMASS = MASS - CSMMASS AD MASS # LEM ALONE: LEMMASS = MASS TS LEMMASS # ON THE BASIS OF APSFLAG: # SET THE P-AXIS RATE COMMAND LIMIT FOR 2-JET/4-JET CONTROL # SET MPAC, WHICH INDICATES THE PROPER SET OF COEFFICIENTS FOR THE LEM-ALONE F(MASS) CALCULATIONS # ENSURE THAT THE LEM MASS VALUE IS WITHIN THE ACCEPTABLE RANGE INHINT ## Page 1477 CAE FLGWRD10 # DETERMINE WHETHER STAGED. MASK APSFLBIT EXTEND BZF DPSFLITE CS POSMAX # ASCENT (OR ON LUNAR SURFACE) TS -2JETLIM # ALWAYS 2 JETS FOR P-AXIS RATE COMMAND CAF OCT14 # INITIALIZE INDEX AT 12. TS MPAC CS LEMMASS # CHECK IF MASS TOO HIGH. CATCH STAGING. AD HIASCENT EXTEND BZMF MASSFIX CS LEMMASS # CHECK IF MASS TOO LOW. THIS LIMITS THE AD LOASCENT # DECREMENTING BY MASSMON. EXTEND BZMF F(MASS) MASSFIX ADS LEMMASS # STORE THE VIOLATED LIMIT AS LEMMASS. ZL # ALSO CORRECT TOTAL MASS, ZEROING THE CCS DOCKTEMP # LOW-ORDER WORD. CAE CSMMASS # DOCKED: MASS = LEMMASS + CSMMASS AD LEMMASS # LEM ALONE: MASS = LEMMASS DXCH MASS TCF F(MASS) DPSFLITE CS BIT10 # FOUR JETS FOR P-AXIS RATE COMMAND ERRORS TS -2JETLIM # EXCEEDING 1.4 DEG/SEC (SCALED AT 45) CAF SIX # INITIALIZE INDEX AT 6. TS MPAC CS LEMMASS # CHECK IF MASS TOO HIGH. SHOULD NEVER AD HIDESCNT # OCCUR EXCEPT PERHAPS BEFORE THE PAD EXTEND # LOAD IS DONE. BZMF MASSFIX CS LEMMASS # CHECK IF MASS TOO LOW. THIS LIMITS THE AD LODESCNT # DECREMENTING BY MASSMON. AD HIASCENT EXTEND BZMF F(MASS) TCF MASSFIX # COMPUTATION OF FUNCTIONS OF MASS F(MASS) RELINT CCS DOCKTEMP TCF DOCKED # DOCKED: USE SEPERATE COMPUTATION. CA TWO STCTR TS MPAC +1 # J=2,1,0 FOR 1JACCR,1JACCQ,1JACC CS TWO ADS MPAC # JX=10,8,6 OR 4,2,0 TO INDEX COEFS. ## Page 1478 STCTR1 CAE LEMMASS INDEX MPAC AD INERCONC TS MPAC +2 # MASS + C EXTEND INDEX MPAC DCA INERCONA EXTEND DV MPAC +2 INDEX MPAC AD INERCONB INDEX MPAC +1 # 1JACC(J)=A(JX)/(MASS+C(JX) + B(JX) TS 1JACC # 1JACC(-1)=L,PVT-CG SCALED AT 8 FEET CCS MPAC +1 TCF STCTR TCF COMMEQS TCF LRESC # COEFFQ AND COEFFR ARE COMPUTED IN THIS SECTION. THEY ARE USED TO RESOLVE Q-R COMPONENTS INTO NON-ORTHOGONAL # U AND V COMPONENTS (SEE ROT-TOUV SECTION). COMMEQS CS 1JACCR AD 1JACCQ EXTEND BZMF BIGIQ EXTEND # EPSILON IS A MEASURE OF COUPLING AND IS DV 1JACCQ # DEFINED=1-IQ/IR FOR IR GREATER THAN IQ. TS EPSILON # THE COMPUTED EXPRESSION IS EQUIVALENT AD -EPSMAX EXTEND BZMF GOODEPS1 CS -EPSMAX TS EPSILON # EPSILON IS LIMITED TO A MAX. OF .42265 GOODEPS1 CA EPSILON EXTEND MP 0.35356 AD .7071 TS COEFFR # IN THIS CASE WHERE IR IS GREATER THAN CS POSMAX # IQ, COEFFQ=-.707(1+.5EPSILON)(1-EPSILON) AD EPSILON # AND COEFFR=.707(1+.5EPSILON) EXTEND MP COEFFR TS COEFFQ TCF JACCUV BIGIQ EXTEND # EPSILON IS DEFINED AS 1-IR/IQ FOR IQ DV 1JACCR # GREATER THAN IR. -EPSILON IS COMPUTED TS -EPSILON # RATHER THAN EPSILON FOR CONVENIENCE CS -EPSILON AD -EPSMAX ## Page 1479 EXTEND BZMF GOODEPS2 CA -EPSMAX TS -EPSILON # EPSILON IS LIMITED TO A MAX. OF .42265 GOODEPS2 CA -EPSILON EXTEND MP 0.35356 AD -.7071 TS COEFFQ # IN THIS CASE WHERE IQ IS GREATER THAN CS -EPSILON # IR, COEFFQ=-.707(1+.5EPSILON) AND AD NEGMAX # COEFFR=.707(1+.5EPSILON)(1-EPSILON) EXTEND MP COEFFQ TS COEFFR JACCUV CS COEFFQ EXTEND MP 1JACCQ # 1JACCQ IS SCALED AT PI/4 TS 1JACCU # 1JACCU USED AS TEMPORARY STORAGE CA COEFFR EXTEND MP 1JACCR AD 1JACCU EXTEND MP BIT14 # SCALING CHANGED FROM PI/4 TO PI/2 TS 1JACCU TS 1JACCV # SCALED AT PI/2 RADIANS/SEC(2) CCS MPAC # COMPUTE L,PVT-CG IF IN DESCENT CAF ZERO # ZERO SWITCHES AND GO TO 1/ACCONT IN TS ALLOWGTS # ASCENT TCF 1/ACCONT -1 CS TWO TS MPAC CS ONE TS MPAC +1 TCF STCTR1 # THIS SECTION COMPUTES THE RATE OF CHANGE OF ACCELERATION DUE TO THE ROTATION OF THE GIMBALS. THE EQUATION IMPLE # MENTED IN BOTH THE Y-X PLANE AND THE Z-X PLANE IS -- D(ALPHA)/DT = TL/I*D(DELTA)/DT, WHERE # T = ENGINE THRUST FORCE # L = PIVOT TO CG DISTANCE OF ENGINE # I = MOMENT OF INERTIA LRESC CAE ABDELV # SCALED AT 2(13) CM/SEC(2) EXTEND MP MASS # SCALED AT B+16 KGS TC DVOVSUB # GET QUOTIENT WITH OVERFLOW PROTECTION ADRES GFACTM # MASS IS DIVIDED BY ACCELERATION OF GRAVITY IN ORDER TO MATCH THE UNITS OF IXX,IYY,IZZ, WHICH ARE SLUG-FT(2). # THE RATIO OF ACCELERATION FROM PIPAS TO ACCELERATION OF GRAVITY IS THE SAME IN METRIC OR ENGINEERING UNITS, SO ## Page 1480 # THAT IS UNCONVERTED. 2.20462 CONVERTS KG. TO LB. NOW T IS IN A SCALED AT 2(14). EXTEND MP L,PVT-CG # SCALED AT 8 FEET. INHINT TS MPAC EXTEND MP 1JACCR TC DVOVSUB # GET QUOTIENT WITH OVERFLOW PROTECTION ADRES TORKJET1 TS ACCDOTR # SCALED AT PI/2(7) CA MPAC EXTEND MP 1JACCQ TC DVOVSUB # GET QUOTIENT WITH OVERFLOW PROTECTION ADRES TORKJET1 SPSCONT TS ACCDOTQ # SCALED AT PI/2(7) EXTEND MP DGBF # .3ACCDOTQ SCALED AT PI/2(8) TS KQ CAE ACCDOTR # .3ACCDOTR AT PI/2(8) EXTEND MP DGBF TS KRDAP EXTEND # NOW COMPUTE QACCDOT, RACCDOT, THE SIGNED READ CHAN12 # JERK TERMS. STORE CHANNEL 12. WITH GIM TS MPAC +1 # BAL DRIVE BITS 9 THROUGH 12. SET LOOP CAF BIT2 # INDEX TO COMPUTE RACCDOT, THEN QACCDOT. TCF LOOP3 CAF ZERO # ACCDOTQ AND ACCDOTR ARE NOT NEGATIVE, LOOP3 TS MPAC # BECAUSE THEY ARE MAGNITUDES CA MPAC +1 INDEX MPAC # MASK CHANNEL IMAGE FOR ANY GIMBAL MOTION MASK GIMBLBTS EXTEND BZF ZACCDOT # IF NONE, Q(R)ACCDOT IS ZERO. CA MPAC +1 INDEX MPAC # GIMBAL IS MOVING. IS ROTATION POSITIVE. MASK GIMBLBTS +1 EXTEND BZF FRSTZERO # IF NOT POSITIVE, BRANCH INDEX MPAC # POSITIVE ROTATION, NEGATIVE Q(R)ACCDOT. CS ACCDOTQ TCF STACCDOT FRSTZERO INDEX MPAC # NEGATIVE ROTATION, POSITIVE Q(R)ACCDOT. CA ACCDOTQ TCF STACCDOT ZACCDOT CAF ZERO ## Page 1481 STACCDOT INDEX MPAC TS QACCDOT # STORE Q(R)ACCDOT. CCS MPAC TCF LOOP3 -1 # NOW DO QACCDOT. CS DAPBOOLS # IS GIMBAL USABLE? MASK USEQRJTS EXTEND BZF DOWNGTS # NO. BE SURE THE GIMBAL SWITCHES ARE DOWN CS T5ADR # YES. IS THE DAP RUNNING? AD PAXISADR EXTEND BZF +2 TCF DOWNGTS # NO. BE SURE THE GIMBAL SWITCHES ARE DOWN CCS INGTS # YES. IS GTS IN CONTROL? TCF DOCKTEST # YES. PROCEED WITH 1/ACCS. TC IBNKCALL # NO. NULL OFFSET AND FIND ALLOWGTS CADR TIMEGMBL DOCKTEST CCS DOCKTEMP # BYPASS 1/ACCONT WHEN DOCKED. TCF 1/ACCRET TCF 1/ACCONT ## Page 1482 # SUBROUTINE: DVOVSUB # AUTHOR: C. WORK, MOD 0 12 JUNE 68 # PURPOSE: THIS SUBROUTINE PROVIDES A SINGLE-PRECISION MACHINE LANGUAGE DIVISION OPERATION WHICH RETURNS # (1) THE QUOTIENT, IF THE DIVISION WAS NORMAL. # (2) NEGMAX, IF THE QUOTIENT WAS IMPROPER AND NEGATIVE. # (3) POSMAX, IF THE QUOTIENT WAS IMPROPER AND POSITIVE OR IF THERE WAS A ZERO DIVISOR. # THE CALLING PROGRAM IS PRESUMED TO BE A JOB IN THE F BANK WHICH CONTAINS DVOVSUB. E BANK MUST BE 6. # THE DIVISOR FOR THIS ROUTINE MAY BE IN EITHER FIXED OR ERASABLE STORAGE. SIGN AGREEMENT IS # ASSUMED BETWEEN THE TWO HALVES OF THE DIVIDEND. (THIS IS CERTAIN IF THE A AND L REGISTERS ARE THE RE- # SULT OF A MULTIPLICATION OPERATION.) # CALL SEQUENCE: # L TC DVOVSUB # L +1 ADRES (DIVISOR) # L +2 RETURN HERE, WITH RESULT IN A,L # INPUT: DIVIDEND IN A,L (SIGN AGREEMENT ASSUMED), DIVISOR IN LOCATION DESIGNATED BY "ADRES". # DIVISOR MAY BE IN THE DVOVSUB FBANK,FIXED-FIXED FBANK,EBANK 6, OR UNSWITCHED ERASABLE. # OUTPUT: QUOTIENT AND REMAINDER, OR POSMAX (NEGMAX), WHICHEVER IS APPROPRIATE. # DEBRIS: SCRATCHX,SCRATCHY,SCRATCHZ,A,L (NOTE: SCRATCHX,Y,Z ARE EQUATED TO MPAC +4,+5, AND +6.) # ABORTS OR ALARMS: NONE # EXITS: TO THE CALL POINT +2. # SUBROUTINES CALLED: NONE. DVOVSUB TS SCRATCHY # SAVE UPPER HALF OF DIVIDEND TS SCRATCHX INDEX Q # OBTAIN ADDRESS OF DIVISOR. CA 0 INCR Q # STEP Q FOR PROPER RETURN SEQUENCE. INDEX A CA 0 # PICK UP THE DIVISOR. EXTEND # RETURN POSMAX FOR A ZERO DIVISOR. BZF MAXPLUS TS SCRATCHZ # STORE DIVISOR. CCS A # GET ABS(DIVISOR) IN THE A REGISTER. AD BIT1 TCF ZEROPLUS AD BIT1 ZEROPLUS XCH SCRATCHY # STORE ABS(DIVISOR). PICK UP TOP HALF OF EXTEND # DIVIDEND. BZMF GOODNEG # GET -ABS(DIVIDEND) ## Page 1483 CS A GOODNEG AD SCRATCHY # ABS(DIVISOR) - ABS(DIVIDEND) EXTEND BZMF MAKEMAX # BRANCH IF DIVISION IS NOT PROPER. CA SCRATCHX # RE-ESTABLISH THE DIVIDEND. EXTEND DV SCRATCHZ # QUOTIENT IN THE A, REMAINDER IN L. TC Q # RETURN TO CALLER. MAKEMAX CCS SCRATCHX # DETERMINE THE SIGN OF THE QUOTIENT. CCS SCRATCHZ # SCRATCHX AND SCRATCHZ ARE NON-ZERO. TCF MAXPLUS CCS SCRATCHZ CAF NEGMAX # +,- OR -,+ TC Q MAXPLUS CAF POSMAX # -,- OR +,+ TC Q # COEFFICIENTS FOR THE JET ACCELERATION CURVE FITS # THE CURVE FITS ARE OF THE FORM - # 1JACC = A/(MASS + C) + B # A IS SCALED AT PI/4 RAD/SEC**2 B+16KG, B IS SCALED AT PI/4 RAD/SEC**2, AND C IS SCALED AT B +16 KG. # THE CURVE FIT FOR L,PVT-CG IS OF THE SAME FORM, EXCEPT THAT A IS SCALED AT 8 FT B+16 KG, B IS SCALED AT 8 FT, # AND C IS SCALED AT B+16 KG. 2DEC +.0410511917 # L A DESCENT INERCONA 2DEC +.0059347674 # 1JACCP A DESCENT 2DEC +.0014979264 # 1JACCQ A DESCENT 2DEC +.0010451889 # 1JACCR A DESCENT 2DEC +.0065443852 # 1JACCP A ASCENT 2DEC +.0035784354 # 1JACCQ A ASCENT 2DEC +.0056946631 # 1JACCR A ASCENT DEC +.155044 # L B DESCENT DEC -.025233 # L C DESCENT ## Page 1484 INERCONB DEC +.002989 # 1JACCP B DESCENT INERCONC DEC +.008721 # 1JACCP C DESCENT DEC +.018791 # 1JACCQ B DESCENT DEC -.068163 # 1JACCQ C DESCENT DEC +.021345 # 1JACCR B DESCENT DEC -.066027 # 1JACCR C DESCENT DEC +.000032 # 1JACCP B ASCENT DEC -.006923 # 1JACCP C ASCENT DEC +.162862 # 1JACCQ B ASCENT DEC +.002588 # 1JACCQ C ASCENT DEC +.009312 # 1JACCR B ASCENT DEC -.023608 # 1JACCR C ASCENT GIMBLBTS OCTAL 01400 OCTAL 01000 OCTAL 06000 OCTAL 04000 DGBF DEC 0.6 # .3 SCALED AT 1/2 0.35356 DEC 0.35356 # .70711 SCALED AT 2 GFACTM OCT 337 # 979.24/2.20462 AT B+15 .7071 DEC .70711 -.7071 DEC -.70711 -EPSMAX DEC -.42265 # CSM-DOCKED INERTIA COMPUTATIONS DOCKED CA ONE # COEFTR = 1 FOR INERTIA COEFFICIENTS SPSLOOP1 TS COEFCTR # = 7 FOR CG COEFFICIENTS CA ONE # MASSCTR = 1 FOR CSM TS MASSCTR # = 0 FOR LEM INDEX COEFCTR CA COEFF -1 # COEFF -1 = C EXTEND MP LEMMASS EXTEND MP CSMMASS # LET X = CSMMASS AND Y = LEMMASS INDEX COEFCTR AD COEFF # COEFF = F TS MPAC # MPAC = C X Y + F TCF +4 SPSLOOP2 TS MASSCTR # LOOP TWICE THROUGH HERE TO OBTAIN EXTEND # MPAC = MPAC + (A X +D)X + (B Y +E)Y DIM COEFCTR # LOOP #1 LOOP #2 INDEX COEFCTR CA COEFF +2 # COEFF +2 = A OR B EXTEND ## Page 1485 INDEX MASSCTR MP LEMMASS INDEX COEFCTR AD COEFF +4 # COEFF +4 = E OR D EXTEND INDEX MASSCTR MP LEMMASS ADS MPAC CCS MASSCTR TCF SPSLOOP2 CCS COEFCTR # IF COEFCTR IS POS, EXIT FROM LOOP WITH TCF +7 # CG X DELDOT = MPAC X 4 PI RAD-CM/SEC TORQCONS 2DEC 0.51443 B-14 # CORRESPONDS TO 500 LB-FT CA MPAC TS MPAC +1 # INERTIA = (MPAC +1) X 2(38) KG-CM(2) CA SEVEN TCF SPSLOOP1 CA 1JACCCON # 1JACC=1JACCCON/MASS ZL TC DVOVSUB ADRES MASS TS 1JACC # SCALED AT PI/4 CA POSMAX # SET INVERSE JET ACCELERATIONS TO POSMAX, TS 1/ANETP # WHICH CORRESPONDS TO ACCEL. OF 1.4 D/SS. TS 1/ANET2 +1 TS 1/ANET2 +2 TS 1/ANET2 +17D TS 1/ANET2 +18D EXTEND DCA TORQCONS EXTEND DV MPAC +1 INHINT TS 1JACCQ # SCALED AT PI/4 TS 1JACCR CA -.7071 TS COEFFQ # COEFFQ AND COEFFR ARE CHOSEN TO MAKE U- CA .7071 # AND V-AXES ORTHOGONAL FOR DOCKED CASE TS COEFFR CA MASS # SCALED AT 2(16) KG EXTEND MP MPAC # SCALED AT 4 PI RAD-CM/SEC EXTEND MP ABDELV # SCALED AT 2(13) CM/SEC(2) TC DVOVSUB # GET QUOTIENT WITH OVERFLOW PROTECTION ## Page 1486 ADRES MPAC +1 TS ACCDOTR TCF SPSCONT # CONTINUE K, KSQ CALCULATIONS 1JACCCON OCT 00167 # SCALED AT PI/4X2(16) RAD/SEC(2)-KG # 2 2 # COEFFICIENTS FOR CURVE FIT OF THE FORM Z = A X +B Y +C X Y +D X +E Y +F COEFF DEC .19518 # C COEFFICIENT OF INERTIA DEC -.00529 # F '' DEC -.17670 # B '' DEC -.03709 # A '' DEC .06974 # E '' DEC .02569 # D '' DEC .20096 # C COEFFICIENT OF CG DEC .13564 # F '' DEC .75704 # B '' DEC -.37142 # A '' DEC -.63117 # E '' DEC .41179 # D '' # ASSIGNMENT OF TEMPORARIES FOR 1/ACCS (EXCLUDING 1/ACCONT) # MPAC, MPAC +1, MPAC +2 USED EXPLICITLY COEFCTR EQUALS MPAC +4 MASSCTR EQUALS MPAC +5 SCRATCHX EQUALS MPAC +4 # SCRATCH AREA FOR DVOVSUB ROUTINE. SCRATCHY EQUALS SCRATCHX +1 SCRATCHZ EQUALS SCRATCHX +2 DOCKTEMP EQUALS MPAC +3 # RECORD OF CSMDOCKED BIT OF DAPBOOLS EPSILON EQUALS MPAC +1 -EPSILON EQUALS EPSILON -.1875 DEC -.18750 ## Page 1487 BANK 20 SETLOC DAPS3 BANK EBANK= AOSQ COUNT* $$/DAPAO -1 TS INGTS # ZERO INGTS IN ASCENT 1/ACCONT CA DB # INITIALIZE DBVAL1,2,3 EXTEND MP BIT13 TS L # 0.25 DB AD A TS DBVAL3 # 0.50 DB CS DBVAL1 AD L TS DBVAL2 # -.75 DB GETAOSUV INHINT CAE AOSR # COMPUTE AOSU AND AOSV BY ROTATING TS L # AOSQ AND AOSR. CAE AOSQ TC IBNKCALL CADR ROT-TOUV DXCH AOSU RELINT CA DAPBOOLS MASK DRIFTBIT # ZERO DURING ULLAGE AND POWERED FLIGHT. CCS A # IF DRIFTING FLIGHT, CA ONE # SET DRIFTER TO 1 TS DRIFTER # SAVE TO TEST FOR DRIFTING FLIGHT LATER AD ALLOWGTS # NON-ZERO IF DRIFT OR GTS NEAR CCS A CA FLATVAL # DRIFTING FLIGHT, STORE .8 IN FLAT TS FLATEMP # IN POWERED FLIGHT, STORE ZERO IN FLAT EXTEND BZF DOPAXIS # IF POWERED AND NO GTS, START P AXIS, CCS DRIFTER # OTHERWISE SET ZONE3LIM CA ZONE3MAX # 17.5 MS, SCALED AT 4 SECONDS. TS Z3TEM DOPAXIS CA 1JACC # 1JACC AT PI/4 = 2JACC AT PI/2 = # ANET AT PI/2 = ANET/ACOAST AT 2(6). AD BIT9 # 1 + ANET/ACOAST AT 2(6) TS FUNTEM CA 1JACC ## Page 1488 TC INVERT INHINT # P AXIS DATA MUST BE CONSISTENT TS 1/ANETP # SCALED AT 2(7)/PI. TS 1/ANETP +1 CS BIT9 # -1 AT 2(6) EXTEND MP 1/ANETP # -1/ANET AT 2(13)/PI EXTEND DV FUNTEM # -1/(ANET + ANET**2/ACOAST) AT 2(7)/PI TS PACCFUN TS PACCFUN +1 CA 1/.03 # NO AOS FOR P AXIS, ACOAST = AMIN TS 1/ACOSTP TS 1/ACOSTP +1 RELINT ZL CCS DRIFTER DXCH AOSU # ZERO AOSU,V IF IN DRIFT, JUST TO BE SURE UAXIS CA ZERO # DO U AXIS COMPUTATIONS TS UV # ZERO FOR U AXIS, ONE FOR V AXIS. BOTHAXES TS SIGNAOS # CODING COMMON TO U,V AXES INDEX UV CCS AOSU # PICK UP ABS(AOSU OR AOSV) AD ONE # RESTORE TO PROPER VALUE TCF +3 # AND LEAVE SIGNAOS AT ZERO AD ONE # NEGATIVE, RESTORE TO PROPER VALUE INCR SIGNAOS # AND SET SIGNAOS TO ONE TO SHOW AOS NEG TS ABSAOS # SAVE ABS(AOS) CS SIGNAOS TS -SIGNAOS # USED AS AN INDEX CA DBVAL1 # SET DB1, DB2 TO DBVAL1 (= DB) TS DBB1 TS DBB2 CA ABSAOS # TEST MAGNITUDE OF ABS(AOS) AD -.03R/S2 EXTEND BZMF NOTMUCH # ABS(AOS) LESS THAN AMIN BIGAOS CCS FLATEMP # AGS(AOS) GREATER THAN AMIN TCF SKIPDB1 # I DRIFT OR GTS, DO NOT COMPUTE DB CA DBVAL1 INDEX -SIGNAOS ## Page 1489 ADS DBB2 # DB2(1) = 2 DB INDEX SIGNAOS TS DBB4 # DB4(3) = 1 DB CA -.1875 # -.1875 PI/2 RAD/SEC(2) SCALED AT PI/2 AD ABSAOS # ABSAOS IS SCALED AT PI/2 EXTEND BZMF +3 CS DBVAL3 # -.5 DB TCF DBONE CS ABSAOS DOUBLE DOUBLE AD BIT14 DOUBLE # 1-8 ABSAOS. (8 IS 16/PI SCALED AT 2/PI) EXTEND MP DB DBONE INDEX SIGNAOS # DB1(2)=(1-8 ABSAOS) DB. IF ABSAOS IS TS DBB1 # GREATER THAN .1875 THEN DB1(2) = -.5 DB CA DBVAL2 INDEX -SIGNAOS TS DBB3 # DB3(4) = -.75 DB SKIPDB1 CA ABSAOS # ABS(AOS) GREATER THAN AMIN, SO IT IS EXTEND MP BIT12 AD ABSAOS # (9/8) ABSAOS. TC INVERT # ALL RIGHT TO DIVIDE INDEX -SIGNAOS TS 1/ACOSTT +1 # 1/ACOASTPOS(NEG) = 1/ABS(AOS) CA 1/.03 INDEX SIGNAOS TS 1/ACOSTT # 1/ACOASTNEG(POS) = 1/AMIN CA ABSAOS AD 1JACCU AD 1JACCU # 2 JACC + ABS(AOS) AD BIT9 # MAXIMUM VALUE IN COMPUTATIONS TS A # TEST FOR OVERFLOW TCF SKIPDB2 # NO OVERFLOW, DO NORMAL COMPUTATION CA ABSAOS # RESCALE TO PI TO PREVENT OVERFLOW EXTEND MP BIT14 AD 1JACCU # 1 JACC AT PI/2 = 2JACC AT PI TS ANET # ANETPOS(NEG) MAX SCALED AT PI = # ANETPOS(NEG) MAX/ACOASTNEG(POS) AT 2(7) AD BIT8 # 1 + ANETPOS/ACOASTNEG AT 2(7) XCH ANET # SAVE IN ANET, WHILE PICKING UP ANET TC INVERT EXTEND ## Page 1490 MP BIT14 # SCALE 1/ANET AT 2(7)/PI TS 1/ANET CA ACCHERE # SET UP RETURN FROM COMPUTATION ROUTINE TS ARET CS BIT8 # -1 AT 2(7) TCF DOACCFUN # FINISH ACCFUN COMPUTATION ACCHERE TCF ACCTHERE NOTMUCH TS L # ABS(AOS) LESS THAN AMIN, SAVE IN L CA 1/.03 # ACOASTPOS,NEG = AMIN TS 1/ACOSTT TS 1/ACOSTT +1 CCS FLATEMP TCF SKIPDB2 # DO NOT COMPUTE DB IF DRIFT OR GTS CA .023R/S2 # .0228 RAD/SEC(2) AD L # L=ABS(AOS)-AMIN=ABS(AOS)-.0245RAD/SEC(2) EXTEND # RESULT IS ABS(AOS)-.0017 RAD/SEC(2) BZMF NOAOS # ABS(AOS) LESS THAN .0017 RAD/SEC(2) SOMEAOS CA DBVAL3 # .0017 RAD/SEC(2) LT ABS(AOS) LT AMIN INDEX -SIGNAOS TS DBB3 # DB3(4) = DB/2 AD A INDEX SIGNAOS TS DBB4 # DB4(3) = DB TCF SKIPDB2 NOAOS CA DBVAL1 TS DBB3 # DB3,4 = DB TS DBB4 SKIPDB2 CA ABSAOS # ANETPOS(NEG) MAX = 2 JACC + ABS(AOS) AD 1JACCU AD 1JACCU TS ANET # CONNOT OVERFLOW HERE CL1/NET+ TC DO1/NET+ # COMPUTE 1/ANET, ACCFUN ACCTHERE INDEX -SIGNAOS TS Z5TEM +2 # STORE ACCFUN IN TEMPORARY BUFFER CA 1/ANET INDEX -SIGNAOS TS 1/ATEM2 +2 # STORE 1/ANET IN TEMPORARY BUFFER CA ABSAOS # SEE IF OVERFLOW IN MIN CASE AD 1JACCU AD BIT9 # MAXIMUM POSSIBLE VALUE ## Page 1491 TS A # OVERFLOW POSSIBLE BUT REMOTE TCF +2 CA POSMAX # IF OVERFLOW, TRUNCATE TO PI/2 AD -.03R/S2 # RESTORE TO CORRECT VALUE TS ANET TC DO1/NET+ # COMPUTE 1/ANET, ACCFUN INDEX -SIGNAOS # STORE MIN VALUES JUST AS MAX VALUES TS Z5TEM CA 1/ANET INDEX -SIGNAOS TS 1/ATEM2 CS ABSAOS # NOW DO NEG(POS) CASES AD 1JACCU AD 1JACCU # ANETNEG(POS) MAX TC 1/ANET- # COMPUTE 1/ANET, ACCFUN, AND ACCSW INDEX SIGNAOS # STORE NEG(POS) VALUES JUST AS POS(NEG) TS Z1TEM +2 TS L # SAVE IN L FOR POSSIBLE FUTURE USE CA 1/ANET INDEX SIGNAOS TS 1/ATEM1 +2 CS ABSAOS AD 1JACCU # 1/ANETNEG(POS) MIN TS ANET AD -.03R/S2 # TEST FOR AMIN EXTEND # IF ANET LESS THAN AMIN, STORE MAX JET BZMF FIXMIN # VALUES FOR MIN JETS AND SET ACCSW TC 1/NETMIN # OTHERWISE DO MIN JET COMPUTATIONS STMIN- INDEX SIGNAOS # STORE VALUES TS Z1TEM CA 1/ANET INDEX SIGNAOS TS 1/ATEM1 INDEX UV CA +UMASK MASK CH5MASK # TEST FOR +U (+V) JET FAILURES EXTEND BZF FAIL- CA 1/ATEM2 # REPLACE FUNCTION VALUES DEPENDING ON THE TS 1/ATEM2 +2 # FAILED JET PAIR WITH CORRESPONDING ONE- CA Z5TEM # JET (OR AMIN) FUNCTION VALUES TS Z5TEM +2 FAIL- INDEX UV CA -UMASK ## Page 1492 MASK CH5MASK # TEST FOR -U (-V) JET FAILURES EXTEND BZF DBFUN CA 1/ATEM1 # REPLACE FUNCTION VALUES DEPENDING ON THE TS 1/ATEM1 +2 # FAILED JET PAIR WITH CORRESPONDING ONE- CA Z1TEM # JET (OR AMIN) FUNCTION VALUES TS Z1TEM +2 DBFUN CS DBB3 # COMPUTE AXISDIST AD DBB1 AD FLATEMP TS AXDSTEM CS DBB4 AD DBB2 AD FLATEMP TS AXDSTEM +1 INHINT CCS UV # TEST FOR U OR V AXIS TCF STORV # V AXIS STORE V VALUES CA ACCSW # U AXIS STORE U VALUES TS ACCSWU CA NINE # TRANSFER 10 WORDS VIA GENTRAN TC GENTRAN +1 ADRES 1/ATEM1 # TEMPORARY BUFFER ADRES 1/ANET1 # THE REAL PLACE RELINT DXCH DBB1 # SAVE U DBS FOR LATER STORING DXCH UDB1 DXCH DBB4 DXCH UDB4 DXCH AXDSTEM DXCH UAXDIST CA ONE # NOW DO V AXIS TS UV CA ZERO TCF BOTHAXES # AND DO IT AGAIN STORV CA ACCSW # STORE V AXIS VALUES TS ACCSWV CA NINE TC GENTRAN +1 ADRES 1/ATEM1 # TEMPORARY BUFFER ## Page 1493 ADRES 1/ANET1 +16D # THE REAL PLACE # NOW STORE DEADBANDS FOR ALL AXES DXCH FLATEMP # FLAT AND ZONE3LIM DXCH FLAT CA DBVAL1 # COMPUTE P AXIS DEADBANDS TS PDB1 TS PDB2 AD FLAT TS PDB3 TS PDB4 CA ZERO TS PAXDIST TS PAXDIST +1 CCS FLAT TCF DRFDB # DRIFT OR GTS - COMPUTE DBS DXCH UDB1 # STORE U DEADBANDS DXCH FIREDB # CANNOT USE GENTRAN BECAUSE OF RELINT DXCH UDB4 DXCH COASTDB DXCH UAXDIST DXCH AXISDIST DXCH DBB1 # STORE V AXIS DEADBANDS DXCH FIREDB +16D # COULD USE GENTRAN IF DESIRED DXCH DBB4 DXCH COASTDB +16D DXCH AXDSTEM DXCH AXISDIST +16D TCF 1/ACCRET +1 # ALL DONE DRFDB CA DBVAL1 # DRIFT DEADBANDS TS FIREDB TS FIREDB +1 TS FIREDB +16D TS FIREDB +17D AD FLAT TS COASTDB TS COASTDB +1 TS COASTDB +16D TS COASTDB +17D CA ZERO TS AXISDIST TS AXISDIST +1 TS AXISDIST +16D TS AXISDIST +17D 1/ACCRET INHINT ## Page 1494 CS DAPBOOLS # SET BIT TO INDICATE DATA GOOD. MASK ACCSOKAY ADS DAPBOOLS RELINT CA ACCRETRN TC BANKJUMP # RETURN TO CALLER INVERT TS HOLD # ROUTINE TO INVERT -INPUT AT PI/2 CA BIT9 # 1 AT 2(6) ZL # ZERO L FOR ACCURACY AND TO PREVENT OVFLO EXTEND DV HOLD TC Q # RESULT AT 2(7)/PI DOWNGTS CAF ZERO # ZERO SWITCHES WHEN USEQRJTS BIT IS UP TS ALLOWGTS # OR DAP IS OFF. TS INGTS TCF DOCKTEST 1/ANET- ZL LXCH ACCSW # ZERO ACCSW TS ANET # SAVE ANET AD -.03R/S2 # TEST FOR MIN VALUE EXTEND BZMF NETNEG # ANET LESS THAN AMIN, SO FAKE IT 1/NETMIN CA ANET EXTEND INDEX -SIGNAOS MP 1/ACOSTT +1 # ANETNEG(POS)/ACOASTPOS(NEG) AT 2(6) # THE FOLLOWING CODING IS VALID FOR BOTH POS OR NEG # VALUES OF AOS DO1/NET+ AD BIT9 # 1 + ANET/ACOAST AT 2(6) XCH ANET # SAVE AND PICK UP ANET EXTEND QXCH ARET # SAVE RETURN TC INVERT TS 1/ANET # 1/ANET AT 2(7)/PI CS BIT9 # -1 AT 2(6) DOACCFUN EXTEND MP 1/ANET # -1/ANET AT 2(13)/PI EXTEND DV ANET # ACCFUN AT 2(7)/PI TC ARET # RETURN NETNEG CS -.03R/S2 # ANET LESS THAN AMIN - SET EQUAL TO AMIN TS ANET TCF 1/NETMIN +1 # CONTINUE AS IF NOTHING HAPPENED ## Page 1495 FIXMIN CCS SIGNAOS CA TWO # IF AOS NEG, ACCSW = +1 AD NEGONE # IF AOS POS, ACCSW = -1 TS ACCSW AD UV # IF ACCSW = +1, TEST FOR +U (+V) JET FAIL INDEX A # IF ACCSW = -1, TEST FOR -U (-V) JET FAIL CA -UMASK +1 MASK CH5MASK EXTEND BZF +4 CS -.03R/S2 # JET FAILURE - CANNOT USE 2-JET VALUES TS ANET # ANET = AMIN TCF STMIN- -1 # CALCULATE FUNCTIONS USING AMIN CA L # L HAS ACCFUN TCF STMIN- # STORE MAX VALUES FOR MIN JETS # ERASABLE ASSIGNMENTS FOR 1/ACCONT 1/ANETP EQUALS BLOCKTOP +2 1/ACOSTP EQUALS BLOCKTOP +4 PACCFUN EQUALS BLOCKTOP +8D PDB1 EQUALS BLOCKTOP +10D PDB2 EQUALS BLOCKTOP +11D PDB4 EQUALS BLOCKTOP +12D PDB3 EQUALS BLOCKTOP +13D PAXDIST EQUALS BLOCKTOP +14D ACCSW EQUALS VBUF # EXECUTIVE TEMPORARIES # CANNOT DO CCS NEWJOB DURING 1/ACCS 1/ATEM1 EQUALS ACCSW +1 # TEMP BUFFER FOR U AND V AXES 1/ATEM2 EQUALS 1/ATEM1 +1 1/ACOSTT EQUALS 1/ATEM1 +4 Z1TEM EQUALS 1/ATEM1 +6 Z5TEM EQUALS 1/ATEM1 +7 UDB1 EQUALS 1/ATEM1 +10D # UAXIS DEADBAND BUFFER UDB2 EQUALS 1/ATEM1 +11D UDB4 EQUALS 1/ATEM1 +12D UDB3 EQUALS 1/ATEM1 +13D UAXDIST EQUALS 1/ATEM1 +14D DBB1 EQUALS 1/ATEM1 +16D # TEMP DEADBAND BUFFER, ALSO V AXIS DBB2 EQUALS 1/ATEM1 +17D DBB4 EQUALS 1/ATEM1 +18D DBB3 EQUALS 1/ATEM1 +19D AXDSTEM EQUALS 1/ATEM1 +20D FLATEMP EQUALS 1/ATEM1 +22D Z3TEM EQUALS 1/ATEM1 +23D # MUST FOLLOW FLATEMP ## Page 1496 DBVAL1 EQUALS DB DBVAL2 EQUALS INTB15+ DBVAL3 EQUALS INTB15+ +1 DRIFTER EQUALS INTB15+ +2 UV EQUALS MPAC ANET EQUALS MPAC +3 FUNTEM EQUALS MPAC +3 1/ANET EQUALS MPAC +4 ARET EQUALS MPAC +5 ABSAOS EQUALS MPAC +6 SIGNAOS EQUALS MPAC +7 -SIGNAOS EQUALS MPAC +8D HOLD EQUALS MPAC +9D ACCRETRN EQUALS FIXLOC -1 ZONE3MAX DEC .004375 # 17.5 MS (35 MS FOR 1 JET) AT 4 SECONDS FLATVAL DEC .01778 # .8 AT PI/4 RAD -.03R/S2 OCT 77377 # -PI/2(7) AT PI/2 .023R/S2 OCT 00356 # .0228 RAD/SEC(2) AT PI/2 1/.03 EQUALS POSMAX # 2(7)/PI AT 2(7)/PI PAXISADR GENADR PAXIS # THE FOLLOWING 4 CONSTANTS ARE JET # FAILURE MASKS AND ARE INDEXED -UMASK OCT 00110 # -U OCT 00022 # -V +UMASK OCT 00204 # +U OCT 00041 # +V