744 lines
20 KiB
JSON
744 lines
20 KiB
JSON
{
|
|
"schema_version": 2,
|
|
"success": true,
|
|
"message": "Both `ftol` and `xtol` termination conditions are satisfied.",
|
|
"convention": "T_body_lidar maps raw LiDAR points into rear-axle body frame",
|
|
"equation": "A_ij X = X B_ij",
|
|
"measured_extrinsic_used_as_initial": false,
|
|
"translation_m": [
|
|
1.2962115049352554,
|
|
-0.0001653420733896053,
|
|
0.7164468137861116
|
|
],
|
|
"rotation_rpy_deg_xyz": [
|
|
-0.7022421146530834,
|
|
1.3831306856730625,
|
|
-0.8286069697615047
|
|
],
|
|
"quaternion_xyzw": [
|
|
-0.006040299739348631,
|
|
0.012113565983787752,
|
|
-0.007156270443853885,
|
|
0.9998827751749451
|
|
],
|
|
"matrix_4x4": [
|
|
[
|
|
0.9996040986249817,
|
|
0.014164523963697197,
|
|
0.024310743983262467,
|
|
1.2962115049352554
|
|
],
|
|
[
|
|
-0.01445720224151504,
|
|
0.9998246051447864,
|
|
0.011905807424097893,
|
|
-0.0001653420733896053
|
|
],
|
|
[
|
|
-0.02413783990927558,
|
|
-0.012252559240975732,
|
|
0.9996335525964305,
|
|
0.7164468137861116
|
|
],
|
|
[
|
|
0.0,
|
|
0.0,
|
|
0.0,
|
|
1.0
|
|
]
|
|
],
|
|
"estimation": {
|
|
"stations": 38,
|
|
"pairs": 108,
|
|
"residuals": {
|
|
"pairs": 108,
|
|
"translation_m": {
|
|
"rms": 0.19743856479972394,
|
|
"median": 0.06046352611504703,
|
|
"p90": 0.21107717888307384,
|
|
"p95": 0.4320413132492668,
|
|
"max": 0.9185086085818974
|
|
},
|
|
"rotation_deg": {
|
|
"rms": 1.594164834809931,
|
|
"median": 0.9846062073478139,
|
|
"p90": 2.2895871608918337,
|
|
"p95": 2.7021815285034116,
|
|
"max": 5.449412955100641
|
|
},
|
|
"per_pair": [
|
|
{
|
|
"pair_index": 0,
|
|
"translation_m": 0.07883616778657004,
|
|
"rotation_deg": 0.5080220774435835
|
|
},
|
|
{
|
|
"pair_index": 1,
|
|
"translation_m": 0.13193158825620543,
|
|
"rotation_deg": 0.4741606069012087
|
|
},
|
|
{
|
|
"pair_index": 2,
|
|
"translation_m": 0.11129387971109267,
|
|
"rotation_deg": 0.5206505897892112
|
|
},
|
|
{
|
|
"pair_index": 3,
|
|
"translation_m": 0.06037317704760375,
|
|
"rotation_deg": 0.4636666105342909
|
|
},
|
|
{
|
|
"pair_index": 4,
|
|
"translation_m": 0.0532377491787842,
|
|
"rotation_deg": 0.6385789459945687
|
|
},
|
|
{
|
|
"pair_index": 5,
|
|
"translation_m": 0.036086228084217256,
|
|
"rotation_deg": 0.7053466734460281
|
|
},
|
|
{
|
|
"pair_index": 6,
|
|
"translation_m": 0.024212071864605337,
|
|
"rotation_deg": 0.35966262441445085
|
|
},
|
|
{
|
|
"pair_index": 7,
|
|
"translation_m": 0.07843107284074759,
|
|
"rotation_deg": 0.9672771351659644
|
|
},
|
|
{
|
|
"pair_index": 8,
|
|
"translation_m": 0.1331135483643765,
|
|
"rotation_deg": 0.9356542123031394
|
|
},
|
|
{
|
|
"pair_index": 9,
|
|
"translation_m": 0.06287483417453568,
|
|
"rotation_deg": 0.8539179575478302
|
|
},
|
|
{
|
|
"pair_index": 10,
|
|
"translation_m": 0.09307074193602183,
|
|
"rotation_deg": 1.1452312070788857
|
|
},
|
|
{
|
|
"pair_index": 11,
|
|
"translation_m": 0.10534310615277773,
|
|
"rotation_deg": 1.2697416838407303
|
|
},
|
|
{
|
|
"pair_index": 12,
|
|
"translation_m": 0.034156566922473784,
|
|
"rotation_deg": 0.4470789762879368
|
|
},
|
|
{
|
|
"pair_index": 13,
|
|
"translation_m": 0.05706608980344394,
|
|
"rotation_deg": 1.4538259192907348
|
|
},
|
|
{
|
|
"pair_index": 14,
|
|
"translation_m": 0.21156185043155915,
|
|
"rotation_deg": 0.32326983959580347
|
|
},
|
|
{
|
|
"pair_index": 15,
|
|
"translation_m": 0.04366721285272495,
|
|
"rotation_deg": 1.1486889953780957
|
|
},
|
|
{
|
|
"pair_index": 16,
|
|
"translation_m": 0.19784063737858906,
|
|
"rotation_deg": 0.4945905742106831
|
|
},
|
|
{
|
|
"pair_index": 17,
|
|
"translation_m": 0.13271207797084064,
|
|
"rotation_deg": 0.8074538026104654
|
|
},
|
|
{
|
|
"pair_index": 18,
|
|
"translation_m": 0.13649995064331025,
|
|
"rotation_deg": 1.035099347913503
|
|
},
|
|
{
|
|
"pair_index": 19,
|
|
"translation_m": 0.058892470655748055,
|
|
"rotation_deg": 0.6808326191608242
|
|
},
|
|
{
|
|
"pair_index": 20,
|
|
"translation_m": 0.12809115411885974,
|
|
"rotation_deg": 0.8895134738281241
|
|
},
|
|
{
|
|
"pair_index": 21,
|
|
"translation_m": 0.07473485983007296,
|
|
"rotation_deg": 0.7244832869216128
|
|
},
|
|
{
|
|
"pair_index": 22,
|
|
"translation_m": 0.003615738521241208,
|
|
"rotation_deg": 0.6536825959057917
|
|
},
|
|
{
|
|
"pair_index": 23,
|
|
"translation_m": 0.06957198571596916,
|
|
"rotation_deg": 0.7883364856790823
|
|
},
|
|
{
|
|
"pair_index": 24,
|
|
"translation_m": 0.06578636179058665,
|
|
"rotation_deg": 0.09595187830987498
|
|
},
|
|
{
|
|
"pair_index": 25,
|
|
"translation_m": 0.11708949328304538,
|
|
"rotation_deg": 0.9037314334019761
|
|
},
|
|
{
|
|
"pair_index": 26,
|
|
"translation_m": 0.2785740172886443,
|
|
"rotation_deg": 1.2395284599701288
|
|
},
|
|
{
|
|
"pair_index": 27,
|
|
"translation_m": 0.054803484360171,
|
|
"rotation_deg": 0.9197207214648975
|
|
},
|
|
{
|
|
"pair_index": 28,
|
|
"translation_m": 0.2066140285757045,
|
|
"rotation_deg": 1.4700310072490443
|
|
},
|
|
{
|
|
"pair_index": 29,
|
|
"translation_m": 0.21086946250515157,
|
|
"rotation_deg": 1.0216432855984101
|
|
},
|
|
{
|
|
"pair_index": 30,
|
|
"translation_m": 0.16273991885860312,
|
|
"rotation_deg": 1.6658320411463268
|
|
},
|
|
{
|
|
"pair_index": 31,
|
|
"translation_m": 0.17536744938199297,
|
|
"rotation_deg": 1.603914654640798
|
|
},
|
|
{
|
|
"pair_index": 32,
|
|
"translation_m": 0.12486444755757231,
|
|
"rotation_deg": 1.72640237007742
|
|
},
|
|
{
|
|
"pair_index": 33,
|
|
"translation_m": 0.03629298593419621,
|
|
"rotation_deg": 0.7021350382463348
|
|
},
|
|
{
|
|
"pair_index": 34,
|
|
"translation_m": 0.04096591124737788,
|
|
"rotation_deg": 1.182229412077533
|
|
},
|
|
{
|
|
"pair_index": 35,
|
|
"translation_m": 0.023876028562682318,
|
|
"rotation_deg": 2.3067680414707423
|
|
},
|
|
{
|
|
"pair_index": 36,
|
|
"translation_m": 0.0232665744848516,
|
|
"rotation_deg": 0.45561721689220397
|
|
},
|
|
{
|
|
"pair_index": 37,
|
|
"translation_m": 0.0202215693688227,
|
|
"rotation_deg": 1.7396398605001189
|
|
},
|
|
{
|
|
"pair_index": 38,
|
|
"translation_m": 0.2386974208323925,
|
|
"rotation_deg": 0.3084186872525065
|
|
},
|
|
{
|
|
"pair_index": 39,
|
|
"translation_m": 0.0320417923623188,
|
|
"rotation_deg": 1.537812332531765
|
|
},
|
|
{
|
|
"pair_index": 40,
|
|
"translation_m": 0.22893456979179405,
|
|
"rotation_deg": 0.6120657430945021
|
|
},
|
|
{
|
|
"pair_index": 41,
|
|
"translation_m": 0.3264153842951392,
|
|
"rotation_deg": 0.5281733672424023
|
|
},
|
|
{
|
|
"pair_index": 42,
|
|
"translation_m": 0.1540882733017021,
|
|
"rotation_deg": 1.9432086107260433
|
|
},
|
|
{
|
|
"pair_index": 43,
|
|
"translation_m": 0.21054079914538157,
|
|
"rotation_deg": 1.2442015725741578
|
|
},
|
|
{
|
|
"pair_index": 44,
|
|
"translation_m": 0.48891681345533766,
|
|
"rotation_deg": 2.8273101876072357
|
|
},
|
|
{
|
|
"pair_index": 45,
|
|
"translation_m": 0.10733355603351397,
|
|
"rotation_deg": 0.8721227552809412
|
|
},
|
|
{
|
|
"pair_index": 46,
|
|
"translation_m": 0.9185086085818974,
|
|
"rotation_deg": 4.489220955656682
|
|
},
|
|
{
|
|
"pair_index": 47,
|
|
"translation_m": 0.7319199589340636,
|
|
"rotation_deg": 5.449412955100641
|
|
},
|
|
{
|
|
"pair_index": 48,
|
|
"translation_m": 0.8659475201606082,
|
|
"rotation_deg": 3.8214376146729045
|
|
},
|
|
{
|
|
"pair_index": 49,
|
|
"translation_m": 0.7210574374098978,
|
|
"rotation_deg": 4.561541716053782
|
|
},
|
|
{
|
|
"pair_index": 50,
|
|
"translation_m": 0.5570099786748203,
|
|
"rotation_deg": 5.373002500144395
|
|
},
|
|
{
|
|
"pair_index": 51,
|
|
"translation_m": 0.04582605589663051,
|
|
"rotation_deg": 0.6822468845946373
|
|
},
|
|
{
|
|
"pair_index": 52,
|
|
"translation_m": 0.036857756558338325,
|
|
"rotation_deg": 1.7515216368522777
|
|
},
|
|
{
|
|
"pair_index": 53,
|
|
"translation_m": 0.043496707068384696,
|
|
"rotation_deg": 1.7461098288880414
|
|
},
|
|
{
|
|
"pair_index": 54,
|
|
"translation_m": 0.045832318963813956,
|
|
"rotation_deg": 1.041278909174025
|
|
},
|
|
{
|
|
"pair_index": 55,
|
|
"translation_m": 0.060553875182490315,
|
|
"rotation_deg": 0.8052115259091664
|
|
},
|
|
{
|
|
"pair_index": 56,
|
|
"translation_m": 0.06652308069145153,
|
|
"rotation_deg": 0.9632642598400051
|
|
},
|
|
{
|
|
"pair_index": 57,
|
|
"translation_m": 0.035908234140899456,
|
|
"rotation_deg": 1.2689384623057567
|
|
},
|
|
{
|
|
"pair_index": 58,
|
|
"translation_m": 0.060880526853900836,
|
|
"rotation_deg": 0.5935557534854639
|
|
},
|
|
{
|
|
"pair_index": 59,
|
|
"translation_m": 0.11419626074713392,
|
|
"rotation_deg": 0.7130165148085522
|
|
},
|
|
{
|
|
"pair_index": 60,
|
|
"translation_m": 0.04265037619565028,
|
|
"rotation_deg": 0.699587177579278
|
|
},
|
|
{
|
|
"pair_index": 61,
|
|
"translation_m": 0.04378802459846447,
|
|
"rotation_deg": 0.675205047149443
|
|
},
|
|
{
|
|
"pair_index": 62,
|
|
"translation_m": 0.08344520239044273,
|
|
"rotation_deg": 1.3214027680911706
|
|
},
|
|
{
|
|
"pair_index": 63,
|
|
"translation_m": 0.017638868448433938,
|
|
"rotation_deg": 0.17533894669557326
|
|
},
|
|
{
|
|
"pair_index": 64,
|
|
"translation_m": 0.03489149886931174,
|
|
"rotation_deg": 1.664944154610128
|
|
},
|
|
{
|
|
"pair_index": 65,
|
|
"translation_m": 0.10079671035324393,
|
|
"rotation_deg": 0.6171025033257196
|
|
},
|
|
{
|
|
"pair_index": 66,
|
|
"translation_m": 0.014396578516872966,
|
|
"rotation_deg": 1.650080935912764
|
|
},
|
|
{
|
|
"pair_index": 67,
|
|
"translation_m": 0.06023554532048859,
|
|
"rotation_deg": 0.42594747696355045
|
|
},
|
|
{
|
|
"pair_index": 68,
|
|
"translation_m": 0.03699195896487648,
|
|
"rotation_deg": 1.2778861613746475
|
|
},
|
|
{
|
|
"pair_index": 69,
|
|
"translation_m": 0.046905032676790276,
|
|
"rotation_deg": 1.132463118089895
|
|
},
|
|
{
|
|
"pair_index": 70,
|
|
"translation_m": 0.070685940640895,
|
|
"rotation_deg": 0.6925680609090175
|
|
},
|
|
{
|
|
"pair_index": 71,
|
|
"translation_m": 0.05072278859454283,
|
|
"rotation_deg": 0.40553765157890925
|
|
},
|
|
{
|
|
"pair_index": 72,
|
|
"translation_m": 0.061114192405838416,
|
|
"rotation_deg": 0.8033058778952246
|
|
},
|
|
{
|
|
"pair_index": 73,
|
|
"translation_m": 0.12007843139860787,
|
|
"rotation_deg": 0.9239227811720148
|
|
},
|
|
{
|
|
"pair_index": 74,
|
|
"translation_m": 0.12118933148474953,
|
|
"rotation_deg": 1.305746559495919
|
|
},
|
|
{
|
|
"pair_index": 75,
|
|
"translation_m": 0.05055191131491414,
|
|
"rotation_deg": 0.20965439069314443
|
|
},
|
|
{
|
|
"pair_index": 76,
|
|
"translation_m": 0.08360132660274813,
|
|
"rotation_deg": 0.876573476333775
|
|
},
|
|
{
|
|
"pair_index": 77,
|
|
"translation_m": 0.02835721910581123,
|
|
"rotation_deg": 1.5894295378250647
|
|
},
|
|
{
|
|
"pair_index": 78,
|
|
"translation_m": 0.03908539475543364,
|
|
"rotation_deg": 0.8083289126351658
|
|
},
|
|
{
|
|
"pair_index": 79,
|
|
"translation_m": 0.054143804150054306,
|
|
"rotation_deg": 1.6541418156239664
|
|
},
|
|
{
|
|
"pair_index": 80,
|
|
"translation_m": 0.026283210691822913,
|
|
"rotation_deg": 1.6667348211605557
|
|
},
|
|
{
|
|
"pair_index": 81,
|
|
"translation_m": 0.089350850518513,
|
|
"rotation_deg": 2.2825286794384145
|
|
},
|
|
{
|
|
"pair_index": 82,
|
|
"translation_m": 0.03347579217967635,
|
|
"rotation_deg": 1.9977395380091536
|
|
},
|
|
{
|
|
"pair_index": 83,
|
|
"translation_m": 0.019000630740619542,
|
|
"rotation_deg": 1.5515794014919868
|
|
},
|
|
{
|
|
"pair_index": 84,
|
|
"translation_m": 0.04109198168971092,
|
|
"rotation_deg": 0.6855676498071515
|
|
},
|
|
{
|
|
"pair_index": 85,
|
|
"translation_m": 0.04412164134783469,
|
|
"rotation_deg": 0.6915721855798296
|
|
},
|
|
{
|
|
"pair_index": 86,
|
|
"translation_m": 0.11294515765470313,
|
|
"rotation_deg": 2.2385943138303417
|
|
},
|
|
{
|
|
"pair_index": 87,
|
|
"translation_m": 0.01925918248868863,
|
|
"rotation_deg": 1.0019352795296634
|
|
},
|
|
{
|
|
"pair_index": 88,
|
|
"translation_m": 0.07700662983793743,
|
|
"rotation_deg": 2.187099011126195
|
|
},
|
|
{
|
|
"pair_index": 89,
|
|
"translation_m": 0.081983290439235,
|
|
"rotation_deg": 1.2833572216410762
|
|
},
|
|
{
|
|
"pair_index": 90,
|
|
"translation_m": 0.07413447803071471,
|
|
"rotation_deg": 1.509039762712118
|
|
},
|
|
{
|
|
"pair_index": 91,
|
|
"translation_m": 0.05026833056909235,
|
|
"rotation_deg": 0.6540616669180302
|
|
},
|
|
{
|
|
"pair_index": 92,
|
|
"translation_m": 0.07040328963228819,
|
|
"rotation_deg": 1.1208457441248971
|
|
},
|
|
{
|
|
"pair_index": 93,
|
|
"translation_m": 0.035342214388759695,
|
|
"rotation_deg": 0.932859896131992
|
|
},
|
|
{
|
|
"pair_index": 94,
|
|
"translation_m": 0.09059341699612283,
|
|
"rotation_deg": 2.23170809346331
|
|
},
|
|
{
|
|
"pair_index": 95,
|
|
"translation_m": 0.0903976819000103,
|
|
"rotation_deg": 2.3060569509498126
|
|
},
|
|
{
|
|
"pair_index": 96,
|
|
"translation_m": 0.029370567781526302,
|
|
"rotation_deg": 1.2512304574145157
|
|
},
|
|
{
|
|
"pair_index": 97,
|
|
"translation_m": 0.031018252539194446,
|
|
"rotation_deg": 1.2538724028818724
|
|
},
|
|
{
|
|
"pair_index": 98,
|
|
"translation_m": 0.05078748646827035,
|
|
"rotation_deg": 0.3396814347935095
|
|
},
|
|
{
|
|
"pair_index": 99,
|
|
"translation_m": 0.024770901259540175,
|
|
"rotation_deg": 0.09062392685294303
|
|
},
|
|
{
|
|
"pair_index": 100,
|
|
"translation_m": 0.03340161795186317,
|
|
"rotation_deg": 1.0544497064860483
|
|
},
|
|
{
|
|
"pair_index": 101,
|
|
"translation_m": 0.032353919411514664,
|
|
"rotation_deg": 2.4697997330248893
|
|
},
|
|
{
|
|
"pair_index": 102,
|
|
"translation_m": 0.0369893920228258,
|
|
"rotation_deg": 0.9428098575535183
|
|
},
|
|
{
|
|
"pair_index": 103,
|
|
"translation_m": 0.03967084241987133,
|
|
"rotation_deg": 2.4057498894359104
|
|
},
|
|
{
|
|
"pair_index": 104,
|
|
"translation_m": 0.032499330822438305,
|
|
"rotation_deg": 0.5201344456818268
|
|
},
|
|
{
|
|
"pair_index": 105,
|
|
"translation_m": 0.020738575117572048,
|
|
"rotation_deg": 1.147380363634985
|
|
},
|
|
{
|
|
"pair_index": 106,
|
|
"translation_m": 0.02864934739022941,
|
|
"rotation_deg": 0.9393233353789158
|
|
},
|
|
{
|
|
"pair_index": 107,
|
|
"translation_m": 0.04427763743614998,
|
|
"rotation_deg": 2.333163177357132
|
|
}
|
|
]
|
|
}
|
|
},
|
|
"ground": {
|
|
"planes": 38,
|
|
"body_origin_height_above_ground_m": 0.2335,
|
|
"formula": "d_lidar - (R_X n_lidar)^T t_X - body_height"
|
|
},
|
|
"linearized_one_sigma": {
|
|
"translation_m": [
|
|
0.004408386781524471,
|
|
0.004767641769352496,
|
|
0.005598290825790153
|
|
],
|
|
"rotation_deg": [
|
|
0.048493732410523904,
|
|
0.046658283462926005,
|
|
0.07519664546145975
|
|
],
|
|
"warning": "conditional local estimate; bootstrap is the primary stability check"
|
|
},
|
|
"weighted_jacobian_condition_number": 7.050612320852161,
|
|
"solver_multistart": {
|
|
"runs": 12,
|
|
"candidates_relative_to_best": [
|
|
{
|
|
"cost": 643.4104764663608,
|
|
"success": true,
|
|
"translation_m": 3.912474170044392e-10,
|
|
"rotation_deg": 6.735629049437961e-10
|
|
},
|
|
{
|
|
"cost": 643.4104764663626,
|
|
"success": true,
|
|
"translation_m": 5.541272376488872e-09,
|
|
"rotation_deg": 8.145564755773614e-08
|
|
},
|
|
{
|
|
"cost": 643.4104764663621,
|
|
"success": true,
|
|
"translation_m": 5.7457948050995e-09,
|
|
"rotation_deg": 9.303346267795607e-08
|
|
},
|
|
{
|
|
"cost": 643.4104764663617,
|
|
"success": true,
|
|
"translation_m": 2.194969543097371e-09,
|
|
"rotation_deg": 6.831261261103626e-08
|
|
},
|
|
{
|
|
"cost": 643.4104764663606,
|
|
"success": true,
|
|
"translation_m": 0.0,
|
|
"rotation_deg": 0.0
|
|
},
|
|
{
|
|
"cost": 643.4104764663606,
|
|
"success": true,
|
|
"translation_m": 2.0328177429825194e-10,
|
|
"rotation_deg": 5.30535295392565e-10
|
|
},
|
|
{
|
|
"cost": 643.4104764663606,
|
|
"success": true,
|
|
"translation_m": 2.942069407882596e-10,
|
|
"rotation_deg": 1.1060405674229135e-09
|
|
},
|
|
{
|
|
"cost": 643.4104764663616,
|
|
"success": true,
|
|
"translation_m": 2.0219843122070147e-09,
|
|
"rotation_deg": 6.76470161118562e-08
|
|
},
|
|
{
|
|
"cost": 643.4104764663626,
|
|
"success": true,
|
|
"translation_m": 4.562054371593163e-09,
|
|
"rotation_deg": 1.0596545697409183e-07
|
|
},
|
|
{
|
|
"cost": 643.4104764663607,
|
|
"success": true,
|
|
"translation_m": 1.928078172154913e-10,
|
|
"rotation_deg": 2.1724633303911955e-09
|
|
},
|
|
{
|
|
"cost": 643.4104764663614,
|
|
"success": true,
|
|
"translation_m": 4.546336113588724e-09,
|
|
"rotation_deg": 6.943102831728965e-08
|
|
},
|
|
{
|
|
"cost": 643.4104764663606,
|
|
"success": true,
|
|
"translation_m": 2.3977413195330228e-09,
|
|
"rotation_deg": 3.302215565653965e-08
|
|
}
|
|
]
|
|
},
|
|
"bootstrap": {
|
|
"runs": 100,
|
|
"order": [
|
|
"x_m",
|
|
"y_m",
|
|
"z_m",
|
|
"roll_deg",
|
|
"pitch_deg",
|
|
"yaw_deg"
|
|
],
|
|
"std": [
|
|
0.0019183316339420184,
|
|
0.0018458296498062193,
|
|
0.0015077091479455522,
|
|
0.06309617953577086,
|
|
0.06679628584461805,
|
|
0.059116801250773655
|
|
],
|
|
"p025": [
|
|
1.2931455727368442,
|
|
-0.0034690771097207083,
|
|
0.7130935831011376,
|
|
-0.8251808751744363,
|
|
1.2576102536763605,
|
|
-0.9269499764475692
|
|
],
|
|
"p975": [
|
|
1.3004042751519689,
|
|
0.0031684595904240874,
|
|
0.7192601795844623,
|
|
-0.5861986801138164,
|
|
1.5316240168054431,
|
|
-0.7099716198219946
|
|
]
|
|
}
|
|
} |