P-AXIS_RCS_AUTOPILOT completed

This commit is contained in:
Dhairya Gada 2020-10-26 19:54:31 +05:30
parent b56164625a
commit b6a0690dc2

View File

@ -746,7 +746,7 @@ RATERROR CA CDUX # FINDCDUW REQUIRES THAT CDUXD=CDUX DURING
TS EDOTP TS EDOTP
CCS DAPTEMP1 # IF P COMMAND CHANGE EXCEEDS BREAKOUT CCS DAPTEMP1 # IF P COMMAND CHANGE EXCEEDS BREAKOUT
TCF +3 # LEVEL, GO TO DIRECT RATE CONTROL. IF NOT TCF +3 # LEVEL, GO TO DIRECT RATE CONTROL. IF NOT
TCF +8D # CHECK FOR DIRECT RATE CONTROL LAST TIME. TCF +8 # CHECK FOR DIRECT RATE CONTROL LAST TIME.
TCF +1 TCF +1
# Page 1435 # Page 1435
AD -RATEDB AD -RATEDB
@ -776,7 +776,7 @@ PEGI CA CDUX # DIRECT RATE CONTROL.
TC +1 TC +1
TS ABSEDOTP TS ABSEDOTP
AD TARGETDB AD TARGETDB
EXTEND # IF RATE ERROR IS LESS THAN DEADBANK, EXTEND # IF RATE ERROR IS LESS THAN DEADBAND,
BZMF LAST # FIRE, AN SWITCH TO PSEUDO-AUTO. BZMF LAST # FIRE, AN SWITCH TO PSEUDO-AUTO.
CA TCP CA TCP
EXTEND # IF TIME IN RATE COMMAND EXCEEDS 4 SEC. EXTEND # IF TIME IN RATE COMMAND EXCEEDS 4 SEC.
@ -910,7 +910,7 @@ CALCPERR CA CDUY # P-ERROR CALCULATION.
XCH E # SAVE FIRST TERM (OF TWO) XCH E # SAVE FIRST TERM (OF TWO)
CA CDUX # THIRD COMPONENT CA CDUX # THIRD COMPONENT
EXTEND EXTEND
MSU CDUXD # CDU VALUE -- ANGLE DESIRED (X-AXIS) MSU CDUXD # CDU VALUE - ANGLE DESIRED (X-AXIS)
# EXTEND # EXTEND
# MP M13 # MP M13
AD DELPEROR # KALCMANU INTERFACE ERROR. AD DELPEROR # KALCMANU INTERFACE ERROR.