parent
624a548983
commit
00444f654f
@ -38,7 +38,7 @@
|
|||||||
|
|
||||||
# PDL 12D - 15D SAFE.
|
# PDL 12D - 15D SAFE.
|
||||||
|
|
||||||
# VALUE OF GIMBAL AND BODY ANGLES VALID AT PIP TIME ARE SAVED DURING READACCS.
|
# VALUES OF GIMBAL AND BODY ANGLES VALID AT PIP TIME ARE SAVED DURING READACCS.
|
||||||
|
|
||||||
EBANK= RTINIT # LET INTERPRETER SET EB
|
EBANK= RTINIT # LET INTERPRETER SET EB
|
||||||
|
|
||||||
@ -66,8 +66,8 @@ CM/POSE TC INTPRET # COME HERE VIA AVEGEXIT.
|
|||||||
S1 # UN FOR THE END OF THE TERMINAL PHASE.
|
S1 # UN FOR THE END OF THE TERMINAL PHASE.
|
||||||
SPVQUIT DEC .019405 # 1000/ 2 VS
|
SPVQUIT DEC .019405 # 1000/ 2 VS
|
||||||
TIX,1 VLOAD # IF V-VQUIT POS, BRANCH.
|
TIX,1 VLOAD # IF V-VQUIT POS, BRANCH.
|
||||||
CM/POSE2 # SAME UYA IN OLDUYA
|
CM/POSE2 # SAVE UYA IN OLDUYA
|
||||||
OLDUYA # OTHERWISE CONTINUE TO USE OLDUYA
|
OLDUYA # OTHERWISE CONTINUE TO USE OLDUYA.
|
||||||
CM/POSE2 STORE UYA/2 # REF COORDS
|
CM/POSE2 STORE UYA/2 # REF COORDS
|
||||||
|
|
||||||
STORE OLDUYA # RESTORE, OR SAVE AS CASE MAY BE.
|
STORE OLDUYA # RESTORE, OR SAVE AS CASE MAY BE.
|
||||||
@ -78,7 +78,7 @@ CM/POSE2 STORE UYA/2 # REF COORDS
|
|||||||
STORE UZA/2 # REF COORDS
|
STORE UZA/2 # REF COORDS
|
||||||
# Page 884
|
# Page 884
|
||||||
TLOAD # PICK UP CDUX, CDUY, CDUZ CORRESPONDING
|
TLOAD # PICK UP CDUX, CDUY, CDUZ CORRESPONDING
|
||||||
AOG/PIP # TO PIPUP TIME IN 2'S C AND SAVE.
|
AOG/PIP # TO PIPUP TIME IN 2S.C AND SAVE.
|
||||||
CM/TRIO STODL 24D
|
CM/TRIO STODL 24D
|
||||||
25D # AIG/PIP
|
25D # AIG/PIP
|
||||||
|
|
||||||
@ -97,7 +97,7 @@ CM/TRIO STODL 24D
|
|||||||
0 # SM /2
|
0 # SM /2
|
||||||
DCOMP VXSC
|
DCOMP VXSC
|
||||||
UBX/2
|
UBX/2
|
||||||
VSL1 # NOISE WON'T OVFL
|
VSL1 # NOISE WONT OVFL.
|
||||||
STODL UBY/2 # =(-SMCI, NOISE, SMSI)/2
|
STODL UBY/2 # =(-SMCI, NOISE, SMSI)/2
|
||||||
2 # CM /2 REPLACES NOISE
|
2 # CM /2 REPLACES NOISE
|
||||||
STODL UBY/2 +2 # UBY/2=(-SMCI, CM, SMSI)/2
|
STODL UBY/2 +2 # UBY/2=(-SMCI, CM, SMSI)/2
|
||||||
@ -120,7 +120,7 @@ CM/TRIO STODL 24D
|
|||||||
UBY/2 +4
|
UBY/2 +4
|
||||||
STOVL UBY/2 +4 # YB/4 PLATFORM COORDS
|
STOVL UBY/2 +4 # YB/4 PLATFORM COORDS
|
||||||
|
|
||||||
# YB = (-COSMCI + SOSI , COCM , COSMSI + SOCI )
|
# YB = (-COSMCI + SOSI , COCM , COSMSI + SOCI )
|
||||||
|
|
||||||
UBY/2
|
UBY/2
|
||||||
VXM VSL2
|
VXM VSL2
|
||||||
@ -135,7 +135,7 @@ CM/TRIO STODL 24D
|
|||||||
STOVL UBX/2 +2 # SM /2 REPLACES NOISE
|
STOVL UBX/2 +2 # SM /2 REPLACES NOISE
|
||||||
UBX/2 # XB/2 PLATFORM COORDS
|
UBX/2 # XB/2 PLATFORM COORDS
|
||||||
|
|
||||||
# XB = ( CMCI , SM , -CMSI )
|
# XB = ( CMCI , SM , -CMSI )
|
||||||
|
|
||||||
VXM VSL1
|
VXM VSL1
|
||||||
REFSMMAT # .5 UNIT
|
REFSMMAT # .5 UNIT
|
||||||
@ -145,8 +145,8 @@ CM/TRIO STODL 24D
|
|||||||
UBY/2
|
UBY/2
|
||||||
STOVL UBZ/2 # ZB/2 DONE REF COORDS
|
STOVL UBZ/2 # ZB/2 DONE REF COORDS
|
||||||
|
|
||||||
# EQUIVALENT TO
|
# EQUIVALENT TO
|
||||||
# ZB = ( SOSMCI + COSI , -SOCM , -SOSMSI + COCI )
|
# ZB = ( SOSMCI + COSI , -SOCM , -SOSMSI + COCI)
|
||||||
|
|
||||||
UXA/2 # -UVREL/2 = -UVA/2
|
UXA/2 # -UVREL/2 = -UVA/2
|
||||||
VXV UNIT # GET UNIT(-UVREL*UBY)/2 = UL/2
|
VXV UNIT # GET UNIT(-UVREL*UBY)/2 = UL/2
|
||||||
@ -199,13 +199,13 @@ CMTR1 INDEX FIXLOC
|
|||||||
TS L
|
TS L
|
||||||
|
|
||||||
INHINT
|
INHINT
|
||||||
# MUST REMAIN INHINTED UNTIL UPDATE OF BODY
|
# MUST REMAIN INHINTED UNTIL UPDATE OF BODY
|
||||||
# ANGLES, SO THAT GAMDIFSW IS VALID FIRST PASS
|
# ANGLES, SO THAT GAMDIFSW IS VALID FIRST PASS
|
||||||
# INDICATOR.
|
# INDICATOR.
|
||||||
|
|
||||||
CS CM/FLAGS
|
CS CM/FLAGS
|
||||||
MASK BIT11 # GAMDIFSW=94D BIT11 INITLY=0
|
MASK BIT11 # GAMDIFSW=94D BIT11 INITLY=0
|
||||||
EXTEND # DON'T CALC GAMA DOT UNTIL HAVE FORMD
|
EXTEND # DONT CALC GAMA DOT UNTIL HAVE FORMD
|
||||||
# ONE DIFFERENCE.
|
# ONE DIFFERENCE.
|
||||||
BZF DOGAMDOT # IS OK, GO ON.
|
BZF DOGAMDOT # IS OK, GO ON.
|
||||||
ADS CM/FLAGS # KNOW BIT IS 0
|
ADS CM/FLAGS # KNOW BIT IS 0
|
||||||
@ -224,12 +224,12 @@ DOGAMDOT CS L
|
|||||||
EXTEND
|
EXTEND
|
||||||
BZMF +3 # SET GAMDOT=+0 AS TAG IF TOO SMALL.
|
BZMF +3 # SET GAMDOT=+0 AS TAG IF TOO SMALL.
|
||||||
|
|
||||||
NOGAMDOT CA ZERO # COME HERE INHINTED
|
NOGAMDOT CA ZERO # COME HERE INHINTED.
|
||||||
TS GAMDOT
|
TS GAMDOT
|
||||||
# FOR NOW LEAVE IN 2'S C
|
# FOR NOW LEAVE IN 2S.C
|
||||||
# UPDATE ANGLES BY CORRECTING EULER ANG
|
# UPDATE ANGLES BY CORRECTING EUILER ANG
|
||||||
# FOR ACCRUED INCREMENT SINCE PIPUP
|
# FOR ACCRUED INCREMENT SINCE PIPUP
|
||||||
# R = R EUIL + R(NOW) - R(PIPUP)
|
# R = R EUIL + R(NOW) -R(PIPUP)
|
||||||
CS MPAC # GET (R EUL/180) /2
|
CS MPAC # GET (R EUL/180) /2
|
||||||
DOUBLE # POSSIBLE OVERFLOW
|
DOUBLE # POSSIBLE OVERFLOW
|
||||||
TC CORANGOV # CORRECT FOR OVFL IF ANY
|
TC CORANGOV # CORRECT FOR OVFL IF ANY
|
||||||
@ -277,7 +277,7 @@ REDOPOSE EXTEND # RE-STARTS COME HERE
|
|||||||
|
|
||||||
RELINT
|
RELINT
|
||||||
|
|
||||||
TC INTPRET # CAN'T TC DANZIG AFTER PHASCHNG.
|
TC INTPRET # CANT TC DANZIG AFTER PHASCHNG.
|
||||||
CM/POSE3 VLOAD ABVAL # RETURN FROM CM/ATUP. (RESTART)
|
CM/POSE3 VLOAD ABVAL # RETURN FROM CM/ATUP. (RESTART)
|
||||||
VN # 2(-7) M/CS
|
VN # 2(-7) M/CS
|
||||||
STORE VMAGI # FOR DISPLAY ON CALL.
|
STORE VMAGI # FOR DISPLAY ON CALL.
|
||||||
@ -299,4 +299,3 @@ TCDU DEC .1 # TCDU = .1 SEC.
|
|||||||
|
|
||||||
EBANK= AOG
|
EBANK= AOG
|
||||||
REPOSADR 2CADR REDOPOSE
|
REPOSADR 2CADR REDOPOSE
|
||||||
|
|
||||||
|
Loading…
Reference in New Issue
Block a user