Co-authored-by: nabeel.hassan <nabeel.hassan@colwiz.com> Co-authored-by: James Harris <wopian@wopian.me>
This commit is contained in:
		| @@ -53,10 +53,10 @@ ALTROUT		TC	DISINDAT	# CHECK MODE SELECT SWITCH AND DIDFLG. | ||||
| 		CAF	BIT2		# RATE COMMAND IS EXECUTED BEFORE RANGE. | ||||
| 		EXTEND | ||||
| 		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 | ||||
| 		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. | ||||
| 		EXTEND | ||||
| 		MP	VVECT +1 | ||||
| @@ -80,10 +80,10 @@ ARCOMP		CA	RUNIT		# COMPUTE ALTRATE = RUNIT.VVECT M/CS *(-6). | ||||
| # Page 899 | ||||
| 		EXTEND			# CHECK POLARITY OF ALTITUDE RATE. | ||||
| 		BZMF	+2 | ||||
| 		TCF	DATAOUT		# NEGATIVE -- SEND POS. PULSES TO ALTM REG. | ||||
| 		CA	ALTRATE		# POSITIVE OR ZERO -- SET SIGN BIT = 1 AND | ||||
| 		AD	BIT15		# SEND TO ALTM REGISTER.  *DO NOT SEND +0* | ||||
| DATAOUT		TS	ALTM		# ACTIVATE THE LANDING ANALOG DISPLAYS | ||||
| 		TCF	DATAOUT		# NEGATIVE - SEND POS. PULSES TO ALTM REG. | ||||
| 		CA	ALTRATE		# POSITIVE OR ZERO - SET SIGN BIT = 1 AND | ||||
| 		AD	BIT15		# SEND TO ALTM REGISTER. *DO NOT SEND +0* | ||||
| DATAOUT		TS	ALTM		# ACTIVATE THE LANDING ANALOG DISPLAYS - - | ||||
| 		CAF	BIT3 | ||||
| 		EXTEND | ||||
| 		WOR	CHAN14		# BIT3 DRIVES THE ALT/ALTRATE METER. | ||||
| @@ -96,13 +96,13 @@ ALTOUT		TC	DISINDAT	# CHECK MODE SELECT SWITCH AND DIDFLG. | ||||
| 		CS	BIT2 | ||||
| 		EXTEND | ||||
| 		WAND	CHAN14 | ||||
| 		CCS	ALTBITS		# = -1 IF OLD ALT. DATA TO BE EXTRAPOLATED. | ||||
| 		CCS	ALTBITS		# =-1 IF OLD ALT. DATA TOBE EXTRAPOLATED. | ||||
| 		TCF	+4 | ||||
| 		TCF	+3 | ||||
| 		TCF	OLDDATA | ||||
| 		TS	ALTBITS		# SET ALTBITS FROM -0 TO +0. | ||||
| 		CS	ONE | ||||
| 		DXCH	ALTBITS		# SET ALTBITS = -1 FOR SWITCH USE NEXT PASS. | ||||
| 		DXCH	ALTBITS		# SET ALTBITS=-1 FOR SWITCH USE NEXT PASS. | ||||
| 		DXCH	ALTSAVE | ||||
| 		CA	BIT10		# NEW ALTITUDE EXTRAPOLATION WITH ALTRATE. | ||||
| 		XCH	Q | ||||
| @@ -150,11 +150,11 @@ DISINDAT	EXTEND | ||||
| 		RAND	CHAN30		# DISPLAYS?  I.E., | ||||
| 		CCS	A		# IS THE MODE SELECT SWITCH IN PGNCS? | ||||
| 		TCF	DISPRSET	# NO.  ASTRONAUT REQUESTS NO INERTIAL DATA | ||||
| 		CS	FLAGWRD1	# YES.  CHECK STATUS OF DIDFLAG. | ||||
| 		CS	FLAGWRD1	# YES. CHECK STATUS OF DIDFLAG. | ||||
| 		MASK	DIDFLBIT | ||||
| 		EXTEND | ||||
| 		BZF	SPEEDRUN	# SET.  PERFORM DATA DISPLAY SEQUENCE. | ||||
| 		CS	FLAGWRD1	# RESET.  PERFORM INITIALIZATION FUNCTIONS. | ||||
| 		BZF	SPEEDRUN	# SET. PERFORM DATA DISPLAY SEQUENCE. | ||||
| 		CS	FLAGWRD1	# RESET. PERFORM INITIALIZATION FUNCTIONS. | ||||
| 		MASK	DIDFLBIT | ||||
| 		ADS	FLAGWRD1	# SET DIDFLAG. | ||||
| 		CS	BIT7 | ||||
| @@ -262,24 +262,24 @@ SPEEDRUN	CS	PIPTIME +1	# UPDATE THE VELOCITY VECTOR | ||||
|  | ||||
| 		CA	DELVS		# HI X OF VELOCITY CORRECTION TERM. | ||||
| 		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 | ||||
| 		AD	VVECT +1	#    Y | ||||
| 		TS	ITEMP2		# = VY - DVY M/CS *2(-5) | ||||
| 		TS	ITEMP2		# = VY - DVY M/CS*2(-5). | ||||
| 		CA	DELVS +4	#    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 | ||||
| 		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 | ||||
| 		CA	ITEMP2 | ||||
| 		EXTEND | ||||
| 		MP	UHYP +2		# Y | ||||
| 		MP	UHYP +2		#    Y | ||||
| 		ADS	RUPTREG1	# ACCUMULATE PARTIAL PRODUCTS. | ||||
| 		CA	ITEMP3 | ||||
| 		EXTEND | ||||
| 		MP	UHYP +4		# Z | ||||
| 		MP	UHYP +4		#    Z | ||||
| 		ADS	RUPTREG1 | ||||
| # Page 903 | ||||
| 		CA	RUPTREG1 | ||||
| @@ -291,11 +291,11 @@ SPEEDRUN	CS	PIPTIME +1	# UPDATE THE VELOCITY VECTOR | ||||
| 		XCH	RUPTREG1 | ||||
| 		CA	ITEMP2 | ||||
| 		EXTEND | ||||
| 		MP	UHZP +2		# Y | ||||
| 		MP	UHZP +2		#    Y | ||||
| 		ADS	RUPTREG1	# ACCUMULATE PARTIAL PRODUCTS. | ||||
| 		CA	ITEMP3 | ||||
| 		EXTEND | ||||
| 		MP	UHZP +4		# Z | ||||
| 		MP	UHZP +4		#    Z | ||||
| 		ADS	RUPTREG1 | ||||
| 		CA	RUPTREG1 | ||||
| 		DOUBLE | ||||
| @@ -317,7 +317,7 @@ LATFWDV		CA	ITEMP4		# COMPUTE LATERAL AND FORWARD VELOCITIES. | ||||
| 		CA	ITEMP3 | ||||
| 		EXTEND | ||||
| 		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. | ||||
| 		EXTEND | ||||
| 		MP	RUPTREG1 | ||||
| @@ -344,7 +344,7 @@ LATFWDV		CA	ITEMP4		# COMPUTE LATERAL AND FORWARD VELOCITIES. | ||||
|  | ||||
| 		CAF	ONE		# LOOP TWICE. | ||||
| VMONITOR	TS	ITEMP5		# FORWARD AND LATERAL VELOCITY LANDING | ||||
| 		INDEX	ITEMP5		#	ANALOG DISPLAYS MONITOR. | ||||
| 		INDEX	ITEMP5		#    ANALOG DISPLAYS MONITOR. | ||||
| 		CCS	LATVEL | ||||
| 		TCF	+4 | ||||
| 		TCF	LVLIMITS | ||||
| @@ -427,7 +427,6 @@ LVLIMITS	INDEX	ITEMP5 | ||||
| 		BZMF	+2 | ||||
| 		TCF	NEGLMLV | ||||
| 		INDEX	ITEMP5 | ||||
|  | ||||
| 		CS	LATVEL | ||||
| 		EXTEND | ||||
| 		BZMF	LVMINLM | ||||
| @@ -500,11 +499,11 @@ ZEROLSTY	INDEX	ITEMP5 | ||||
| 		EXTEND | ||||
| 		WOR	CHAN14 | ||||
| 		TC	LADQSAVE	# GO TO ALTROUT +1 OR TO ALTOUT +1 | ||||
| ZERODATA	CAF	ZERO		# ZERO ALTSAVE AND ALTSAVE +1 | ||||
| 		TS	L		#	NO NEGATIVE ALTITUDES ALLOWED. | ||||
| ZERODATA	CAF	ZERO		# ZERO ALTSAVE AND ALTSAVE +1 - - - | ||||
| 		TS	L		#	 NO NEGATIVE ALTITUDES ALLOWED. | ||||
| 		TCF	ZDATA2 | ||||
|  | ||||
| # **************************************************************************** | ||||
| # ************************************************************************ | ||||
|  | ||||
| DISPRSET	CS	FLAGWRD0	# ARE WE IN DESCENT TRAJECTORY? | ||||
| 		MASK	R10FLBIT | ||||
| @@ -514,7 +513,7 @@ DISPRSET	CS	FLAGWRD0	# ARE WE IN DESCENT TRAJECTORY? | ||||
| 		MASK	IMODES33	# CHECK IF INERTIAL DATA JUST DISPLAYED. | ||||
| 		CCS	A | ||||
| 		CAF	BIT2		# YES. DISABLE RR ERROR COUNTER | ||||
| 		AD	BIT8		# NO.  REMOVE DISPLAY INERTIAL DATA | ||||
| 		AD	BIT8		# NO. REMOVE DISPLAY INERTIAL DATA | ||||
| 		COM | ||||
| 		EXTEND | ||||
| 		WAND	CHAN12 | ||||
| @@ -525,12 +524,10 @@ ABORTON		CS	BITS8/7		# RESET INERTIAL DATA, INTERLEAVE FLAGS. | ||||
| 		MASK	FLAGWRD1 | ||||
| 		TS	FLAGWRD1	# RESET DIDFLAG. | ||||
| 		TCF	TASKOVER | ||||
|  | ||||
| # ****************************************************************************** | ||||
|  | ||||
| # ************************************************************************ | ||||
| BITS8/7		OCT	00300		# INERTIAL DATA AND INTERLEAVE FLAGS. | ||||
|  | ||||
| BITSET		=	PRIO6 | ||||
|  | ||||
| # ****************************************************************************** | ||||
| # ************************************************************************ | ||||
|  | ||||
|  | ||||
|   | ||||
		Reference in New Issue
	
	Block a user