Skip to content

Commit

Permalink
Proof KALCMANU_STEERING chrislgarry#598 (chrislgarry#735)
Browse files Browse the repository at this point in the history
Co-authored-by: James Harris <wopian@wopian.me>
  • Loading branch information
kagof and wopian authored Oct 20, 2020
1 parent 8c1ce8e commit f2522c9
Showing 1 changed file with 16 additions and 24 deletions.
40 changes: 16 additions & 24 deletions Luminary099/KALCMANU_STEERING.agc
Original file line number Diff line number Diff line change
Expand Up @@ -37,17 +37,17 @@
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
KEL # STABLE MEMBER AXES
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
Expand All @@ -59,24 +59,18 @@ 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
EXTEND # OR PREVIOUS DESIRED CDU ANGLES
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
Expand All @@ -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
Expand All @@ -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
Expand All @@ -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
Expand All @@ -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

Expand All @@ -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

Expand Down Expand Up @@ -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
Expand All @@ -225,5 +219,3 @@ GOODMANU CA ATTPRIO # RESTORE USERS PRIO
TC SPVAC # RETURN TO USER

TC TASKOVER


0 comments on commit f2522c9

Please sign in to comment.