kjodle/Apollo-11
1
0
Fork 0
Code Issues Pull Requests Projects Releases Wiki Activity

Proof MEASUREMENT_INCORPORATION (#358)

Browse Source 
Closes #227, covers pages 1252 to 1261
This commit is contained in:
James Buckley 2018-11-13 10:12:24 -06:00 committed by James Harris
parent c3f93c3ccf
commit 2e30258105
1 changed files with 61 additions and 68 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

27
Comanche055/MEASUREMENT_INCORPORATION.agc
View File

@ -28,16 +28,15 @@
# Colossus 2A # Colossus 2A
# Page 1252 # Page 1252
# INCORP1 -- PERFORMS THE SIX DIMENSIONAL STATE VECTOR DEVIATION FOR POSITION # INCORP1--PERFORMS THE SIX DIMENSIONAL STATE VECTOR DEVIATION FOR POSITI
# AND VELOCITY OR THE NINE-DIMENSIONAL DEVIATION OF POSITION, VELOCITY, AND # ON AND VELOCITY OR THE NINE DIMENSIONAL DEVIATION OF POSITION,VELOCITY,A
# RADAR OR LANDMARK BIAS. THE OUTPUT OF THE BVECTOR ROUTINE ALONG WITH THE # ND RADAR OR LANDMARK BIAS.THE OUTPUT OF THE BVECTOR ROUTINE ALONG WITH T
# ERROR TRANSITION MATRIX (W) ARE USED AS INPUT TO THE ROUTINE. THE DEVIATION # HE ERROR TRANSITION MATRIX(W) ARE USED AS INPUT TO THE ROUTINE.THE DEVIA
# IS OBTAINED BY COMPUTING AN ESTIMATED TRACKING MEASUREMENT FROM THE # TION IS OBTAINED BY COMPUTING AN ESTIMATED TRACKING MEASUREMENT FROM THE
# CURRENT STATE VECTOR AND COMPARING IT WITH AN ACTUAL TRACKING MEASUREMENT # CURRENT STATE VECTOR AND COMPARING IT WITH AN ACTUAL TRACKING MEASUREMEN
# AND APPLYING A STATISTICAL WEIGHTING VECTOR. # T AND APPLYING A STATISTICAL WEIGHTING VECTOR.
#
# INPUT # INPUT
# DMENFLG = 0 (6-DIMENSIONAL BVECTOR), =1 (9-DIMENSIONAL) # DMENFLG = 0 6DIMENSIONAL BVECTOR 1= 9DIMENSIONAL
# W = ERROR TRANSITION MATRIX 6X6 OR 9X9 # W = ERROR TRANSITION MATRIX 6X6 OR 9X9
# VARIANCE = VARIANCE (SCALAR) # VARIANCE = VARIANCE (SCALAR)
# DELTAQ = MEASURED DEVIATION(SCALAR) # DELTAQ = MEASURED DEVIATION(SCALAR)
@ -88,7 +87,7 @@ Z123 VLOAD MXV*
BVECTOR +12D # BVECTOR (2) BVECTOR +12D # BVECTOR (2)
MXV* VAD* MXV* VAD*
W +162D,1 W +162D,1
ZI +18D,2 # B(0)*W+B(1)*(W+54)+B(2)*(W+108) FIRST PASS ZI +18D,2 # B(0)*W+B(1)*(W+54)+B(2)*(W+108)FIRST PAS
STORE ZI +18D,2 # ZI THEN Z2 THEN Z3 STORE ZI +18D,2 # ZI THEN Z2 THEN Z3
TIX,1 TIX,1
INCOR1 INCOR1
@ -206,10 +205,9 @@ INCOR3 VLOAD*
EGRESS EGRESS
# Page 1256 # Page 1256
# INCORP2 -- INCORPORATES THE COMPUTED STATE VECTOR DEVIATIONS INTO THE # INCORP2 -INCORPORATES THE COMPUTED STATE VECTOR DEVIATIONS INTO THE
# ESTIMATED STATE VECTOR. THE STATE VECTOR UPDATED MAY BE FOR EITHER THE # ESTIMATED STATE VECTOR. THE STATE VECTOR UPDATED MAY BE FOR EITHER THE
# LEM OR THE CSM.DETERMINED BY FLAG VEHUPFLG.(ZERO = LEM) (1 = CSM) # LEM OR THE CSM.DETERMINED BY FLAG VEHUPFLG.(ZERO = LEM) (1 = CSM)
#
# INPUT # INPUT
# PERMANENT STATE VECTOR FOR EITHER THE LEM OR CSM # PERMANENT STATE VECTOR FOR EITHER THE LEM OR CSM
# VEHUPFLG = UPDATE VEHICLE C=LEM 1=CSM # VEHUPFLG = UPDATE VEHICLE C=LEM 1=CSM
@ -462,7 +460,6 @@ NEWZCOMP VLOAD ABVAL
SETLOC MEASINC3 SETLOC MEASINC3
BANK BANK
# Page 1261 # Page 1261
NEWZCMP1 DLOAD SXA,1 NEWZCMP1 DLOAD SXA,1
NORMZI NORMZI
@ -497,7 +494,3 @@ NEWZCMP1 DLOAD SXA,1
GOTO GOTO
INCOR2 -3 INCOR2 -3
NORMZI = 36D NORMZI = 36D