Proof CM_BODY_ATTITUDE (#195) (#336)

🕵️ Proofread #195
pull/342/head
Glenn Dwiyatcita 2018-05-28 15:42:47 +02:00 committed by James Harris
parent 624a548983
commit 00444f654f
1 changed files with 18 additions and 19 deletions

View File

@ -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
@ -146,7 +146,7 @@ CM/TRIO STODL 24D
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
@ -205,7 +205,7 @@ CMTR1 INDEX FIXLOC
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