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

35
Comanche055/MEASUREMENT_INCORPORATION.agc
View File

@ -28,19 +28,18 @@
# 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)
# BVECTOR = 6 OR 9 DIMENSIONAL BVECTOR # BVECTOR = 6 OR 9 DIMENSIONAL BVECTOR
# #
# OUTPUT # OUTPUT
@ -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
@ -173,7 +172,7 @@ INCOR2 VLOAD VXM* # COMPUT OMEGA1,2,3
ZI +12D ZI +12D
VXM* VAD VXM* VAD
W +198D,2 W +198D,2
PUSH TIX,2 # PD 2-7=OMEGA1, 8-13=OMEGA2, 14-19=OMEGA3 PUSH TIX,2 # PD 2-7=OMEGA1,8-13=OMEGA2,14-19=OMEGA3
INCOR2 INCOR2
VLOAD STADR VLOAD STADR
STORE OMEGA +12D STORE OMEGA +12D
@ -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
@ -238,7 +236,7 @@ INCOR3 VLOAD*
INCORP2 STQ CALL INCORP2 STQ CALL
EGRESS EGRESS
INTSTALL INTSTALL
VLOAD VXSC # CALC. GAMMA*OMEGA1,2,3 VLOAD VXSC # CALC. GAMMA * OMEGA1,2,3
OMEGA OMEGA
GAMMA GAMMA
STOVL OMEGAM1 STOVL OMEGAM1
@ -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