Co-authored-by: nabeel.hassan <nabeel.hassan@colwiz.com> Co-authored-by: James Harris <wopian@wopian.me>
This commit is contained in:
parent
90e37c527e
commit
9f58155b0c
@ -53,10 +53,10 @@ ALTROUT TC DISINDAT # CHECK MODE SELECT SWITCH AND DIDFLG.
|
|||||||
CAF BIT2 # RATE COMMAND IS EXECUTED BEFORE RANGE.
|
CAF BIT2 # RATE COMMAND IS EXECUTED BEFORE RANGE.
|
||||||
EXTEND
|
EXTEND
|
||||||
WOR CHAN14 # ALTRATE (BIT2 = 1), ALTITUDE (BIT2 = 0).
|
WOR CHAN14 # ALTRATE (BIT2 = 1), ALTITUDE (BIT2 = 0).
|
||||||
ARCOMP CA RUNIT # COMPUTE ALTRATE = RUNIT.VVECT M/CS *(-6).
|
ARCOMP CA RUNIT # COMPUTE ALTRATE=RUNIT.VVECT M/CS *2(-6).
|
||||||
EXTEND
|
EXTEND
|
||||||
MP VVECT # MULTIPLY X-COMPONENTS.
|
MP VVECT # MULTIPLY X-COMPONENTS.
|
||||||
XCH RUPTREG1 # SAVE SINGLE PRECISION RESULT M/CS*2(-6)
|
XCH RUPTREG1 # SAVE SINGLE PRECISION RESULT M/CS*2(-6).
|
||||||
CA RUNIT +1 # MULTIPLY Y-COMPONENTS.
|
CA RUNIT +1 # MULTIPLY Y-COMPONENTS.
|
||||||
EXTEND
|
EXTEND
|
||||||
MP VVECT +1
|
MP VVECT +1
|
||||||
@ -80,10 +80,10 @@ ARCOMP CA RUNIT # COMPUTE ALTRATE = RUNIT.VVECT M/CS *(-6).
|
|||||||
# Page 899
|
# Page 899
|
||||||
EXTEND # CHECK POLARITY OF ALTITUDE RATE.
|
EXTEND # CHECK POLARITY OF ALTITUDE RATE.
|
||||||
BZMF +2
|
BZMF +2
|
||||||
TCF DATAOUT # NEGATIVE -- SEND POS. PULSES TO ALTM REG.
|
TCF DATAOUT # NEGATIVE - SEND POS. PULSES TO ALTM REG.
|
||||||
CA ALTRATE # POSITIVE OR ZERO -- SET SIGN BIT = 1 AND
|
CA ALTRATE # POSITIVE OR ZERO - SET SIGN BIT = 1 AND
|
||||||
AD BIT15 # SEND TO ALTM REGISTER. *DO NOT SEND +0*
|
AD BIT15 # SEND TO ALTM REGISTER. *DO NOT SEND +0*
|
||||||
DATAOUT TS ALTM # ACTIVATE THE LANDING ANALOG DISPLAYS
|
DATAOUT TS ALTM # ACTIVATE THE LANDING ANALOG DISPLAYS - -
|
||||||
CAF BIT3
|
CAF BIT3
|
||||||
EXTEND
|
EXTEND
|
||||||
WOR CHAN14 # BIT3 DRIVES THE ALT/ALTRATE METER.
|
WOR CHAN14 # BIT3 DRIVES THE ALT/ALTRATE METER.
|
||||||
@ -96,13 +96,13 @@ ALTOUT TC DISINDAT # CHECK MODE SELECT SWITCH AND DIDFLG.
|
|||||||
CS BIT2
|
CS BIT2
|
||||||
EXTEND
|
EXTEND
|
||||||
WAND CHAN14
|
WAND CHAN14
|
||||||
CCS ALTBITS # = -1 IF OLD ALT. DATA TO BE EXTRAPOLATED.
|
CCS ALTBITS # =-1 IF OLD ALT. DATA TOBE EXTRAPOLATED.
|
||||||
TCF +4
|
TCF +4
|
||||||
TCF +3
|
TCF +3
|
||||||
TCF OLDDATA
|
TCF OLDDATA
|
||||||
TS ALTBITS # SET ALTBITS FROM -0 TO +0.
|
TS ALTBITS # SET ALTBITS FROM -0 TO +0.
|
||||||
CS ONE
|
CS ONE
|
||||||
DXCH ALTBITS # SET ALTBITS = -1 FOR SWITCH USE NEXT PASS.
|
DXCH ALTBITS # SET ALTBITS=-1 FOR SWITCH USE NEXT PASS.
|
||||||
DXCH ALTSAVE
|
DXCH ALTSAVE
|
||||||
CA BIT10 # NEW ALTITUDE EXTRAPOLATION WITH ALTRATE.
|
CA BIT10 # NEW ALTITUDE EXTRAPOLATION WITH ALTRATE.
|
||||||
XCH Q
|
XCH Q
|
||||||
@ -262,16 +262,16 @@ SPEEDRUN CS PIPTIME +1 # UPDATE THE VELOCITY VECTOR
|
|||||||
|
|
||||||
CA DELVS # HI X OF VELOCITY CORRECTION TERM.
|
CA DELVS # HI X OF VELOCITY CORRECTION TERM.
|
||||||
AD VVECT # HI X OF UPDATED VELOCITY VECTOR.
|
AD VVECT # HI X OF UPDATED VELOCITY VECTOR.
|
||||||
TS ITEMP1 # = VX - DVX M/CS *2(-5).
|
TS ITEMP1 # = VX - DVX M/CS*2(-5).
|
||||||
CA DELVS +2 # Y
|
CA DELVS +2 # Y
|
||||||
AD VVECT +1 # Y
|
AD VVECT +1 # Y
|
||||||
TS ITEMP2 # = VY - DVY M/CS *2(-5)
|
TS ITEMP2 # = VY - DVY M/CS*2(-5).
|
||||||
CA DELVS +4 # Z
|
CA DELVS +4 # Z
|
||||||
AD VVECT +2 # Z
|
AD VVECT +2 # Z
|
||||||
TS ITEMP3 # = VZ - DVZ M/CS *2(-5)
|
TS ITEMP3 # = VZ - DVZ M/CS*2(-5).
|
||||||
CA ITEMP1 # COMPUTE VHY, VELOCITY DIRECTED ALONG THE
|
CA ITEMP1 # COMPUTE VHY, VELOCITY DIRECTED ALONG THE
|
||||||
EXTEND # Y-COORDINATE.
|
EXTEND # Y-COORDINATE.
|
||||||
MP UHYP # HI X OF CROSS-RANGE HALF-UNIT VECTOR
|
MP UHYP # HI X OF CROSS-RANGE HALF-UNIT VECTOR.
|
||||||
XCH RUPTREG1
|
XCH RUPTREG1
|
||||||
CA ITEMP2
|
CA ITEMP2
|
||||||
EXTEND
|
EXTEND
|
||||||
@ -317,7 +317,7 @@ LATFWDV CA ITEMP4 # COMPUTE LATERAL AND FORWARD VELOCITIES.
|
|||||||
CA ITEMP3
|
CA ITEMP3
|
||||||
EXTEND
|
EXTEND
|
||||||
MP VHZ
|
MP VHZ
|
||||||
ADS RUPTREG1 # = VHY(COS)AOG+VHZ(SIN)AOG M/CS *2(-5)
|
ADS RUPTREG1 # =VHY(COS)AOG+VHZ(SIN)AOG M/CS *2(-5)
|
||||||
CA VELCONV # CONVERT LATERAL VELOCITY TO BIT UNITS.
|
CA VELCONV # CONVERT LATERAL VELOCITY TO BIT UNITS.
|
||||||
EXTEND
|
EXTEND
|
||||||
MP RUPTREG1
|
MP RUPTREG1
|
||||||
@ -427,7 +427,6 @@ LVLIMITS INDEX ITEMP5
|
|||||||
BZMF +2
|
BZMF +2
|
||||||
TCF NEGLMLV
|
TCF NEGLMLV
|
||||||
INDEX ITEMP5
|
INDEX ITEMP5
|
||||||
|
|
||||||
CS LATVEL
|
CS LATVEL
|
||||||
EXTEND
|
EXTEND
|
||||||
BZMF LVMINLM
|
BZMF LVMINLM
|
||||||
@ -500,11 +499,11 @@ ZEROLSTY INDEX ITEMP5
|
|||||||
EXTEND
|
EXTEND
|
||||||
WOR CHAN14
|
WOR CHAN14
|
||||||
TC LADQSAVE # GO TO ALTROUT +1 OR TO ALTOUT +1
|
TC LADQSAVE # GO TO ALTROUT +1 OR TO ALTOUT +1
|
||||||
ZERODATA CAF ZERO # ZERO ALTSAVE AND ALTSAVE +1
|
ZERODATA CAF ZERO # ZERO ALTSAVE AND ALTSAVE +1 - - -
|
||||||
TS L # NO NEGATIVE ALTITUDES ALLOWED.
|
TS L # NO NEGATIVE ALTITUDES ALLOWED.
|
||||||
TCF ZDATA2
|
TCF ZDATA2
|
||||||
|
|
||||||
# ****************************************************************************
|
# ************************************************************************
|
||||||
|
|
||||||
DISPRSET CS FLAGWRD0 # ARE WE IN DESCENT TRAJECTORY?
|
DISPRSET CS FLAGWRD0 # ARE WE IN DESCENT TRAJECTORY?
|
||||||
MASK R10FLBIT
|
MASK R10FLBIT
|
||||||
@ -525,12 +524,10 @@ ABORTON CS BITS8/7 # RESET INERTIAL DATA, INTERLEAVE FLAGS.
|
|||||||
MASK FLAGWRD1
|
MASK FLAGWRD1
|
||||||
TS FLAGWRD1 # RESET DIDFLAG.
|
TS FLAGWRD1 # RESET DIDFLAG.
|
||||||
TCF TASKOVER
|
TCF TASKOVER
|
||||||
|
# ************************************************************************
|
||||||
# ******************************************************************************
|
|
||||||
|
|
||||||
BITS8/7 OCT 00300 # INERTIAL DATA AND INTERLEAVE FLAGS.
|
BITS8/7 OCT 00300 # INERTIAL DATA AND INTERLEAVE FLAGS.
|
||||||
|
|
||||||
BITSET = PRIO6
|
BITSET = PRIO6
|
||||||
|
# ************************************************************************
|
||||||
# ******************************************************************************
|
|
||||||
|
|
||||||
|
|
||||||
|
Loading…
Reference in New Issue
Block a user