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 | ||||
| 		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 | ||||
| DATAOUT		TS	ALTM		# ACTIVATE THE LANDING ANALOG DISPLAYS - - | ||||
| 		CAF	BIT3 | ||||
| 		EXTEND | ||||
| 		WOR	CHAN14		# BIT3 DRIVES THE ALT/ALTRATE METER. | ||||
| @@ -265,13 +265,13 @@ SPEEDRUN	CS	PIPTIME +1	# UPDATE THE VELOCITY VECTOR | ||||
| 		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 | ||||
| @@ -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 | ||||
| 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 | ||||
| @@ -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