mirror of
https://github.com/MoreTore/openpilot.git
synced 2026-08-07 01:06:01 +08:00
build
This commit is contained in:
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,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 @@
|
||||
DEV-cdca40f0-DEBUG
|
||||
DEV-6f569061-DEBUG
|
||||
@@ -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);
|
||||
|
||||
@@ -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
@@ -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.
Binary file not shown.
Binary file not shown.
Binary file not shown.
Binary file not shown.
Binary file not shown.
Reference in New Issue
Block a user