Proof KALCMANU_STEERING #598 (#735)

Co-authored-by: James Harris <wopian@wopian.me>
pull/772/head
Karl Goffin 2020-10-20 17:56:00 +03:00 committed by GitHub
parent 8c1ce8ef4d
commit f2522c9bb3
No known key found for this signature in database
GPG Key ID: 4AEE18F83AFDEB23
1 changed files with 16 additions and 24 deletions

View File

@ -37,7 +37,7 @@
NEWDELHI TC BANKCALL # CHECK FOR AUTO STABILIZATION
CADR ISITAUTO # ONLY
CCS A
TCF NOGO -2
TCF NOGO -2
NEWANGL TC INTPRET
AXC,1 AXC,2
MIS # COMPUTE THE NEW MATRIX FROM S/C TO
@ -45,9 +45,9 @@ NEWANGL TC INTPRET
CALL
MXM3
VLOAD STADR
STOVL MIS +12D # CALCULATE NEW DESIRED CDU ANGLES
STOVL MIS +12D # CALCULATE NEW DESIRED CDU ANGLES
STADR
STOVL MIS +6D
STOVL MIS +6D
STADR
STORE MIS
AXC,1 CALL
@ -59,7 +59,7 @@ NEWANGL TC INTPRET
BONCLR EXIT
CALCMAN2
MANUSTAT # TO START MANEUVER
CAF TWO # +0 OTHERWISE
CAF TWO # +0 OTHERWISE
INCRDCDU TS SPNDX
INDEX SPNDX
CA BCDU # INITIAL CDU ANGLES
@ -67,16 +67,10 @@ INCRDCDU TS SPNDX
INDEX SPNDX
MSU NCDU
EXTEND
# The following 2 lines seem to have no purpose at all.
# I am removing them because they only serve to confuse
# the assembler by getting in between EXTEND and MP.
# --- RSB 2009.
#SETLOC KALCMON1
#BANK
SETLOC KALCMON1
BANK
MP DT/TAU
CCS A # CONVERT TO 2'S COMPLEMENT
CCS A # CONVERT TO 2S COMPLEMENT
AD ONE
TCF +2
COM
@ -94,7 +88,7 @@ INCRDCDU TS SPNDX
RELINT
# COMPARE PRESENT TIME WTIH TIME TO TERMINATE MANEUVER
# COMPARE PRESENT TIME WITH TIME TO TERMINATE MANEUVER
TMANUCHK TC TIMECHK
TCF CONTMANU
@ -117,11 +111,11 @@ TIMECHK EXTEND
TC Q
TCF +2
TCF 2NDRETRN
CCS TTEMP +1
CCS TTEMP +1
TC Q
TCF MANUOFF
COM
MANUOFF AD ONESEK +1
MANUOFF AD ONESEK +1
EXTEND
BZMF 2NDRETRN
INCR Q
@ -134,7 +128,7 @@ MANUSTAT EXIT # INITIALIZATION ROUTINE
EXTEND # FOR AUTOMATIC MANEUVERS
DCA TIME2
# Page 367
DAS TM # TM+TO MANEUVER COMPLETION TIME
DAS TM # TM+TO MANEUVER COMPLETION TIME
EXTEND
DCS ONESEK
DAS TM # (TM+TO)-1
@ -157,14 +151,14 @@ RATEBIAS TS KSPNDX
MP BRATE
EXTEND
INDEX KSPNDX
DV 1JACC # = AJX $ 90 DEG/SEC-SEC
DV 1JACC # =AJX $ 90 DEG/SEC-SEC
INDEX KSPNDX
TS DELPEROR # $ 180 DEG
TS DELPEROR # $ 180 DEG
CCS KSPNDX
TCF RATEBIAS
CA TIME1
AD ONESEK +1
AD ONESEK +1
XCH NEXTIME
TCF INCRDCDU -1
@ -185,7 +179,7 @@ MANUCALL INHINT # CALL FOR NEXT UPDATE VIA WAITLIST
EBANK= TTEMP
2CADR UPDTCALL
# Page 368
CAF ONESEK +1 # INCREMENT TIME FOR NEXT UPDATE
CAF ONESEK +1 # INCREMENT TIME FOR NEXT UPDATE
ADS NEXTIME
TCF ENDOFJOB
@ -213,7 +207,7 @@ MANUSTOP CAF ZERO # ZERO MANEUVER RATES
ENDROLL CA CPHI # NO FINAL YAW
TS CDUXD
CAF ZERO
TS OMEGAPD # I.E., MANEUVER DID NOT GO THRU
TS OMEGAPD # I.E. MANEUVER DID NOT GO THRU
TS DELDCDU # GIMBAL LOCK ORIGINALLY
TS DELPEROR
GOODMANU CA ATTPRIO # RESTORE USERS PRIO
@ -225,5 +219,3 @@ GOODMANU CA ATTPRIO # RESTORE USERS PRIO
TC SPVAC # RETURN TO USER
TC TASKOVER