This commit is contained in:
firestar5683
2026-05-31 13:45:41 -05:00
parent 6f5690618f
commit 8a3a872a93
46 changed files with 1413 additions and 1411 deletions
Binary file not shown.
Binary file not shown.
@@ -35,7 +35,7 @@ NS_ :
BS_:
BU_: XXX
BO_ 1280 RADAR_TRACK_500: 8 RADAR
SG_ UNKNOWN_1 : 7|8@0- (1,0) [-128|127] "" XXX
SG_ AZIMUTH : 12|10@0- (0.2,0) [-102.4|102.2] "" XXX
@@ -47,7 +47,7 @@ BO_ 1280 RADAR_TRACK_500: 8 RADAR
SG_ STATE_3 : 39|1@0+ (1,0) [0|1] "" XXX
SG_ REL_SPEED : 53|14@0- (0.01,0) [-81.92|81.92] "" XXX
SG_ STATE_2 : 55|2@0+ (1,0) [0|3] "" XXX
BO_ 1281 RADAR_TRACK_501: 8 RADAR
SG_ UNKNOWN_1 : 7|8@0- (1,0) [-128|127] "" XXX
SG_ AZIMUTH : 12|10@0- (0.2,0) [-102.4|102.2] "" XXX
@@ -59,7 +59,7 @@ BO_ 1281 RADAR_TRACK_501: 8 RADAR
SG_ STATE_3 : 39|1@0+ (1,0) [0|1] "" XXX
SG_ REL_SPEED : 53|14@0- (0.01,0) [-81.92|81.92] "" XXX
SG_ STATE_2 : 55|2@0+ (1,0) [0|3] "" XXX
BO_ 1282 RADAR_TRACK_502: 8 RADAR
SG_ UNKNOWN_1 : 7|8@0- (1,0) [-128|127] "" XXX
SG_ AZIMUTH : 12|10@0- (0.2,0) [-102.4|102.2] "" XXX
@@ -71,7 +71,7 @@ BO_ 1282 RADAR_TRACK_502: 8 RADAR
SG_ STATE_3 : 39|1@0+ (1,0) [0|1] "" XXX
SG_ REL_SPEED : 53|14@0- (0.01,0) [-81.92|81.92] "" XXX
SG_ STATE_2 : 55|2@0+ (1,0) [0|3] "" XXX
BO_ 1283 RADAR_TRACK_503: 8 RADAR
SG_ UNKNOWN_1 : 7|8@0- (1,0) [-128|127] "" XXX
SG_ AZIMUTH : 12|10@0- (0.2,0) [-102.4|102.2] "" XXX
@@ -83,7 +83,7 @@ BO_ 1283 RADAR_TRACK_503: 8 RADAR
SG_ STATE_3 : 39|1@0+ (1,0) [0|1] "" XXX
SG_ REL_SPEED : 53|14@0- (0.01,0) [-81.92|81.92] "" XXX
SG_ STATE_2 : 55|2@0+ (1,0) [0|3] "" XXX
BO_ 1284 RADAR_TRACK_504: 8 RADAR
SG_ UNKNOWN_1 : 7|8@0- (1,0) [-128|127] "" XXX
SG_ AZIMUTH : 12|10@0- (0.2,0) [-102.4|102.2] "" XXX
@@ -95,7 +95,7 @@ BO_ 1284 RADAR_TRACK_504: 8 RADAR
SG_ STATE_3 : 39|1@0+ (1,0) [0|1] "" XXX
SG_ REL_SPEED : 53|14@0- (0.01,0) [-81.92|81.92] "" XXX
SG_ STATE_2 : 55|2@0+ (1,0) [0|3] "" XXX
BO_ 1285 RADAR_TRACK_505: 8 RADAR
SG_ UNKNOWN_1 : 7|8@0- (1,0) [-128|127] "" XXX
SG_ AZIMUTH : 12|10@0- (0.2,0) [-102.4|102.2] "" XXX
@@ -107,7 +107,7 @@ BO_ 1285 RADAR_TRACK_505: 8 RADAR
SG_ STATE_3 : 39|1@0+ (1,0) [0|1] "" XXX
SG_ REL_SPEED : 53|14@0- (0.01,0) [-81.92|81.92] "" XXX
SG_ STATE_2 : 55|2@0+ (1,0) [0|3] "" XXX
BO_ 1286 RADAR_TRACK_506: 8 RADAR
SG_ UNKNOWN_1 : 7|8@0- (1,0) [-128|127] "" XXX
SG_ AZIMUTH : 12|10@0- (0.2,0) [-102.4|102.2] "" XXX
@@ -119,7 +119,7 @@ BO_ 1286 RADAR_TRACK_506: 8 RADAR
SG_ STATE_3 : 39|1@0+ (1,0) [0|1] "" XXX
SG_ REL_SPEED : 53|14@0- (0.01,0) [-81.92|81.92] "" XXX
SG_ STATE_2 : 55|2@0+ (1,0) [0|3] "" XXX
BO_ 1287 RADAR_TRACK_507: 8 RADAR
SG_ UNKNOWN_1 : 7|8@0- (1,0) [-128|127] "" XXX
SG_ AZIMUTH : 12|10@0- (0.2,0) [-102.4|102.2] "" XXX
@@ -131,7 +131,7 @@ BO_ 1287 RADAR_TRACK_507: 8 RADAR
SG_ STATE_3 : 39|1@0+ (1,0) [0|1] "" XXX
SG_ REL_SPEED : 53|14@0- (0.01,0) [-81.92|81.92] "" XXX
SG_ STATE_2 : 55|2@0+ (1,0) [0|3] "" XXX
BO_ 1288 RADAR_TRACK_508: 8 RADAR
SG_ UNKNOWN_1 : 7|8@0- (1,0) [-128|127] "" XXX
SG_ AZIMUTH : 12|10@0- (0.2,0) [-102.4|102.2] "" XXX
@@ -143,7 +143,7 @@ BO_ 1288 RADAR_TRACK_508: 8 RADAR
SG_ STATE_3 : 39|1@0+ (1,0) [0|1] "" XXX
SG_ REL_SPEED : 53|14@0- (0.01,0) [-81.92|81.92] "" XXX
SG_ STATE_2 : 55|2@0+ (1,0) [0|3] "" XXX
BO_ 1289 RADAR_TRACK_509: 8 RADAR
SG_ UNKNOWN_1 : 7|8@0- (1,0) [-128|127] "" XXX
SG_ AZIMUTH : 12|10@0- (0.2,0) [-102.4|102.2] "" XXX
@@ -155,7 +155,7 @@ BO_ 1289 RADAR_TRACK_509: 8 RADAR
SG_ STATE_3 : 39|1@0+ (1,0) [0|1] "" XXX
SG_ REL_SPEED : 53|14@0- (0.01,0) [-81.92|81.92] "" XXX
SG_ STATE_2 : 55|2@0+ (1,0) [0|3] "" XXX
BO_ 1290 RADAR_TRACK_50a: 8 RADAR
SG_ UNKNOWN_1 : 7|8@0- (1,0) [-128|127] "" XXX
SG_ AZIMUTH : 12|10@0- (0.2,0) [-102.4|102.2] "" XXX
@@ -167,7 +167,7 @@ BO_ 1290 RADAR_TRACK_50a: 8 RADAR
SG_ STATE_3 : 39|1@0+ (1,0) [0|1] "" XXX
SG_ REL_SPEED : 53|14@0- (0.01,0) [-81.92|81.92] "" XXX
SG_ STATE_2 : 55|2@0+ (1,0) [0|3] "" XXX
BO_ 1291 RADAR_TRACK_50b: 8 RADAR
SG_ UNKNOWN_1 : 7|8@0- (1,0) [-128|127] "" XXX
SG_ AZIMUTH : 12|10@0- (0.2,0) [-102.4|102.2] "" XXX
@@ -179,7 +179,7 @@ BO_ 1291 RADAR_TRACK_50b: 8 RADAR
SG_ STATE_3 : 39|1@0+ (1,0) [0|1] "" XXX
SG_ REL_SPEED : 53|14@0- (0.01,0) [-81.92|81.92] "" XXX
SG_ STATE_2 : 55|2@0+ (1,0) [0|3] "" XXX
BO_ 1292 RADAR_TRACK_50c: 8 RADAR
SG_ UNKNOWN_1 : 7|8@0- (1,0) [-128|127] "" XXX
SG_ AZIMUTH : 12|10@0- (0.2,0) [-102.4|102.2] "" XXX
@@ -191,7 +191,7 @@ BO_ 1292 RADAR_TRACK_50c: 8 RADAR
SG_ STATE_3 : 39|1@0+ (1,0) [0|1] "" XXX
SG_ REL_SPEED : 53|14@0- (0.01,0) [-81.92|81.92] "" XXX
SG_ STATE_2 : 55|2@0+ (1,0) [0|3] "" XXX
BO_ 1293 RADAR_TRACK_50d: 8 RADAR
SG_ UNKNOWN_1 : 7|8@0- (1,0) [-128|127] "" XXX
SG_ AZIMUTH : 12|10@0- (0.2,0) [-102.4|102.2] "" XXX
@@ -203,7 +203,7 @@ BO_ 1293 RADAR_TRACK_50d: 8 RADAR
SG_ STATE_3 : 39|1@0+ (1,0) [0|1] "" XXX
SG_ REL_SPEED : 53|14@0- (0.01,0) [-81.92|81.92] "" XXX
SG_ STATE_2 : 55|2@0+ (1,0) [0|3] "" XXX
BO_ 1294 RADAR_TRACK_50e: 8 RADAR
SG_ UNKNOWN_1 : 7|8@0- (1,0) [-128|127] "" XXX
SG_ AZIMUTH : 12|10@0- (0.2,0) [-102.4|102.2] "" XXX
@@ -215,7 +215,7 @@ BO_ 1294 RADAR_TRACK_50e: 8 RADAR
SG_ STATE_3 : 39|1@0+ (1,0) [0|1] "" XXX
SG_ REL_SPEED : 53|14@0- (0.01,0) [-81.92|81.92] "" XXX
SG_ STATE_2 : 55|2@0+ (1,0) [0|3] "" XXX
BO_ 1295 RADAR_TRACK_50f: 8 RADAR
SG_ UNKNOWN_1 : 7|8@0- (1,0) [-128|127] "" XXX
SG_ AZIMUTH : 12|10@0- (0.2,0) [-102.4|102.2] "" XXX
@@ -227,7 +227,7 @@ BO_ 1295 RADAR_TRACK_50f: 8 RADAR
SG_ STATE_3 : 39|1@0+ (1,0) [0|1] "" XXX
SG_ REL_SPEED : 53|14@0- (0.01,0) [-81.92|81.92] "" XXX
SG_ STATE_2 : 55|2@0+ (1,0) [0|3] "" XXX
BO_ 1296 RADAR_TRACK_510: 8 RADAR
SG_ UNKNOWN_1 : 7|8@0- (1,0) [-128|127] "" XXX
SG_ AZIMUTH : 12|10@0- (0.2,0) [-102.4|102.2] "" XXX
@@ -239,7 +239,7 @@ BO_ 1296 RADAR_TRACK_510: 8 RADAR
SG_ STATE_3 : 39|1@0+ (1,0) [0|1] "" XXX
SG_ REL_SPEED : 53|14@0- (0.01,0) [-81.92|81.92] "" XXX
SG_ STATE_2 : 55|2@0+ (1,0) [0|3] "" XXX
BO_ 1297 RADAR_TRACK_511: 8 RADAR
SG_ UNKNOWN_1 : 7|8@0- (1,0) [-128|127] "" XXX
SG_ AZIMUTH : 12|10@0- (0.2,0) [-102.4|102.2] "" XXX
@@ -251,7 +251,7 @@ BO_ 1297 RADAR_TRACK_511: 8 RADAR
SG_ STATE_3 : 39|1@0+ (1,0) [0|1] "" XXX
SG_ REL_SPEED : 53|14@0- (0.01,0) [-81.92|81.92] "" XXX
SG_ STATE_2 : 55|2@0+ (1,0) [0|3] "" XXX
BO_ 1298 RADAR_TRACK_512: 8 RADAR
SG_ UNKNOWN_1 : 7|8@0- (1,0) [-128|127] "" XXX
SG_ AZIMUTH : 12|10@0- (0.2,0) [-102.4|102.2] "" XXX
@@ -263,7 +263,7 @@ BO_ 1298 RADAR_TRACK_512: 8 RADAR
SG_ STATE_3 : 39|1@0+ (1,0) [0|1] "" XXX
SG_ REL_SPEED : 53|14@0- (0.01,0) [-81.92|81.92] "" XXX
SG_ STATE_2 : 55|2@0+ (1,0) [0|3] "" XXX
BO_ 1299 RADAR_TRACK_513: 8 RADAR
SG_ UNKNOWN_1 : 7|8@0- (1,0) [-128|127] "" XXX
SG_ AZIMUTH : 12|10@0- (0.2,0) [-102.4|102.2] "" XXX
@@ -275,7 +275,7 @@ BO_ 1299 RADAR_TRACK_513: 8 RADAR
SG_ STATE_3 : 39|1@0+ (1,0) [0|1] "" XXX
SG_ REL_SPEED : 53|14@0- (0.01,0) [-81.92|81.92] "" XXX
SG_ STATE_2 : 55|2@0+ (1,0) [0|3] "" XXX
BO_ 1300 RADAR_TRACK_514: 8 RADAR
SG_ UNKNOWN_1 : 7|8@0- (1,0) [-128|127] "" XXX
SG_ AZIMUTH : 12|10@0- (0.2,0) [-102.4|102.2] "" XXX
@@ -287,7 +287,7 @@ BO_ 1300 RADAR_TRACK_514: 8 RADAR
SG_ STATE_3 : 39|1@0+ (1,0) [0|1] "" XXX
SG_ REL_SPEED : 53|14@0- (0.01,0) [-81.92|81.92] "" XXX
SG_ STATE_2 : 55|2@0+ (1,0) [0|3] "" XXX
BO_ 1301 RADAR_TRACK_515: 8 RADAR
SG_ UNKNOWN_1 : 7|8@0- (1,0) [-128|127] "" XXX
SG_ AZIMUTH : 12|10@0- (0.2,0) [-102.4|102.2] "" XXX
@@ -299,7 +299,7 @@ BO_ 1301 RADAR_TRACK_515: 8 RADAR
SG_ STATE_3 : 39|1@0+ (1,0) [0|1] "" XXX
SG_ REL_SPEED : 53|14@0- (0.01,0) [-81.92|81.92] "" XXX
SG_ STATE_2 : 55|2@0+ (1,0) [0|3] "" XXX
BO_ 1302 RADAR_TRACK_516: 8 RADAR
SG_ UNKNOWN_1 : 7|8@0- (1,0) [-128|127] "" XXX
SG_ AZIMUTH : 12|10@0- (0.2,0) [-102.4|102.2] "" XXX
@@ -311,7 +311,7 @@ BO_ 1302 RADAR_TRACK_516: 8 RADAR
SG_ STATE_3 : 39|1@0+ (1,0) [0|1] "" XXX
SG_ REL_SPEED : 53|14@0- (0.01,0) [-81.92|81.92] "" XXX
SG_ STATE_2 : 55|2@0+ (1,0) [0|3] "" XXX
BO_ 1303 RADAR_TRACK_517: 8 RADAR
SG_ UNKNOWN_1 : 7|8@0- (1,0) [-128|127] "" XXX
SG_ AZIMUTH : 12|10@0- (0.2,0) [-102.4|102.2] "" XXX
@@ -323,7 +323,7 @@ BO_ 1303 RADAR_TRACK_517: 8 RADAR
SG_ STATE_3 : 39|1@0+ (1,0) [0|1] "" XXX
SG_ REL_SPEED : 53|14@0- (0.01,0) [-81.92|81.92] "" XXX
SG_ STATE_2 : 55|2@0+ (1,0) [0|3] "" XXX
BO_ 1304 RADAR_TRACK_518: 8 RADAR
SG_ UNKNOWN_1 : 7|8@0- (1,0) [-128|127] "" XXX
SG_ AZIMUTH : 12|10@0- (0.2,0) [-102.4|102.2] "" XXX
@@ -335,7 +335,7 @@ BO_ 1304 RADAR_TRACK_518: 8 RADAR
SG_ STATE_3 : 39|1@0+ (1,0) [0|1] "" XXX
SG_ REL_SPEED : 53|14@0- (0.01,0) [-81.92|81.92] "" XXX
SG_ STATE_2 : 55|2@0+ (1,0) [0|3] "" XXX
BO_ 1305 RADAR_TRACK_519: 8 RADAR
SG_ UNKNOWN_1 : 7|8@0- (1,0) [-128|127] "" XXX
SG_ AZIMUTH : 12|10@0- (0.2,0) [-102.4|102.2] "" XXX
@@ -347,7 +347,7 @@ BO_ 1305 RADAR_TRACK_519: 8 RADAR
SG_ STATE_3 : 39|1@0+ (1,0) [0|1] "" XXX
SG_ REL_SPEED : 53|14@0- (0.01,0) [-81.92|81.92] "" XXX
SG_ STATE_2 : 55|2@0+ (1,0) [0|3] "" XXX
BO_ 1306 RADAR_TRACK_51a: 8 RADAR
SG_ UNKNOWN_1 : 7|8@0- (1,0) [-128|127] "" XXX
SG_ AZIMUTH : 12|10@0- (0.2,0) [-102.4|102.2] "" XXX
@@ -359,7 +359,7 @@ BO_ 1306 RADAR_TRACK_51a: 8 RADAR
SG_ STATE_3 : 39|1@0+ (1,0) [0|1] "" XXX
SG_ REL_SPEED : 53|14@0- (0.01,0) [-81.92|81.92] "" XXX
SG_ STATE_2 : 55|2@0+ (1,0) [0|3] "" XXX
BO_ 1307 RADAR_TRACK_51b: 8 RADAR
SG_ UNKNOWN_1 : 7|8@0- (1,0) [-128|127] "" XXX
SG_ AZIMUTH : 12|10@0- (0.2,0) [-102.4|102.2] "" XXX
@@ -371,7 +371,7 @@ BO_ 1307 RADAR_TRACK_51b: 8 RADAR
SG_ STATE_3 : 39|1@0+ (1,0) [0|1] "" XXX
SG_ REL_SPEED : 53|14@0- (0.01,0) [-81.92|81.92] "" XXX
SG_ STATE_2 : 55|2@0+ (1,0) [0|3] "" XXX
BO_ 1308 RADAR_TRACK_51c: 8 RADAR
SG_ UNKNOWN_1 : 7|8@0- (1,0) [-128|127] "" XXX
SG_ AZIMUTH : 12|10@0- (0.2,0) [-102.4|102.2] "" XXX
@@ -383,7 +383,7 @@ BO_ 1308 RADAR_TRACK_51c: 8 RADAR
SG_ STATE_3 : 39|1@0+ (1,0) [0|1] "" XXX
SG_ REL_SPEED : 53|14@0- (0.01,0) [-81.92|81.92] "" XXX
SG_ STATE_2 : 55|2@0+ (1,0) [0|3] "" XXX
BO_ 1309 RADAR_TRACK_51d: 8 RADAR
SG_ UNKNOWN_1 : 7|8@0- (1,0) [-128|127] "" XXX
SG_ AZIMUTH : 12|10@0- (0.2,0) [-102.4|102.2] "" XXX
@@ -395,7 +395,7 @@ BO_ 1309 RADAR_TRACK_51d: 8 RADAR
SG_ STATE_3 : 39|1@0+ (1,0) [0|1] "" XXX
SG_ REL_SPEED : 53|14@0- (0.01,0) [-81.92|81.92] "" XXX
SG_ STATE_2 : 55|2@0+ (1,0) [0|3] "" XXX
BO_ 1310 RADAR_TRACK_51e: 8 RADAR
SG_ UNKNOWN_1 : 7|8@0- (1,0) [-128|127] "" XXX
SG_ AZIMUTH : 12|10@0- (0.2,0) [-102.4|102.2] "" XXX
@@ -407,7 +407,7 @@ BO_ 1310 RADAR_TRACK_51e: 8 RADAR
SG_ STATE_3 : 39|1@0+ (1,0) [0|1] "" XXX
SG_ REL_SPEED : 53|14@0- (0.01,0) [-81.92|81.92] "" XXX
SG_ STATE_2 : 55|2@0+ (1,0) [0|3] "" XXX
BO_ 1311 RADAR_TRACK_51f: 8 RADAR
SG_ UNKNOWN_1 : 7|8@0- (1,0) [-128|127] "" XXX
SG_ AZIMUTH : 12|10@0- (0.2,0) [-102.4|102.2] "" XXX
@@ -419,3 +419,4 @@ BO_ 1311 RADAR_TRACK_51f: 8 RADAR
SG_ STATE_3 : 39|1@0+ (1,0) [0|1] "" XXX
SG_ REL_SPEED : 53|14@0- (0.01,0) [-81.92|81.92] "" XXX
SG_ STATE_2 : 55|2@0+ (1,0) [0|3] "" XXX
@@ -35,7 +35,7 @@ NS_ :
BS_:
BU_: XXX
BO_ 1280 RADAR_TRACK_500: 8 RADAR
SG_ CHECKSUM : 0|8@1+ (1,0) [0|255] "" XXX
SG_ COUNTER : 11|4@0+ (1,0) [0|15] "" XXX
@@ -45,7 +45,7 @@ BO_ 1280 RADAR_TRACK_500: 8 RADAR
SG_ LONG_DIST : 34|11@0+ (0.1,0) [0|204.7] "" XXX
SG_ STATE_2 : 55|1@0+ (1,0) [0|1] "" XXX
SG_ REL_SPEED : 53|14@0- (0.01,0) [-81.92|81.92] "" XXX
BO_ 1281 RADAR_TRACK_501: 8 RADAR
SG_ CHECKSUM : 0|8@1+ (1,0) [0|255] "" XXX
SG_ COUNTER : 11|4@0+ (1,0) [0|15] "" XXX
@@ -55,7 +55,7 @@ BO_ 1281 RADAR_TRACK_501: 8 RADAR
SG_ LONG_DIST : 34|11@0+ (0.1,0) [0|204.7] "" XXX
SG_ STATE_2 : 55|1@0+ (1,0) [0|1] "" XXX
SG_ REL_SPEED : 53|14@0- (0.01,0) [-81.92|81.92] "" XXX
BO_ 1282 RADAR_TRACK_502: 8 RADAR
SG_ CHECKSUM : 0|8@1+ (1,0) [0|255] "" XXX
SG_ COUNTER : 11|4@0+ (1,0) [0|15] "" XXX
@@ -65,7 +65,7 @@ BO_ 1282 RADAR_TRACK_502: 8 RADAR
SG_ LONG_DIST : 34|11@0+ (0.1,0) [0|204.7] "" XXX
SG_ STATE_2 : 55|1@0+ (1,0) [0|1] "" XXX
SG_ REL_SPEED : 53|14@0- (0.01,0) [-81.92|81.92] "" XXX
BO_ 1283 RADAR_TRACK_503: 8 RADAR
SG_ CHECKSUM : 0|8@1+ (1,0) [0|255] "" XXX
SG_ COUNTER : 11|4@0+ (1,0) [0|15] "" XXX
@@ -75,7 +75,7 @@ BO_ 1283 RADAR_TRACK_503: 8 RADAR
SG_ LONG_DIST : 34|11@0+ (0.1,0) [0|204.7] "" XXX
SG_ STATE_2 : 55|1@0+ (1,0) [0|1] "" XXX
SG_ REL_SPEED : 53|14@0- (0.01,0) [-81.92|81.92] "" XXX
BO_ 1284 RADAR_TRACK_504: 8 RADAR
SG_ CHECKSUM : 0|8@1+ (1,0) [0|255] "" XXX
SG_ COUNTER : 11|4@0+ (1,0) [0|15] "" XXX
@@ -85,7 +85,7 @@ BO_ 1284 RADAR_TRACK_504: 8 RADAR
SG_ LONG_DIST : 34|11@0+ (0.1,0) [0|204.7] "" XXX
SG_ STATE_2 : 55|1@0+ (1,0) [0|1] "" XXX
SG_ REL_SPEED : 53|14@0- (0.01,0) [-81.92|81.92] "" XXX
BO_ 1285 RADAR_TRACK_505: 8 RADAR
SG_ CHECKSUM : 0|8@1+ (1,0) [0|255] "" XXX
SG_ COUNTER : 11|4@0+ (1,0) [0|15] "" XXX
@@ -95,7 +95,7 @@ BO_ 1285 RADAR_TRACK_505: 8 RADAR
SG_ LONG_DIST : 34|11@0+ (0.1,0) [0|204.7] "" XXX
SG_ STATE_2 : 55|1@0+ (1,0) [0|1] "" XXX
SG_ REL_SPEED : 53|14@0- (0.01,0) [-81.92|81.92] "" XXX
BO_ 1286 RADAR_TRACK_506: 8 RADAR
SG_ CHECKSUM : 0|8@1+ (1,0) [0|255] "" XXX
SG_ COUNTER : 11|4@0+ (1,0) [0|15] "" XXX
@@ -105,7 +105,7 @@ BO_ 1286 RADAR_TRACK_506: 8 RADAR
SG_ LONG_DIST : 34|11@0+ (0.1,0) [0|204.7] "" XXX
SG_ STATE_2 : 55|1@0+ (1,0) [0|1] "" XXX
SG_ REL_SPEED : 53|14@0- (0.01,0) [-81.92|81.92] "" XXX
BO_ 1287 RADAR_TRACK_507: 8 RADAR
SG_ CHECKSUM : 0|8@1+ (1,0) [0|255] "" XXX
SG_ COUNTER : 11|4@0+ (1,0) [0|15] "" XXX
@@ -115,7 +115,7 @@ BO_ 1287 RADAR_TRACK_507: 8 RADAR
SG_ LONG_DIST : 34|11@0+ (0.1,0) [0|204.7] "" XXX
SG_ STATE_2 : 55|1@0+ (1,0) [0|1] "" XXX
SG_ REL_SPEED : 53|14@0- (0.01,0) [-81.92|81.92] "" XXX
BO_ 1288 RADAR_TRACK_508: 8 RADAR
SG_ CHECKSUM : 0|8@1+ (1,0) [0|255] "" XXX
SG_ COUNTER : 11|4@0+ (1,0) [0|15] "" XXX
@@ -125,7 +125,7 @@ BO_ 1288 RADAR_TRACK_508: 8 RADAR
SG_ LONG_DIST : 34|11@0+ (0.1,0) [0|204.7] "" XXX
SG_ STATE_2 : 55|1@0+ (1,0) [0|1] "" XXX
SG_ REL_SPEED : 53|14@0- (0.01,0) [-81.92|81.92] "" XXX
BO_ 1289 RADAR_TRACK_509: 8 RADAR
SG_ CHECKSUM : 0|8@1+ (1,0) [0|255] "" XXX
SG_ COUNTER : 11|4@0+ (1,0) [0|15] "" XXX
@@ -135,7 +135,7 @@ BO_ 1289 RADAR_TRACK_509: 8 RADAR
SG_ LONG_DIST : 34|11@0+ (0.1,0) [0|204.7] "" XXX
SG_ STATE_2 : 55|1@0+ (1,0) [0|1] "" XXX
SG_ REL_SPEED : 53|14@0- (0.01,0) [-81.92|81.92] "" XXX
BO_ 1290 RADAR_TRACK_50a: 8 RADAR
SG_ CHECKSUM : 0|8@1+ (1,0) [0|255] "" XXX
SG_ COUNTER : 11|4@0+ (1,0) [0|15] "" XXX
@@ -145,7 +145,7 @@ BO_ 1290 RADAR_TRACK_50a: 8 RADAR
SG_ LONG_DIST : 34|11@0+ (0.1,0) [0|204.7] "" XXX
SG_ STATE_2 : 55|1@0+ (1,0) [0|1] "" XXX
SG_ REL_SPEED : 53|14@0- (0.01,0) [-81.92|81.92] "" XXX
BO_ 1291 RADAR_TRACK_50b: 8 RADAR
SG_ CHECKSUM : 0|8@1+ (1,0) [0|255] "" XXX
SG_ COUNTER : 11|4@0+ (1,0) [0|15] "" XXX
@@ -155,7 +155,7 @@ BO_ 1291 RADAR_TRACK_50b: 8 RADAR
SG_ LONG_DIST : 34|11@0+ (0.1,0) [0|204.7] "" XXX
SG_ STATE_2 : 55|1@0+ (1,0) [0|1] "" XXX
SG_ REL_SPEED : 53|14@0- (0.01,0) [-81.92|81.92] "" XXX
BO_ 1292 RADAR_TRACK_50c: 8 RADAR
SG_ CHECKSUM : 0|8@1+ (1,0) [0|255] "" XXX
SG_ COUNTER : 11|4@0+ (1,0) [0|15] "" XXX
@@ -165,7 +165,7 @@ BO_ 1292 RADAR_TRACK_50c: 8 RADAR
SG_ LONG_DIST : 34|11@0+ (0.1,0) [0|204.7] "" XXX
SG_ STATE_2 : 55|1@0+ (1,0) [0|1] "" XXX
SG_ REL_SPEED : 53|14@0- (0.01,0) [-81.92|81.92] "" XXX
BO_ 1293 RADAR_TRACK_50d: 8 RADAR
SG_ CHECKSUM : 0|8@1+ (1,0) [0|255] "" XXX
SG_ COUNTER : 11|4@0+ (1,0) [0|15] "" XXX
@@ -175,7 +175,7 @@ BO_ 1293 RADAR_TRACK_50d: 8 RADAR
SG_ LONG_DIST : 34|11@0+ (0.1,0) [0|204.7] "" XXX
SG_ STATE_2 : 55|1@0+ (1,0) [0|1] "" XXX
SG_ REL_SPEED : 53|14@0- (0.01,0) [-81.92|81.92] "" XXX
BO_ 1294 RADAR_TRACK_50e: 8 RADAR
SG_ CHECKSUM : 0|8@1+ (1,0) [0|255] "" XXX
SG_ COUNTER : 11|4@0+ (1,0) [0|15] "" XXX
@@ -185,7 +185,7 @@ BO_ 1294 RADAR_TRACK_50e: 8 RADAR
SG_ LONG_DIST : 34|11@0+ (0.1,0) [0|204.7] "" XXX
SG_ STATE_2 : 55|1@0+ (1,0) [0|1] "" XXX
SG_ REL_SPEED : 53|14@0- (0.01,0) [-81.92|81.92] "" XXX
BO_ 1295 RADAR_TRACK_50f: 8 RADAR
SG_ CHECKSUM : 0|8@1+ (1,0) [0|255] "" XXX
SG_ COUNTER : 11|4@0+ (1,0) [0|15] "" XXX
@@ -195,7 +195,7 @@ BO_ 1295 RADAR_TRACK_50f: 8 RADAR
SG_ LONG_DIST : 34|11@0+ (0.1,0) [0|204.7] "" XXX
SG_ STATE_2 : 55|1@0+ (1,0) [0|1] "" XXX
SG_ REL_SPEED : 53|14@0- (0.01,0) [-81.92|81.92] "" XXX
BO_ 1296 RADAR_TRACK_510: 8 RADAR
SG_ CHECKSUM : 0|8@1+ (1,0) [0|255] "" XXX
SG_ COUNTER : 11|4@0+ (1,0) [0|15] "" XXX
@@ -205,7 +205,7 @@ BO_ 1296 RADAR_TRACK_510: 8 RADAR
SG_ LONG_DIST : 34|11@0+ (0.1,0) [0|204.7] "" XXX
SG_ STATE_2 : 55|1@0+ (1,0) [0|1] "" XXX
SG_ REL_SPEED : 53|14@0- (0.01,0) [-81.92|81.92] "" XXX
BO_ 1297 RADAR_TRACK_511: 8 RADAR
SG_ CHECKSUM : 0|8@1+ (1,0) [0|255] "" XXX
SG_ COUNTER : 11|4@0+ (1,0) [0|15] "" XXX
@@ -215,7 +215,7 @@ BO_ 1297 RADAR_TRACK_511: 8 RADAR
SG_ LONG_DIST : 34|11@0+ (0.1,0) [0|204.7] "" XXX
SG_ STATE_2 : 55|1@0+ (1,0) [0|1] "" XXX
SG_ REL_SPEED : 53|14@0- (0.01,0) [-81.92|81.92] "" XXX
BO_ 1298 RADAR_TRACK_512: 8 RADAR
SG_ CHECKSUM : 0|8@1+ (1,0) [0|255] "" XXX
SG_ COUNTER : 11|4@0+ (1,0) [0|15] "" XXX
@@ -225,7 +225,7 @@ BO_ 1298 RADAR_TRACK_512: 8 RADAR
SG_ LONG_DIST : 34|11@0+ (0.1,0) [0|204.7] "" XXX
SG_ STATE_2 : 55|1@0+ (1,0) [0|1] "" XXX
SG_ REL_SPEED : 53|14@0- (0.01,0) [-81.92|81.92] "" XXX
BO_ 1299 RADAR_TRACK_513: 8 RADAR
SG_ CHECKSUM : 0|8@1+ (1,0) [0|255] "" XXX
SG_ COUNTER : 11|4@0+ (1,0) [0|15] "" XXX
@@ -235,7 +235,7 @@ BO_ 1299 RADAR_TRACK_513: 8 RADAR
SG_ LONG_DIST : 34|11@0+ (0.1,0) [0|204.7] "" XXX
SG_ STATE_2 : 55|1@0+ (1,0) [0|1] "" XXX
SG_ REL_SPEED : 53|14@0- (0.01,0) [-81.92|81.92] "" XXX
BO_ 1300 RADAR_TRACK_514: 8 RADAR
SG_ CHECKSUM : 0|8@1+ (1,0) [0|255] "" XXX
SG_ COUNTER : 11|4@0+ (1,0) [0|15] "" XXX
@@ -245,7 +245,7 @@ BO_ 1300 RADAR_TRACK_514: 8 RADAR
SG_ LONG_DIST : 34|11@0+ (0.1,0) [0|204.7] "" XXX
SG_ STATE_2 : 55|1@0+ (1,0) [0|1] "" XXX
SG_ REL_SPEED : 53|14@0- (0.01,0) [-81.92|81.92] "" XXX
BO_ 1301 RADAR_TRACK_515: 8 RADAR
SG_ CHECKSUM : 0|8@1+ (1,0) [0|255] "" XXX
SG_ COUNTER : 11|4@0+ (1,0) [0|15] "" XXX
@@ -255,7 +255,7 @@ BO_ 1301 RADAR_TRACK_515: 8 RADAR
SG_ LONG_DIST : 34|11@0+ (0.1,0) [0|204.7] "" XXX
SG_ STATE_2 : 55|1@0+ (1,0) [0|1] "" XXX
SG_ REL_SPEED : 53|14@0- (0.01,0) [-81.92|81.92] "" XXX
BO_ 1302 RADAR_TRACK_516: 8 RADAR
SG_ CHECKSUM : 0|8@1+ (1,0) [0|255] "" XXX
SG_ COUNTER : 11|4@0+ (1,0) [0|15] "" XXX
@@ -265,7 +265,7 @@ BO_ 1302 RADAR_TRACK_516: 8 RADAR
SG_ LONG_DIST : 34|11@0+ (0.1,0) [0|204.7] "" XXX
SG_ STATE_2 : 55|1@0+ (1,0) [0|1] "" XXX
SG_ REL_SPEED : 53|14@0- (0.01,0) [-81.92|81.92] "" XXX
BO_ 1303 RADAR_TRACK_517: 8 RADAR
SG_ CHECKSUM : 0|8@1+ (1,0) [0|255] "" XXX
SG_ COUNTER : 11|4@0+ (1,0) [0|15] "" XXX
@@ -275,7 +275,7 @@ BO_ 1303 RADAR_TRACK_517: 8 RADAR
SG_ LONG_DIST : 34|11@0+ (0.1,0) [0|204.7] "" XXX
SG_ STATE_2 : 55|1@0+ (1,0) [0|1] "" XXX
SG_ REL_SPEED : 53|14@0- (0.01,0) [-81.92|81.92] "" XXX
BO_ 1304 RADAR_TRACK_518: 8 RADAR
SG_ CHECKSUM : 0|8@1+ (1,0) [0|255] "" XXX
SG_ COUNTER : 11|4@0+ (1,0) [0|15] "" XXX
@@ -285,7 +285,7 @@ BO_ 1304 RADAR_TRACK_518: 8 RADAR
SG_ LONG_DIST : 34|11@0+ (0.1,0) [0|204.7] "" XXX
SG_ STATE_2 : 55|1@0+ (1,0) [0|1] "" XXX
SG_ REL_SPEED : 53|14@0- (0.01,0) [-81.92|81.92] "" XXX
BO_ 1305 RADAR_TRACK_519: 8 RADAR
SG_ CHECKSUM : 0|8@1+ (1,0) [0|255] "" XXX
SG_ COUNTER : 11|4@0+ (1,0) [0|15] "" XXX
@@ -295,7 +295,7 @@ BO_ 1305 RADAR_TRACK_519: 8 RADAR
SG_ LONG_DIST : 34|11@0+ (0.1,0) [0|204.7] "" XXX
SG_ STATE_2 : 55|1@0+ (1,0) [0|1] "" XXX
SG_ REL_SPEED : 53|14@0- (0.01,0) [-81.92|81.92] "" XXX
BO_ 1306 RADAR_TRACK_51a: 8 RADAR
SG_ CHECKSUM : 0|8@1+ (1,0) [0|255] "" XXX
SG_ COUNTER : 11|4@0+ (1,0) [0|15] "" XXX
@@ -305,7 +305,7 @@ BO_ 1306 RADAR_TRACK_51a: 8 RADAR
SG_ LONG_DIST : 34|11@0+ (0.1,0) [0|204.7] "" XXX
SG_ STATE_2 : 55|1@0+ (1,0) [0|1] "" XXX
SG_ REL_SPEED : 53|14@0- (0.01,0) [-81.92|81.92] "" XXX
BO_ 1307 RADAR_TRACK_51b: 8 RADAR
SG_ CHECKSUM : 0|8@1+ (1,0) [0|255] "" XXX
SG_ COUNTER : 11|4@0+ (1,0) [0|15] "" XXX
@@ -315,7 +315,7 @@ BO_ 1307 RADAR_TRACK_51b: 8 RADAR
SG_ LONG_DIST : 34|11@0+ (0.1,0) [0|204.7] "" XXX
SG_ STATE_2 : 55|1@0+ (1,0) [0|1] "" XXX
SG_ REL_SPEED : 53|14@0- (0.01,0) [-81.92|81.92] "" XXX
BO_ 1308 RADAR_TRACK_51c: 8 RADAR
SG_ CHECKSUM : 0|8@1+ (1,0) [0|255] "" XXX
SG_ COUNTER : 11|4@0+ (1,0) [0|15] "" XXX
@@ -325,7 +325,7 @@ BO_ 1308 RADAR_TRACK_51c: 8 RADAR
SG_ LONG_DIST : 34|11@0+ (0.1,0) [0|204.7] "" XXX
SG_ STATE_2 : 55|1@0+ (1,0) [0|1] "" XXX
SG_ REL_SPEED : 53|14@0- (0.01,0) [-81.92|81.92] "" XXX
BO_ 1309 RADAR_TRACK_51d: 8 RADAR
SG_ CHECKSUM : 0|8@1+ (1,0) [0|255] "" XXX
SG_ COUNTER : 11|4@0+ (1,0) [0|15] "" XXX
@@ -335,7 +335,7 @@ BO_ 1309 RADAR_TRACK_51d: 8 RADAR
SG_ LONG_DIST : 34|11@0+ (0.1,0) [0|204.7] "" XXX
SG_ STATE_2 : 55|1@0+ (1,0) [0|1] "" XXX
SG_ REL_SPEED : 53|14@0- (0.01,0) [-81.92|81.92] "" XXX
BO_ 1310 RADAR_TRACK_51e: 8 RADAR
SG_ CHECKSUM : 0|8@1+ (1,0) [0|255] "" XXX
SG_ COUNTER : 11|4@0+ (1,0) [0|15] "" XXX
@@ -345,7 +345,7 @@ BO_ 1310 RADAR_TRACK_51e: 8 RADAR
SG_ LONG_DIST : 34|11@0+ (0.1,0) [0|204.7] "" XXX
SG_ STATE_2 : 55|1@0+ (1,0) [0|1] "" XXX
SG_ REL_SPEED : 53|14@0- (0.01,0) [-81.92|81.92] "" XXX
BO_ 1311 RADAR_TRACK_51f: 8 RADAR
SG_ CHECKSUM : 0|8@1+ (1,0) [0|255] "" XXX
SG_ COUNTER : 11|4@0+ (1,0) [0|15] "" XXX
@@ -355,3 +355,4 @@ BO_ 1311 RADAR_TRACK_51f: 8 RADAR
SG_ LONG_DIST : 34|11@0+ (0.1,0) [0|204.7] "" XXX
SG_ STATE_2 : 55|1@0+ (1,0) [0|1] "" XXX
SG_ REL_SPEED : 53|14@0- (0.01,0) [-81.92|81.92] "" XXX
Binary file not shown.
Binary file not shown.
Binary file not shown.
Binary file not shown.
Binary file not shown.
Binary file not shown.
Binary file not shown.
Binary file not shown.
Binary file not shown.
Binary file not shown.
+1 -1
View File
@@ -1,2 +1,2 @@
extern const uint8_t gitversion[19];
const uint8_t gitversion[19] = "DEV-cdca40f0-DEBUG";
const uint8_t gitversion[19] = "DEV-6f569061-DEBUG";
Binary file not shown.
Binary file not shown.
Binary file not shown.
Binary file not shown.
Binary file not shown.
Binary file not shown.
Binary file not shown.
Binary file not shown.
Binary file not shown.
Binary file not shown.
Binary file not shown.
Binary file not shown.
Binary file not shown.
Binary file not shown.
Binary file not shown.
Binary file not shown.
Binary file not shown.
Binary file not shown.
Binary file not shown.
Binary file not shown.
+1 -1
View File
@@ -1 +1 @@
DEV-cdca40f0-DEBUG
DEV-6f569061-DEBUG
+342 -342
View File
@@ -45,326 +45,326 @@ const static double MAHA_THRESH_31 = 3.8414588206941227;
* *
* This file is part of 'ekf' *
******************************************************************************/
void err_fun(double *nom_x, double *delta_x, double *out_4413943037710355540) {
out_4413943037710355540[0] = delta_x[0] + nom_x[0];
out_4413943037710355540[1] = delta_x[1] + nom_x[1];
out_4413943037710355540[2] = delta_x[2] + nom_x[2];
out_4413943037710355540[3] = delta_x[3] + nom_x[3];
out_4413943037710355540[4] = delta_x[4] + nom_x[4];
out_4413943037710355540[5] = delta_x[5] + nom_x[5];
out_4413943037710355540[6] = delta_x[6] + nom_x[6];
out_4413943037710355540[7] = delta_x[7] + nom_x[7];
out_4413943037710355540[8] = delta_x[8] + nom_x[8];
void err_fun(double *nom_x, double *delta_x, double *out_6119760954545072171) {
out_6119760954545072171[0] = delta_x[0] + nom_x[0];
out_6119760954545072171[1] = delta_x[1] + nom_x[1];
out_6119760954545072171[2] = delta_x[2] + nom_x[2];
out_6119760954545072171[3] = delta_x[3] + nom_x[3];
out_6119760954545072171[4] = delta_x[4] + nom_x[4];
out_6119760954545072171[5] = delta_x[5] + nom_x[5];
out_6119760954545072171[6] = delta_x[6] + nom_x[6];
out_6119760954545072171[7] = delta_x[7] + nom_x[7];
out_6119760954545072171[8] = delta_x[8] + nom_x[8];
}
void inv_err_fun(double *nom_x, double *true_x, double *out_896653973664715101) {
out_896653973664715101[0] = -nom_x[0] + true_x[0];
out_896653973664715101[1] = -nom_x[1] + true_x[1];
out_896653973664715101[2] = -nom_x[2] + true_x[2];
out_896653973664715101[3] = -nom_x[3] + true_x[3];
out_896653973664715101[4] = -nom_x[4] + true_x[4];
out_896653973664715101[5] = -nom_x[5] + true_x[5];
out_896653973664715101[6] = -nom_x[6] + true_x[6];
out_896653973664715101[7] = -nom_x[7] + true_x[7];
out_896653973664715101[8] = -nom_x[8] + true_x[8];
void inv_err_fun(double *nom_x, double *true_x, double *out_3032957791392119605) {
out_3032957791392119605[0] = -nom_x[0] + true_x[0];
out_3032957791392119605[1] = -nom_x[1] + true_x[1];
out_3032957791392119605[2] = -nom_x[2] + true_x[2];
out_3032957791392119605[3] = -nom_x[3] + true_x[3];
out_3032957791392119605[4] = -nom_x[4] + true_x[4];
out_3032957791392119605[5] = -nom_x[5] + true_x[5];
out_3032957791392119605[6] = -nom_x[6] + true_x[6];
out_3032957791392119605[7] = -nom_x[7] + true_x[7];
out_3032957791392119605[8] = -nom_x[8] + true_x[8];
}
void H_mod_fun(double *state, double *out_5267188789104253679) {
out_5267188789104253679[0] = 1.0;
out_5267188789104253679[1] = 0.0;
out_5267188789104253679[2] = 0.0;
out_5267188789104253679[3] = 0.0;
out_5267188789104253679[4] = 0.0;
out_5267188789104253679[5] = 0.0;
out_5267188789104253679[6] = 0.0;
out_5267188789104253679[7] = 0.0;
out_5267188789104253679[8] = 0.0;
out_5267188789104253679[9] = 0.0;
out_5267188789104253679[10] = 1.0;
out_5267188789104253679[11] = 0.0;
out_5267188789104253679[12] = 0.0;
out_5267188789104253679[13] = 0.0;
out_5267188789104253679[14] = 0.0;
out_5267188789104253679[15] = 0.0;
out_5267188789104253679[16] = 0.0;
out_5267188789104253679[17] = 0.0;
out_5267188789104253679[18] = 0.0;
out_5267188789104253679[19] = 0.0;
out_5267188789104253679[20] = 1.0;
out_5267188789104253679[21] = 0.0;
out_5267188789104253679[22] = 0.0;
out_5267188789104253679[23] = 0.0;
out_5267188789104253679[24] = 0.0;
out_5267188789104253679[25] = 0.0;
out_5267188789104253679[26] = 0.0;
out_5267188789104253679[27] = 0.0;
out_5267188789104253679[28] = 0.0;
out_5267188789104253679[29] = 0.0;
out_5267188789104253679[30] = 1.0;
out_5267188789104253679[31] = 0.0;
out_5267188789104253679[32] = 0.0;
out_5267188789104253679[33] = 0.0;
out_5267188789104253679[34] = 0.0;
out_5267188789104253679[35] = 0.0;
out_5267188789104253679[36] = 0.0;
out_5267188789104253679[37] = 0.0;
out_5267188789104253679[38] = 0.0;
out_5267188789104253679[39] = 0.0;
out_5267188789104253679[40] = 1.0;
out_5267188789104253679[41] = 0.0;
out_5267188789104253679[42] = 0.0;
out_5267188789104253679[43] = 0.0;
out_5267188789104253679[44] = 0.0;
out_5267188789104253679[45] = 0.0;
out_5267188789104253679[46] = 0.0;
out_5267188789104253679[47] = 0.0;
out_5267188789104253679[48] = 0.0;
out_5267188789104253679[49] = 0.0;
out_5267188789104253679[50] = 1.0;
out_5267188789104253679[51] = 0.0;
out_5267188789104253679[52] = 0.0;
out_5267188789104253679[53] = 0.0;
out_5267188789104253679[54] = 0.0;
out_5267188789104253679[55] = 0.0;
out_5267188789104253679[56] = 0.0;
out_5267188789104253679[57] = 0.0;
out_5267188789104253679[58] = 0.0;
out_5267188789104253679[59] = 0.0;
out_5267188789104253679[60] = 1.0;
out_5267188789104253679[61] = 0.0;
out_5267188789104253679[62] = 0.0;
out_5267188789104253679[63] = 0.0;
out_5267188789104253679[64] = 0.0;
out_5267188789104253679[65] = 0.0;
out_5267188789104253679[66] = 0.0;
out_5267188789104253679[67] = 0.0;
out_5267188789104253679[68] = 0.0;
out_5267188789104253679[69] = 0.0;
out_5267188789104253679[70] = 1.0;
out_5267188789104253679[71] = 0.0;
out_5267188789104253679[72] = 0.0;
out_5267188789104253679[73] = 0.0;
out_5267188789104253679[74] = 0.0;
out_5267188789104253679[75] = 0.0;
out_5267188789104253679[76] = 0.0;
out_5267188789104253679[77] = 0.0;
out_5267188789104253679[78] = 0.0;
out_5267188789104253679[79] = 0.0;
out_5267188789104253679[80] = 1.0;
void H_mod_fun(double *state, double *out_6225772227410316778) {
out_6225772227410316778[0] = 1.0;
out_6225772227410316778[1] = 0.0;
out_6225772227410316778[2] = 0.0;
out_6225772227410316778[3] = 0.0;
out_6225772227410316778[4] = 0.0;
out_6225772227410316778[5] = 0.0;
out_6225772227410316778[6] = 0.0;
out_6225772227410316778[7] = 0.0;
out_6225772227410316778[8] = 0.0;
out_6225772227410316778[9] = 0.0;
out_6225772227410316778[10] = 1.0;
out_6225772227410316778[11] = 0.0;
out_6225772227410316778[12] = 0.0;
out_6225772227410316778[13] = 0.0;
out_6225772227410316778[14] = 0.0;
out_6225772227410316778[15] = 0.0;
out_6225772227410316778[16] = 0.0;
out_6225772227410316778[17] = 0.0;
out_6225772227410316778[18] = 0.0;
out_6225772227410316778[19] = 0.0;
out_6225772227410316778[20] = 1.0;
out_6225772227410316778[21] = 0.0;
out_6225772227410316778[22] = 0.0;
out_6225772227410316778[23] = 0.0;
out_6225772227410316778[24] = 0.0;
out_6225772227410316778[25] = 0.0;
out_6225772227410316778[26] = 0.0;
out_6225772227410316778[27] = 0.0;
out_6225772227410316778[28] = 0.0;
out_6225772227410316778[29] = 0.0;
out_6225772227410316778[30] = 1.0;
out_6225772227410316778[31] = 0.0;
out_6225772227410316778[32] = 0.0;
out_6225772227410316778[33] = 0.0;
out_6225772227410316778[34] = 0.0;
out_6225772227410316778[35] = 0.0;
out_6225772227410316778[36] = 0.0;
out_6225772227410316778[37] = 0.0;
out_6225772227410316778[38] = 0.0;
out_6225772227410316778[39] = 0.0;
out_6225772227410316778[40] = 1.0;
out_6225772227410316778[41] = 0.0;
out_6225772227410316778[42] = 0.0;
out_6225772227410316778[43] = 0.0;
out_6225772227410316778[44] = 0.0;
out_6225772227410316778[45] = 0.0;
out_6225772227410316778[46] = 0.0;
out_6225772227410316778[47] = 0.0;
out_6225772227410316778[48] = 0.0;
out_6225772227410316778[49] = 0.0;
out_6225772227410316778[50] = 1.0;
out_6225772227410316778[51] = 0.0;
out_6225772227410316778[52] = 0.0;
out_6225772227410316778[53] = 0.0;
out_6225772227410316778[54] = 0.0;
out_6225772227410316778[55] = 0.0;
out_6225772227410316778[56] = 0.0;
out_6225772227410316778[57] = 0.0;
out_6225772227410316778[58] = 0.0;
out_6225772227410316778[59] = 0.0;
out_6225772227410316778[60] = 1.0;
out_6225772227410316778[61] = 0.0;
out_6225772227410316778[62] = 0.0;
out_6225772227410316778[63] = 0.0;
out_6225772227410316778[64] = 0.0;
out_6225772227410316778[65] = 0.0;
out_6225772227410316778[66] = 0.0;
out_6225772227410316778[67] = 0.0;
out_6225772227410316778[68] = 0.0;
out_6225772227410316778[69] = 0.0;
out_6225772227410316778[70] = 1.0;
out_6225772227410316778[71] = 0.0;
out_6225772227410316778[72] = 0.0;
out_6225772227410316778[73] = 0.0;
out_6225772227410316778[74] = 0.0;
out_6225772227410316778[75] = 0.0;
out_6225772227410316778[76] = 0.0;
out_6225772227410316778[77] = 0.0;
out_6225772227410316778[78] = 0.0;
out_6225772227410316778[79] = 0.0;
out_6225772227410316778[80] = 1.0;
}
void f_fun(double *state, double dt, double *out_1590758894307502735) {
out_1590758894307502735[0] = state[0];
out_1590758894307502735[1] = state[1];
out_1590758894307502735[2] = state[2];
out_1590758894307502735[3] = state[3];
out_1590758894307502735[4] = state[4];
out_1590758894307502735[5] = dt*((-state[4] + (-center_to_front*stiffness_front*state[0] + center_to_rear*stiffness_rear*state[0])/(mass*state[4]))*state[6] - 9.8100000000000005*state[8] + stiffness_front*(-state[2] - state[3] + state[7])*state[0]/(mass*state[1]) + (-stiffness_front*state[0] - stiffness_rear*state[0])*state[5]/(mass*state[4])) + state[5];
out_1590758894307502735[6] = dt*(center_to_front*stiffness_front*(-state[2] - state[3] + state[7])*state[0]/(rotational_inertia*state[1]) + (-center_to_front*stiffness_front*state[0] + center_to_rear*stiffness_rear*state[0])*state[5]/(rotational_inertia*state[4]) + (-pow(center_to_front, 2)*stiffness_front*state[0] - pow(center_to_rear, 2)*stiffness_rear*state[0])*state[6]/(rotational_inertia*state[4])) + state[6];
out_1590758894307502735[7] = state[7];
out_1590758894307502735[8] = state[8];
void f_fun(double *state, double dt, double *out_1791723405675881227) {
out_1791723405675881227[0] = state[0];
out_1791723405675881227[1] = state[1];
out_1791723405675881227[2] = state[2];
out_1791723405675881227[3] = state[3];
out_1791723405675881227[4] = state[4];
out_1791723405675881227[5] = dt*((-state[4] + (-center_to_front*stiffness_front*state[0] + center_to_rear*stiffness_rear*state[0])/(mass*state[4]))*state[6] - 9.8100000000000005*state[8] + stiffness_front*(-state[2] - state[3] + state[7])*state[0]/(mass*state[1]) + (-stiffness_front*state[0] - stiffness_rear*state[0])*state[5]/(mass*state[4])) + state[5];
out_1791723405675881227[6] = dt*(center_to_front*stiffness_front*(-state[2] - state[3] + state[7])*state[0]/(rotational_inertia*state[1]) + (-center_to_front*stiffness_front*state[0] + center_to_rear*stiffness_rear*state[0])*state[5]/(rotational_inertia*state[4]) + (-pow(center_to_front, 2)*stiffness_front*state[0] - pow(center_to_rear, 2)*stiffness_rear*state[0])*state[6]/(rotational_inertia*state[4])) + state[6];
out_1791723405675881227[7] = state[7];
out_1791723405675881227[8] = state[8];
}
void F_fun(double *state, double dt, double *out_4932077017586128960) {
out_4932077017586128960[0] = 1;
out_4932077017586128960[1] = 0;
out_4932077017586128960[2] = 0;
out_4932077017586128960[3] = 0;
out_4932077017586128960[4] = 0;
out_4932077017586128960[5] = 0;
out_4932077017586128960[6] = 0;
out_4932077017586128960[7] = 0;
out_4932077017586128960[8] = 0;
out_4932077017586128960[9] = 0;
out_4932077017586128960[10] = 1;
out_4932077017586128960[11] = 0;
out_4932077017586128960[12] = 0;
out_4932077017586128960[13] = 0;
out_4932077017586128960[14] = 0;
out_4932077017586128960[15] = 0;
out_4932077017586128960[16] = 0;
out_4932077017586128960[17] = 0;
out_4932077017586128960[18] = 0;
out_4932077017586128960[19] = 0;
out_4932077017586128960[20] = 1;
out_4932077017586128960[21] = 0;
out_4932077017586128960[22] = 0;
out_4932077017586128960[23] = 0;
out_4932077017586128960[24] = 0;
out_4932077017586128960[25] = 0;
out_4932077017586128960[26] = 0;
out_4932077017586128960[27] = 0;
out_4932077017586128960[28] = 0;
out_4932077017586128960[29] = 0;
out_4932077017586128960[30] = 1;
out_4932077017586128960[31] = 0;
out_4932077017586128960[32] = 0;
out_4932077017586128960[33] = 0;
out_4932077017586128960[34] = 0;
out_4932077017586128960[35] = 0;
out_4932077017586128960[36] = 0;
out_4932077017586128960[37] = 0;
out_4932077017586128960[38] = 0;
out_4932077017586128960[39] = 0;
out_4932077017586128960[40] = 1;
out_4932077017586128960[41] = 0;
out_4932077017586128960[42] = 0;
out_4932077017586128960[43] = 0;
out_4932077017586128960[44] = 0;
out_4932077017586128960[45] = dt*(stiffness_front*(-state[2] - state[3] + state[7])/(mass*state[1]) + (-stiffness_front - stiffness_rear)*state[5]/(mass*state[4]) + (-center_to_front*stiffness_front + center_to_rear*stiffness_rear)*state[6]/(mass*state[4]));
out_4932077017586128960[46] = -dt*stiffness_front*(-state[2] - state[3] + state[7])*state[0]/(mass*pow(state[1], 2));
out_4932077017586128960[47] = -dt*stiffness_front*state[0]/(mass*state[1]);
out_4932077017586128960[48] = -dt*stiffness_front*state[0]/(mass*state[1]);
out_4932077017586128960[49] = dt*((-1 - (-center_to_front*stiffness_front*state[0] + center_to_rear*stiffness_rear*state[0])/(mass*pow(state[4], 2)))*state[6] - (-stiffness_front*state[0] - stiffness_rear*state[0])*state[5]/(mass*pow(state[4], 2)));
out_4932077017586128960[50] = dt*(-stiffness_front*state[0] - stiffness_rear*state[0])/(mass*state[4]) + 1;
out_4932077017586128960[51] = dt*(-state[4] + (-center_to_front*stiffness_front*state[0] + center_to_rear*stiffness_rear*state[0])/(mass*state[4]));
out_4932077017586128960[52] = dt*stiffness_front*state[0]/(mass*state[1]);
out_4932077017586128960[53] = -9.8100000000000005*dt;
out_4932077017586128960[54] = dt*(center_to_front*stiffness_front*(-state[2] - state[3] + state[7])/(rotational_inertia*state[1]) + (-center_to_front*stiffness_front + center_to_rear*stiffness_rear)*state[5]/(rotational_inertia*state[4]) + (-pow(center_to_front, 2)*stiffness_front - pow(center_to_rear, 2)*stiffness_rear)*state[6]/(rotational_inertia*state[4]));
out_4932077017586128960[55] = -center_to_front*dt*stiffness_front*(-state[2] - state[3] + state[7])*state[0]/(rotational_inertia*pow(state[1], 2));
out_4932077017586128960[56] = -center_to_front*dt*stiffness_front*state[0]/(rotational_inertia*state[1]);
out_4932077017586128960[57] = -center_to_front*dt*stiffness_front*state[0]/(rotational_inertia*state[1]);
out_4932077017586128960[58] = dt*(-(-center_to_front*stiffness_front*state[0] + center_to_rear*stiffness_rear*state[0])*state[5]/(rotational_inertia*pow(state[4], 2)) - (-pow(center_to_front, 2)*stiffness_front*state[0] - pow(center_to_rear, 2)*stiffness_rear*state[0])*state[6]/(rotational_inertia*pow(state[4], 2)));
out_4932077017586128960[59] = dt*(-center_to_front*stiffness_front*state[0] + center_to_rear*stiffness_rear*state[0])/(rotational_inertia*state[4]);
out_4932077017586128960[60] = dt*(-pow(center_to_front, 2)*stiffness_front*state[0] - pow(center_to_rear, 2)*stiffness_rear*state[0])/(rotational_inertia*state[4]) + 1;
out_4932077017586128960[61] = center_to_front*dt*stiffness_front*state[0]/(rotational_inertia*state[1]);
out_4932077017586128960[62] = 0;
out_4932077017586128960[63] = 0;
out_4932077017586128960[64] = 0;
out_4932077017586128960[65] = 0;
out_4932077017586128960[66] = 0;
out_4932077017586128960[67] = 0;
out_4932077017586128960[68] = 0;
out_4932077017586128960[69] = 0;
out_4932077017586128960[70] = 1;
out_4932077017586128960[71] = 0;
out_4932077017586128960[72] = 0;
out_4932077017586128960[73] = 0;
out_4932077017586128960[74] = 0;
out_4932077017586128960[75] = 0;
out_4932077017586128960[76] = 0;
out_4932077017586128960[77] = 0;
out_4932077017586128960[78] = 0;
out_4932077017586128960[79] = 0;
out_4932077017586128960[80] = 1;
void F_fun(double *state, double dt, double *out_4540850954218753986) {
out_4540850954218753986[0] = 1;
out_4540850954218753986[1] = 0;
out_4540850954218753986[2] = 0;
out_4540850954218753986[3] = 0;
out_4540850954218753986[4] = 0;
out_4540850954218753986[5] = 0;
out_4540850954218753986[6] = 0;
out_4540850954218753986[7] = 0;
out_4540850954218753986[8] = 0;
out_4540850954218753986[9] = 0;
out_4540850954218753986[10] = 1;
out_4540850954218753986[11] = 0;
out_4540850954218753986[12] = 0;
out_4540850954218753986[13] = 0;
out_4540850954218753986[14] = 0;
out_4540850954218753986[15] = 0;
out_4540850954218753986[16] = 0;
out_4540850954218753986[17] = 0;
out_4540850954218753986[18] = 0;
out_4540850954218753986[19] = 0;
out_4540850954218753986[20] = 1;
out_4540850954218753986[21] = 0;
out_4540850954218753986[22] = 0;
out_4540850954218753986[23] = 0;
out_4540850954218753986[24] = 0;
out_4540850954218753986[25] = 0;
out_4540850954218753986[26] = 0;
out_4540850954218753986[27] = 0;
out_4540850954218753986[28] = 0;
out_4540850954218753986[29] = 0;
out_4540850954218753986[30] = 1;
out_4540850954218753986[31] = 0;
out_4540850954218753986[32] = 0;
out_4540850954218753986[33] = 0;
out_4540850954218753986[34] = 0;
out_4540850954218753986[35] = 0;
out_4540850954218753986[36] = 0;
out_4540850954218753986[37] = 0;
out_4540850954218753986[38] = 0;
out_4540850954218753986[39] = 0;
out_4540850954218753986[40] = 1;
out_4540850954218753986[41] = 0;
out_4540850954218753986[42] = 0;
out_4540850954218753986[43] = 0;
out_4540850954218753986[44] = 0;
out_4540850954218753986[45] = dt*(stiffness_front*(-state[2] - state[3] + state[7])/(mass*state[1]) + (-stiffness_front - stiffness_rear)*state[5]/(mass*state[4]) + (-center_to_front*stiffness_front + center_to_rear*stiffness_rear)*state[6]/(mass*state[4]));
out_4540850954218753986[46] = -dt*stiffness_front*(-state[2] - state[3] + state[7])*state[0]/(mass*pow(state[1], 2));
out_4540850954218753986[47] = -dt*stiffness_front*state[0]/(mass*state[1]);
out_4540850954218753986[48] = -dt*stiffness_front*state[0]/(mass*state[1]);
out_4540850954218753986[49] = dt*((-1 - (-center_to_front*stiffness_front*state[0] + center_to_rear*stiffness_rear*state[0])/(mass*pow(state[4], 2)))*state[6] - (-stiffness_front*state[0] - stiffness_rear*state[0])*state[5]/(mass*pow(state[4], 2)));
out_4540850954218753986[50] = dt*(-stiffness_front*state[0] - stiffness_rear*state[0])/(mass*state[4]) + 1;
out_4540850954218753986[51] = dt*(-state[4] + (-center_to_front*stiffness_front*state[0] + center_to_rear*stiffness_rear*state[0])/(mass*state[4]));
out_4540850954218753986[52] = dt*stiffness_front*state[0]/(mass*state[1]);
out_4540850954218753986[53] = -9.8100000000000005*dt;
out_4540850954218753986[54] = dt*(center_to_front*stiffness_front*(-state[2] - state[3] + state[7])/(rotational_inertia*state[1]) + (-center_to_front*stiffness_front + center_to_rear*stiffness_rear)*state[5]/(rotational_inertia*state[4]) + (-pow(center_to_front, 2)*stiffness_front - pow(center_to_rear, 2)*stiffness_rear)*state[6]/(rotational_inertia*state[4]));
out_4540850954218753986[55] = -center_to_front*dt*stiffness_front*(-state[2] - state[3] + state[7])*state[0]/(rotational_inertia*pow(state[1], 2));
out_4540850954218753986[56] = -center_to_front*dt*stiffness_front*state[0]/(rotational_inertia*state[1]);
out_4540850954218753986[57] = -center_to_front*dt*stiffness_front*state[0]/(rotational_inertia*state[1]);
out_4540850954218753986[58] = dt*(-(-center_to_front*stiffness_front*state[0] + center_to_rear*stiffness_rear*state[0])*state[5]/(rotational_inertia*pow(state[4], 2)) - (-pow(center_to_front, 2)*stiffness_front*state[0] - pow(center_to_rear, 2)*stiffness_rear*state[0])*state[6]/(rotational_inertia*pow(state[4], 2)));
out_4540850954218753986[59] = dt*(-center_to_front*stiffness_front*state[0] + center_to_rear*stiffness_rear*state[0])/(rotational_inertia*state[4]);
out_4540850954218753986[60] = dt*(-pow(center_to_front, 2)*stiffness_front*state[0] - pow(center_to_rear, 2)*stiffness_rear*state[0])/(rotational_inertia*state[4]) + 1;
out_4540850954218753986[61] = center_to_front*dt*stiffness_front*state[0]/(rotational_inertia*state[1]);
out_4540850954218753986[62] = 0;
out_4540850954218753986[63] = 0;
out_4540850954218753986[64] = 0;
out_4540850954218753986[65] = 0;
out_4540850954218753986[66] = 0;
out_4540850954218753986[67] = 0;
out_4540850954218753986[68] = 0;
out_4540850954218753986[69] = 0;
out_4540850954218753986[70] = 1;
out_4540850954218753986[71] = 0;
out_4540850954218753986[72] = 0;
out_4540850954218753986[73] = 0;
out_4540850954218753986[74] = 0;
out_4540850954218753986[75] = 0;
out_4540850954218753986[76] = 0;
out_4540850954218753986[77] = 0;
out_4540850954218753986[78] = 0;
out_4540850954218753986[79] = 0;
out_4540850954218753986[80] = 1;
}
void h_25(double *state, double *unused, double *out_2151142981028497358) {
out_2151142981028497358[0] = state[6];
void h_25(double *state, double *unused, double *out_6713287060643499630) {
out_6713287060643499630[0] = state[6];
}
void H_25(double *state, double *unused, double *out_5796040611085329032) {
out_5796040611085329032[0] = 0;
out_5796040611085329032[1] = 0;
out_5796040611085329032[2] = 0;
out_5796040611085329032[3] = 0;
out_5796040611085329032[4] = 0;
out_5796040611085329032[5] = 0;
out_5796040611085329032[6] = 1;
out_5796040611085329032[7] = 0;
out_5796040611085329032[8] = 0;
void H_25(double *state, double *unused, double *out_2967415998501920459) {
out_2967415998501920459[0] = 0;
out_2967415998501920459[1] = 0;
out_2967415998501920459[2] = 0;
out_2967415998501920459[3] = 0;
out_2967415998501920459[4] = 0;
out_2967415998501920459[5] = 0;
out_2967415998501920459[6] = 1;
out_2967415998501920459[7] = 0;
out_2967415998501920459[8] = 0;
}
void h_24(double *state, double *unused, double *out_7809478958388963293) {
out_7809478958388963293[0] = state[4];
out_7809478958388963293[1] = state[5];
void h_24(double *state, double *unused, double *out_7006841003408788110) {
out_7006841003408788110[0] = state[4];
out_7006841003408788110[1] = state[5];
}
void H_24(double *state, double *unused, double *out_1813717459687561134) {
out_1813717459687561134[0] = 0;
out_1813717459687561134[1] = 0;
out_1813717459687561134[2] = 0;
out_1813717459687561134[3] = 0;
out_1813717459687561134[4] = 1;
out_1813717459687561134[5] = 0;
out_1813717459687561134[6] = 0;
out_1813717459687561134[7] = 0;
out_1813717459687561134[8] = 0;
out_1813717459687561134[9] = 0;
out_1813717459687561134[10] = 0;
out_1813717459687561134[11] = 0;
out_1813717459687561134[12] = 0;
out_1813717459687561134[13] = 0;
out_1813717459687561134[14] = 1;
out_1813717459687561134[15] = 0;
out_1813717459687561134[16] = 0;
out_1813717459687561134[17] = 0;
void H_24(double *state, double *unused, double *out_5140065597507420025) {
out_5140065597507420025[0] = 0;
out_5140065597507420025[1] = 0;
out_5140065597507420025[2] = 0;
out_5140065597507420025[3] = 0;
out_5140065597507420025[4] = 1;
out_5140065597507420025[5] = 0;
out_5140065597507420025[6] = 0;
out_5140065597507420025[7] = 0;
out_5140065597507420025[8] = 0;
out_5140065597507420025[9] = 0;
out_5140065597507420025[10] = 0;
out_5140065597507420025[11] = 0;
out_5140065597507420025[12] = 0;
out_5140065597507420025[13] = 0;
out_5140065597507420025[14] = 1;
out_5140065597507420025[15] = 0;
out_5140065597507420025[16] = 0;
out_5140065597507420025[17] = 0;
}
void h_30(double *state, double *unused, double *out_8921978207378848294) {
out_8921978207378848294[0] = state[4];
void h_30(double *state, double *unused, double *out_57548165706851306) {
out_57548165706851306[0] = state[4];
}
void H_30(double *state, double *unused, double *out_5734013121132605829) {
out_5734013121132605829[0] = 0;
out_5734013121132605829[1] = 0;
out_5734013121132605829[2] = 0;
out_5734013121132605829[3] = 0;
out_5734013121132605829[4] = 1;
out_5734013121132605829[5] = 0;
out_5734013121132605829[6] = 0;
out_5734013121132605829[7] = 0;
out_5734013121132605829[8] = 0;
void H_30(double *state, double *unused, double *out_449083039994671832) {
out_449083039994671832[0] = 0;
out_449083039994671832[1] = 0;
out_449083039994671832[2] = 0;
out_449083039994671832[3] = 0;
out_449083039994671832[4] = 1;
out_449083039994671832[5] = 0;
out_449083039994671832[6] = 0;
out_449083039994671832[7] = 0;
out_449083039994671832[8] = 0;
}
void h_26(double *state, double *unused, double *out_3355877023318338429) {
out_3355877023318338429[0] = state[7];
void h_26(double *state, double *unused, double *out_5284319070179179257) {
out_5284319070179179257[0] = state[7];
}
void H_26(double *state, double *unused, double *out_6452894675195640936) {
out_6452894675195640936[0] = 0;
out_6452894675195640936[1] = 0;
out_6452894675195640936[2] = 0;
out_6452894675195640936[3] = 0;
out_6452894675195640936[4] = 0;
out_6452894675195640936[5] = 0;
out_6452894675195640936[6] = 0;
out_6452894675195640936[7] = 1;
out_6452894675195640936[8] = 0;
void H_26(double *state, double *unused, double *out_6708919317375976683) {
out_6708919317375976683[0] = 0;
out_6708919317375976683[1] = 0;
out_6708919317375976683[2] = 0;
out_6708919317375976683[3] = 0;
out_6708919317375976683[4] = 0;
out_6708919317375976683[5] = 0;
out_6708919317375976683[6] = 0;
out_6708919317375976683[7] = 1;
out_6708919317375976683[8] = 0;
}
void h_27(double *state, double *unused, double *out_6869400431411979084) {
out_6869400431411979084[0] = state[3];
void h_27(double *state, double *unused, double *out_2937147548800054846) {
out_2937147548800054846[0] = state[3];
}
void H_27(double *state, double *unused, double *out_7908776432933030740) {
out_7908776432933030740[0] = 0;
out_7908776432933030740[1] = 0;
out_7908776432933030740[2] = 0;
out_7908776432933030740[3] = 1;
out_7908776432933030740[4] = 0;
out_7908776432933030740[5] = 0;
out_7908776432933030740[6] = 0;
out_7908776432933030740[7] = 0;
out_7908776432933030740[8] = 0;
void H_27(double *state, double *unused, double *out_2623846351795096743) {
out_2623846351795096743[0] = 0;
out_2623846351795096743[1] = 0;
out_2623846351795096743[2] = 0;
out_2623846351795096743[3] = 1;
out_2623846351795096743[4] = 0;
out_2623846351795096743[5] = 0;
out_2623846351795096743[6] = 0;
out_2623846351795096743[7] = 0;
out_2623846351795096743[8] = 0;
}
void h_29(double *state, double *unused, double *out_3696070991543523347) {
out_3696070991543523347[0] = state[1];
void h_29(double *state, double *unused, double *out_3094334217151183991) {
out_3094334217151183991[0] = state[1];
}
void H_29(double *state, double *unused, double *out_5223781776818213645) {
out_5223781776818213645[0] = 0;
out_5223781776818213645[1] = 1;
out_5223781776818213645[2] = 0;
out_5223781776818213645[3] = 0;
out_5223781776818213645[4] = 0;
out_5223781776818213645[5] = 0;
out_5223781776818213645[6] = 0;
out_5223781776818213645[7] = 0;
out_5223781776818213645[8] = 0;
void H_29(double *state, double *unused, double *out_61148304319720352) {
out_61148304319720352[0] = 0;
out_61148304319720352[1] = 1;
out_61148304319720352[2] = 0;
out_61148304319720352[3] = 0;
out_61148304319720352[4] = 0;
out_61148304319720352[5] = 0;
out_61148304319720352[6] = 0;
out_61148304319720352[7] = 0;
out_61148304319720352[8] = 0;
}
void h_28(double *state, double *unused, double *out_6575670374636726887) {
out_6575670374636726887[0] = state[0];
void h_28(double *state, double *unused, double *out_2064525718860790799) {
out_2064525718860790799[0] = state[0];
}
void H_28(double *state, double *unused, double *out_8140563279821807397) {
out_8140563279821807397[0] = 1;
out_8140563279821807397[1] = 0;
out_8140563279821807397[2] = 0;
out_8140563279821807397[3] = 0;
out_8140563279821807397[4] = 0;
out_8140563279821807397[5] = 0;
out_8140563279821807397[6] = 0;
out_8140563279821807397[7] = 0;
out_8140563279821807397[8] = 0;
void H_28(double *state, double *unused, double *out_5021250712749810222) {
out_5021250712749810222[0] = 1;
out_5021250712749810222[1] = 0;
out_5021250712749810222[2] = 0;
out_5021250712749810222[3] = 0;
out_5021250712749810222[4] = 0;
out_5021250712749810222[5] = 0;
out_5021250712749810222[6] = 0;
out_5021250712749810222[7] = 0;
out_5021250712749810222[8] = 0;
}
void h_31(double *state, double *unused, double *out_5612122275792175083) {
out_5612122275792175083[0] = state[8];
void h_31(double *state, double *unused, double *out_6870473728994628775) {
out_6870473728994628775[0] = state[8];
}
void H_31(double *state, double *unused, double *out_5826686572962289460) {
out_5826686572962289460[0] = 0;
out_5826686572962289460[1] = 0;
out_5826686572962289460[2] = 0;
out_5826686572962289460[3] = 0;
out_5826686572962289460[4] = 0;
out_5826686572962289460[5] = 0;
out_5826686572962289460[6] = 0;
out_5826686572962289460[7] = 0;
out_5826686572962289460[8] = 1;
void H_31(double *state, double *unused, double *out_7335127419609328159) {
out_7335127419609328159[0] = 0;
out_7335127419609328159[1] = 0;
out_7335127419609328159[2] = 0;
out_7335127419609328159[3] = 0;
out_7335127419609328159[4] = 0;
out_7335127419609328159[5] = 0;
out_7335127419609328159[6] = 0;
out_7335127419609328159[7] = 0;
out_7335127419609328159[8] = 1;
}
#include <eigen3/Eigen/Dense>
#include <iostream>
@@ -518,68 +518,68 @@ void car_update_28(double *in_x, double *in_P, double *in_z, double *in_R, doubl
void car_update_31(double *in_x, double *in_P, double *in_z, double *in_R, double *in_ea) {
update<1, 3, 0>(in_x, in_P, h_31, H_31, NULL, in_z, in_R, in_ea, MAHA_THRESH_31);
}
void car_err_fun(double *nom_x, double *delta_x, double *out_4413943037710355540) {
err_fun(nom_x, delta_x, out_4413943037710355540);
void car_err_fun(double *nom_x, double *delta_x, double *out_6119760954545072171) {
err_fun(nom_x, delta_x, out_6119760954545072171);
}
void car_inv_err_fun(double *nom_x, double *true_x, double *out_896653973664715101) {
inv_err_fun(nom_x, true_x, out_896653973664715101);
void car_inv_err_fun(double *nom_x, double *true_x, double *out_3032957791392119605) {
inv_err_fun(nom_x, true_x, out_3032957791392119605);
}
void car_H_mod_fun(double *state, double *out_5267188789104253679) {
H_mod_fun(state, out_5267188789104253679);
void car_H_mod_fun(double *state, double *out_6225772227410316778) {
H_mod_fun(state, out_6225772227410316778);
}
void car_f_fun(double *state, double dt, double *out_1590758894307502735) {
f_fun(state, dt, out_1590758894307502735);
void car_f_fun(double *state, double dt, double *out_1791723405675881227) {
f_fun(state, dt, out_1791723405675881227);
}
void car_F_fun(double *state, double dt, double *out_4932077017586128960) {
F_fun(state, dt, out_4932077017586128960);
void car_F_fun(double *state, double dt, double *out_4540850954218753986) {
F_fun(state, dt, out_4540850954218753986);
}
void car_h_25(double *state, double *unused, double *out_2151142981028497358) {
h_25(state, unused, out_2151142981028497358);
void car_h_25(double *state, double *unused, double *out_6713287060643499630) {
h_25(state, unused, out_6713287060643499630);
}
void car_H_25(double *state, double *unused, double *out_5796040611085329032) {
H_25(state, unused, out_5796040611085329032);
void car_H_25(double *state, double *unused, double *out_2967415998501920459) {
H_25(state, unused, out_2967415998501920459);
}
void car_h_24(double *state, double *unused, double *out_7809478958388963293) {
h_24(state, unused, out_7809478958388963293);
void car_h_24(double *state, double *unused, double *out_7006841003408788110) {
h_24(state, unused, out_7006841003408788110);
}
void car_H_24(double *state, double *unused, double *out_1813717459687561134) {
H_24(state, unused, out_1813717459687561134);
void car_H_24(double *state, double *unused, double *out_5140065597507420025) {
H_24(state, unused, out_5140065597507420025);
}
void car_h_30(double *state, double *unused, double *out_8921978207378848294) {
h_30(state, unused, out_8921978207378848294);
void car_h_30(double *state, double *unused, double *out_57548165706851306) {
h_30(state, unused, out_57548165706851306);
}
void car_H_30(double *state, double *unused, double *out_5734013121132605829) {
H_30(state, unused, out_5734013121132605829);
void car_H_30(double *state, double *unused, double *out_449083039994671832) {
H_30(state, unused, out_449083039994671832);
}
void car_h_26(double *state, double *unused, double *out_3355877023318338429) {
h_26(state, unused, out_3355877023318338429);
void car_h_26(double *state, double *unused, double *out_5284319070179179257) {
h_26(state, unused, out_5284319070179179257);
}
void car_H_26(double *state, double *unused, double *out_6452894675195640936) {
H_26(state, unused, out_6452894675195640936);
void car_H_26(double *state, double *unused, double *out_6708919317375976683) {
H_26(state, unused, out_6708919317375976683);
}
void car_h_27(double *state, double *unused, double *out_6869400431411979084) {
h_27(state, unused, out_6869400431411979084);
void car_h_27(double *state, double *unused, double *out_2937147548800054846) {
h_27(state, unused, out_2937147548800054846);
}
void car_H_27(double *state, double *unused, double *out_7908776432933030740) {
H_27(state, unused, out_7908776432933030740);
void car_H_27(double *state, double *unused, double *out_2623846351795096743) {
H_27(state, unused, out_2623846351795096743);
}
void car_h_29(double *state, double *unused, double *out_3696070991543523347) {
h_29(state, unused, out_3696070991543523347);
void car_h_29(double *state, double *unused, double *out_3094334217151183991) {
h_29(state, unused, out_3094334217151183991);
}
void car_H_29(double *state, double *unused, double *out_5223781776818213645) {
H_29(state, unused, out_5223781776818213645);
void car_H_29(double *state, double *unused, double *out_61148304319720352) {
H_29(state, unused, out_61148304319720352);
}
void car_h_28(double *state, double *unused, double *out_6575670374636726887) {
h_28(state, unused, out_6575670374636726887);
void car_h_28(double *state, double *unused, double *out_2064525718860790799) {
h_28(state, unused, out_2064525718860790799);
}
void car_H_28(double *state, double *unused, double *out_8140563279821807397) {
H_28(state, unused, out_8140563279821807397);
void car_H_28(double *state, double *unused, double *out_5021250712749810222) {
H_28(state, unused, out_5021250712749810222);
}
void car_h_31(double *state, double *unused, double *out_5612122275792175083) {
h_31(state, unused, out_5612122275792175083);
void car_h_31(double *state, double *unused, double *out_6870473728994628775) {
h_31(state, unused, out_6870473728994628775);
}
void car_H_31(double *state, double *unused, double *out_5826686572962289460) {
H_31(state, unused, out_5826686572962289460);
void car_H_31(double *state, double *unused, double *out_7335127419609328159) {
H_31(state, unused, out_7335127419609328159);
}
void car_predict(double *in_x, double *in_P, double *in_Q, double dt) {
predict(in_x, in_P, in_Q, dt);
+21 -21
View File
@@ -9,27 +9,27 @@ void car_update_27(double *in_x, double *in_P, double *in_z, double *in_R, doubl
void car_update_29(double *in_x, double *in_P, double *in_z, double *in_R, double *in_ea);
void car_update_28(double *in_x, double *in_P, double *in_z, double *in_R, double *in_ea);
void car_update_31(double *in_x, double *in_P, double *in_z, double *in_R, double *in_ea);
void car_err_fun(double *nom_x, double *delta_x, double *out_4413943037710355540);
void car_inv_err_fun(double *nom_x, double *true_x, double *out_896653973664715101);
void car_H_mod_fun(double *state, double *out_5267188789104253679);
void car_f_fun(double *state, double dt, double *out_1590758894307502735);
void car_F_fun(double *state, double dt, double *out_4932077017586128960);
void car_h_25(double *state, double *unused, double *out_2151142981028497358);
void car_H_25(double *state, double *unused, double *out_5796040611085329032);
void car_h_24(double *state, double *unused, double *out_7809478958388963293);
void car_H_24(double *state, double *unused, double *out_1813717459687561134);
void car_h_30(double *state, double *unused, double *out_8921978207378848294);
void car_H_30(double *state, double *unused, double *out_5734013121132605829);
void car_h_26(double *state, double *unused, double *out_3355877023318338429);
void car_H_26(double *state, double *unused, double *out_6452894675195640936);
void car_h_27(double *state, double *unused, double *out_6869400431411979084);
void car_H_27(double *state, double *unused, double *out_7908776432933030740);
void car_h_29(double *state, double *unused, double *out_3696070991543523347);
void car_H_29(double *state, double *unused, double *out_5223781776818213645);
void car_h_28(double *state, double *unused, double *out_6575670374636726887);
void car_H_28(double *state, double *unused, double *out_8140563279821807397);
void car_h_31(double *state, double *unused, double *out_5612122275792175083);
void car_H_31(double *state, double *unused, double *out_5826686572962289460);
void car_err_fun(double *nom_x, double *delta_x, double *out_6119760954545072171);
void car_inv_err_fun(double *nom_x, double *true_x, double *out_3032957791392119605);
void car_H_mod_fun(double *state, double *out_6225772227410316778);
void car_f_fun(double *state, double dt, double *out_1791723405675881227);
void car_F_fun(double *state, double dt, double *out_4540850954218753986);
void car_h_25(double *state, double *unused, double *out_6713287060643499630);
void car_H_25(double *state, double *unused, double *out_2967415998501920459);
void car_h_24(double *state, double *unused, double *out_7006841003408788110);
void car_H_24(double *state, double *unused, double *out_5140065597507420025);
void car_h_30(double *state, double *unused, double *out_57548165706851306);
void car_H_30(double *state, double *unused, double *out_449083039994671832);
void car_h_26(double *state, double *unused, double *out_5284319070179179257);
void car_H_26(double *state, double *unused, double *out_6708919317375976683);
void car_h_27(double *state, double *unused, double *out_2937147548800054846);
void car_H_27(double *state, double *unused, double *out_2623846351795096743);
void car_h_29(double *state, double *unused, double *out_3094334217151183991);
void car_H_29(double *state, double *unused, double *out_61148304319720352);
void car_h_28(double *state, double *unused, double *out_2064525718860790799);
void car_H_28(double *state, double *unused, double *out_5021250712749810222);
void car_h_31(double *state, double *unused, double *out_6870473728994628775);
void car_H_31(double *state, double *unused, double *out_7335127419609328159);
void car_predict(double *in_x, double *in_P, double *in_Q, double dt);
void car_set_mass(double x);
void car_set_rotational_inertia(double x);
File diff suppressed because it is too large Load Diff
+13 -13
View File
@@ -5,18 +5,18 @@ void pose_update_4(double *in_x, double *in_P, double *in_z, double *in_R, doubl
void pose_update_10(double *in_x, double *in_P, double *in_z, double *in_R, double *in_ea);
void pose_update_13(double *in_x, double *in_P, double *in_z, double *in_R, double *in_ea);
void pose_update_14(double *in_x, double *in_P, double *in_z, double *in_R, double *in_ea);
void pose_err_fun(double *nom_x, double *delta_x, double *out_8743902382867857614);
void pose_inv_err_fun(double *nom_x, double *true_x, double *out_3636694381902544351);
void pose_H_mod_fun(double *state, double *out_2152190311268096506);
void pose_f_fun(double *state, double dt, double *out_5042547316032857663);
void pose_F_fun(double *state, double dt, double *out_6708996175305477877);
void pose_h_4(double *state, double *unused, double *out_3603221658780671100);
void pose_H_4(double *state, double *unused, double *out_7556357530358465972);
void pose_h_10(double *state, double *unused, double *out_8258563454346399047);
void pose_H_10(double *state, double *unused, double *out_2735534763065741146);
void pose_h_13(double *state, double *unused, double *out_7576910815427407655);
void pose_H_13(double *state, double *unused, double *out_4344083705026133171);
void pose_h_14(double *state, double *unused, double *out_984451843965455601);
void pose_H_14(double *state, double *unused, double *out_7807598111055713348);
void pose_err_fun(double *nom_x, double *delta_x, double *out_4567767818172860295);
void pose_inv_err_fun(double *nom_x, double *true_x, double *out_4613807108104960206);
void pose_H_mod_fun(double *state, double *out_6572770099193808423);
void pose_f_fun(double *state, double dt, double *out_972215043360367871);
void pose_F_fun(double *state, double dt, double *out_9096792433349462064);
void pose_h_4(double *state, double *unused, double *out_2265781100835663155);
void pose_H_4(double *state, double *unused, double *out_8392468825100105284);
void pose_h_10(double *state, double *unused, double *out_316139620022094761);
void pose_H_10(double *state, double *unused, double *out_3533745887327993443);
void pose_h_13(double *state, double *unused, double *out_5506810827115614970);
void pose_H_13(double *state, double *unused, double *out_781837616783404355);
void pose_h_14(double *state, double *unused, double *out_3429617090731340208);
void pose_H_14(double *state, double *unused, double *out_4429227968760620755);
void pose_predict(double *in_x, double *in_P, double *in_Q, double dt);
}
Binary file not shown.
BIN
View File
Binary file not shown.
Binary file not shown.
Binary file not shown.
Binary file not shown.
Binary file not shown.