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. | 		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 | ||||||
|  | # ************************************************************************ | ||||||
| # ****************************************************************************** |  | ||||||
|  |  | ||||||
|  |  | ||||||
|   | |||||||
		Reference in New Issue
	
	Block a user