489 lines
13 KiB
JSON
489 lines
13 KiB
JSON
{
|
|
"schema_version": 2,
|
|
"success": true,
|
|
"message": "`ftol` termination condition is 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.2944883843818025,
|
|
-0.0008838118010001346,
|
|
0.7058442435591689
|
|
],
|
|
"rotation_rpy_deg_xyz": [
|
|
-0.7159364624845366,
|
|
1.3526878670674298,
|
|
-0.975972089807914
|
|
],
|
|
"quaternion_xyzw": [
|
|
-0.006146489369094902,
|
|
0.011856702812467925,
|
|
-0.008442354678834595,
|
|
0.999875175166545
|
|
],
|
|
"matrix_4x4": [
|
|
[
|
|
0.9995762904917872,
|
|
0.016736847531056993,
|
|
0.02381422728959523,
|
|
1.2944883843818025
|
|
],
|
|
[
|
|
-0.01702835592221438,
|
|
0.9997818946318248,
|
|
0.01209124728823738,
|
|
-0.0008838118010001346
|
|
],
|
|
[
|
|
-0.023606663916460907,
|
|
-0.01249164125009491,
|
|
0.9996432785337048,
|
|
0.7058442435591689
|
|
],
|
|
[
|
|
0.0,
|
|
0.0,
|
|
0.0,
|
|
1.0
|
|
]
|
|
],
|
|
"estimation": {
|
|
"stations": 34,
|
|
"pairs": 57,
|
|
"residuals": {
|
|
"pairs": 57,
|
|
"translation_m": {
|
|
"rms": 0.1544348214275169,
|
|
"median": 0.0705120546692258,
|
|
"p90": 0.2796247931030114,
|
|
"p95": 0.38830732511177307,
|
|
"max": 0.42173620405868173
|
|
},
|
|
"rotation_deg": {
|
|
"rms": 1.6127366820434261,
|
|
"median": 0.7802394472449041,
|
|
"p90": 2.0427026963913084,
|
|
"p95": 4.139878905679253,
|
|
"max": 4.927876933555878
|
|
},
|
|
"per_pair": [
|
|
{
|
|
"pair_index": 0,
|
|
"translation_m": 0.04921586129986855,
|
|
"rotation_deg": 0.7802394472449041
|
|
},
|
|
{
|
|
"pair_index": 1,
|
|
"translation_m": 0.06022467069161827,
|
|
"rotation_deg": 0.8076387678918286
|
|
},
|
|
{
|
|
"pair_index": 2,
|
|
"translation_m": 0.05733334031955927,
|
|
"rotation_deg": 0.3801287351167008
|
|
},
|
|
{
|
|
"pair_index": 3,
|
|
"translation_m": 0.10178704595686662,
|
|
"rotation_deg": 0.23294290596786388
|
|
},
|
|
{
|
|
"pair_index": 4,
|
|
"translation_m": 0.0950710667744258,
|
|
"rotation_deg": 0.8441747973849835
|
|
},
|
|
{
|
|
"pair_index": 5,
|
|
"translation_m": 0.1482159791451249,
|
|
"rotation_deg": 0.681326797444399
|
|
},
|
|
{
|
|
"pair_index": 6,
|
|
"translation_m": 0.02325894326521952,
|
|
"rotation_deg": 0.6033104606942519
|
|
},
|
|
{
|
|
"pair_index": 7,
|
|
"translation_m": 0.07474087499522525,
|
|
"rotation_deg": 0.6507288891948437
|
|
},
|
|
{
|
|
"pair_index": 8,
|
|
"translation_m": 0.18825515016508942,
|
|
"rotation_deg": 0.26486292076967255
|
|
},
|
|
{
|
|
"pair_index": 9,
|
|
"translation_m": 0.04309283328904936,
|
|
"rotation_deg": 0.13788972833567684
|
|
},
|
|
{
|
|
"pair_index": 10,
|
|
"translation_m": 0.04634466299044426,
|
|
"rotation_deg": 0.727856852897771
|
|
},
|
|
{
|
|
"pair_index": 11,
|
|
"translation_m": 0.043890799917503956,
|
|
"rotation_deg": 0.7033085139548623
|
|
},
|
|
{
|
|
"pair_index": 12,
|
|
"translation_m": 0.06569153273548976,
|
|
"rotation_deg": 0.8215251942968772
|
|
},
|
|
{
|
|
"pair_index": 13,
|
|
"translation_m": 0.05085505830053342,
|
|
"rotation_deg": 0.5703942163369722
|
|
},
|
|
{
|
|
"pair_index": 14,
|
|
"translation_m": 0.08080041374696341,
|
|
"rotation_deg": 0.7042489825699358
|
|
},
|
|
{
|
|
"pair_index": 15,
|
|
"translation_m": 0.028283768727744116,
|
|
"rotation_deg": 0.5815552521395532
|
|
},
|
|
{
|
|
"pair_index": 16,
|
|
"translation_m": 0.034152028863445455,
|
|
"rotation_deg": 1.0076363281960339
|
|
},
|
|
{
|
|
"pair_index": 17,
|
|
"translation_m": 0.10661935094245772,
|
|
"rotation_deg": 0.585736616100307
|
|
},
|
|
{
|
|
"pair_index": 18,
|
|
"translation_m": 0.0705120546692258,
|
|
"rotation_deg": 0.8052707169746115
|
|
},
|
|
{
|
|
"pair_index": 19,
|
|
"translation_m": 0.06442322486081886,
|
|
"rotation_deg": 2.1113003980243557
|
|
},
|
|
{
|
|
"pair_index": 20,
|
|
"translation_m": 0.058531034305082885,
|
|
"rotation_deg": 0.5873890947329841
|
|
},
|
|
{
|
|
"pair_index": 21,
|
|
"translation_m": 0.06915436202628812,
|
|
"rotation_deg": 0.4455496836075116
|
|
},
|
|
{
|
|
"pair_index": 22,
|
|
"translation_m": 0.1484005911609239,
|
|
"rotation_deg": 1.9969708953026104
|
|
},
|
|
{
|
|
"pair_index": 23,
|
|
"translation_m": 0.10429385187976488,
|
|
"rotation_deg": 0.12781289285231975
|
|
},
|
|
{
|
|
"pair_index": 24,
|
|
"translation_m": 0.06859842051942554,
|
|
"rotation_deg": 0.3198403871694416
|
|
},
|
|
{
|
|
"pair_index": 25,
|
|
"translation_m": 0.037990236699121674,
|
|
"rotation_deg": 0.631070403868711
|
|
},
|
|
{
|
|
"pair_index": 26,
|
|
"translation_m": 0.03189885614531801,
|
|
"rotation_deg": 0.7541329389301039
|
|
},
|
|
{
|
|
"pair_index": 27,
|
|
"translation_m": 0.07672961622319935,
|
|
"rotation_deg": 1.5806114049925588
|
|
},
|
|
{
|
|
"pair_index": 28,
|
|
"translation_m": 0.069983101896218,
|
|
"rotation_deg": 0.4729689795147634
|
|
},
|
|
{
|
|
"pair_index": 29,
|
|
"translation_m": 0.016135065100391668,
|
|
"rotation_deg": 0.3789407761818106
|
|
},
|
|
{
|
|
"pair_index": 30,
|
|
"translation_m": 0.07432095926140471,
|
|
"rotation_deg": 1.8120862981058055
|
|
},
|
|
{
|
|
"pair_index": 31,
|
|
"translation_m": 0.17890921343127023,
|
|
"rotation_deg": 3.97184190714068
|
|
},
|
|
{
|
|
"pair_index": 32,
|
|
"translation_m": 0.2459042707502872,
|
|
"rotation_deg": 4.617881335971262
|
|
},
|
|
{
|
|
"pair_index": 33,
|
|
"translation_m": 0.06334407979243162,
|
|
"rotation_deg": 0.8238155509065317
|
|
},
|
|
{
|
|
"pair_index": 34,
|
|
"translation_m": 0.07743513463604834,
|
|
"rotation_deg": 4.0203782981062535
|
|
},
|
|
{
|
|
"pair_index": 35,
|
|
"translation_m": 0.15971289980951447,
|
|
"rotation_deg": 4.84466491195667
|
|
},
|
|
{
|
|
"pair_index": 36,
|
|
"translation_m": 0.13395086756218255,
|
|
"rotation_deg": 4.927876933555878
|
|
},
|
|
{
|
|
"pair_index": 37,
|
|
"translation_m": 0.06599998782040693,
|
|
"rotation_deg": 1.9960824610834838
|
|
},
|
|
{
|
|
"pair_index": 38,
|
|
"translation_m": 0.04503412561992633,
|
|
"rotation_deg": 1.279332716204477
|
|
},
|
|
{
|
|
"pair_index": 39,
|
|
"translation_m": 0.11215573119400024,
|
|
"rotation_deg": 0.5578231171630792
|
|
},
|
|
{
|
|
"pair_index": 40,
|
|
"translation_m": 0.05509905448014895,
|
|
"rotation_deg": 0.6608982729619334
|
|
},
|
|
{
|
|
"pair_index": 41,
|
|
"translation_m": 0.007272665876828039,
|
|
"rotation_deg": 1.2124341117031159
|
|
},
|
|
{
|
|
"pair_index": 42,
|
|
"translation_m": 0.055811383114362484,
|
|
"rotation_deg": 0.8153248357421402
|
|
},
|
|
{
|
|
"pair_index": 43,
|
|
"translation_m": 0.03138324591270751,
|
|
"rotation_deg": 1.2136591021205085
|
|
},
|
|
{
|
|
"pair_index": 44,
|
|
"translation_m": 0.13982233632280833,
|
|
"rotation_deg": 1.2089791291543672
|
|
},
|
|
{
|
|
"pair_index": 45,
|
|
"translation_m": 0.42173620405868173,
|
|
"rotation_deg": 1.126390973143559
|
|
},
|
|
{
|
|
"pair_index": 46,
|
|
"translation_m": 0.027936086071527602,
|
|
"rotation_deg": 0.5561027320483051
|
|
},
|
|
{
|
|
"pair_index": 47,
|
|
"translation_m": 0.08146548874814821,
|
|
"rotation_deg": 1.5984131745791201
|
|
},
|
|
{
|
|
"pair_index": 48,
|
|
"translation_m": 0.40597723810744263,
|
|
"rotation_deg": 1.3479854285502366
|
|
},
|
|
{
|
|
"pair_index": 49,
|
|
"translation_m": 0.3864154920341234,
|
|
"rotation_deg": 0.6215042157245596
|
|
},
|
|
{
|
|
"pair_index": 50,
|
|
"translation_m": 0.18945577362130134,
|
|
"rotation_deg": 0.596177211598774
|
|
},
|
|
{
|
|
"pair_index": 51,
|
|
"translation_m": 0.37813335218979344,
|
|
"rotation_deg": 1.0668602650100487
|
|
},
|
|
{
|
|
"pair_index": 52,
|
|
"translation_m": 0.330205576632098,
|
|
"rotation_deg": 0.40979383494055255
|
|
},
|
|
{
|
|
"pair_index": 53,
|
|
"translation_m": 0.39587465742237204,
|
|
"rotation_deg": 0.7934150366951904
|
|
},
|
|
{
|
|
"pair_index": 54,
|
|
"translation_m": 0.060998991546499626,
|
|
"rotation_deg": 0.9224390837063629
|
|
},
|
|
{
|
|
"pair_index": 55,
|
|
"translation_m": 0.0952510183208545,
|
|
"rotation_deg": 0.8616718556937568
|
|
},
|
|
{
|
|
"pair_index": 56,
|
|
"translation_m": 0.10976329201195999,
|
|
"rotation_deg": 0.5415573303416338
|
|
}
|
|
]
|
|
}
|
|
},
|
|
"ground": {
|
|
"planes": 34,
|
|
"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.006072210871275005,
|
|
0.0060852661675311025,
|
|
0.005465720025368553
|
|
],
|
|
"rotation_deg": [
|
|
0.06255688904352227,
|
|
0.06213349734715941,
|
|
0.13055508827073753
|
|
],
|
|
"warning": "conditional local estimate; bootstrap is the primary stability check"
|
|
},
|
|
"weighted_jacobian_condition_number": 6.040138286165465,
|
|
"solver_multistart": {
|
|
"runs": 12,
|
|
"candidates_relative_to_best": [
|
|
{
|
|
"cost": 324.2098227991519,
|
|
"success": true,
|
|
"translation_m": 5.570266299009551e-09,
|
|
"rotation_deg": 1.4455049406405054e-07
|
|
},
|
|
{
|
|
"cost": 324.20982279914983,
|
|
"success": true,
|
|
"translation_m": 0.0,
|
|
"rotation_deg": 0.0
|
|
},
|
|
{
|
|
"cost": 324.20982279915165,
|
|
"success": true,
|
|
"translation_m": 5.216823166795417e-09,
|
|
"rotation_deg": 1.973338877475283e-07
|
|
},
|
|
{
|
|
"cost": 324.20982279915034,
|
|
"success": true,
|
|
"translation_m": 1.3901066622882166e-09,
|
|
"rotation_deg": 6.335210062786435e-08
|
|
},
|
|
{
|
|
"cost": 324.20982279914995,
|
|
"success": true,
|
|
"translation_m": 3.578733410578741e-10,
|
|
"rotation_deg": 6.852733510041159e-09
|
|
},
|
|
{
|
|
"cost": 324.20982279914983,
|
|
"success": true,
|
|
"translation_m": 6.594966941115627e-10,
|
|
"rotation_deg": 2.2216701960527812e-08
|
|
},
|
|
{
|
|
"cost": 324.20982279914983,
|
|
"success": true,
|
|
"translation_m": 2.1650538139486925e-09,
|
|
"rotation_deg": 3.6255288379996055e-08
|
|
},
|
|
{
|
|
"cost": 324.2098227991501,
|
|
"success": true,
|
|
"translation_m": 1.5027981325208515e-09,
|
|
"rotation_deg": 6.326578543393082e-08
|
|
},
|
|
{
|
|
"cost": 324.20982279914983,
|
|
"success": true,
|
|
"translation_m": 6.094320168262204e-10,
|
|
"rotation_deg": 1.025130160040861e-08
|
|
},
|
|
{
|
|
"cost": 324.2098227991552,
|
|
"success": true,
|
|
"translation_m": 1.057266183614633e-08,
|
|
"rotation_deg": 3.643863231629731e-07
|
|
},
|
|
{
|
|
"cost": 324.20982279915063,
|
|
"success": true,
|
|
"translation_m": 3.9489601150102006e-09,
|
|
"rotation_deg": 1.359274031832874e-07
|
|
},
|
|
{
|
|
"cost": 324.20982279914983,
|
|
"success": true,
|
|
"translation_m": 6.276644321676319e-10,
|
|
"rotation_deg": 2.14493230752589e-08
|
|
}
|
|
]
|
|
},
|
|
"bootstrap": {
|
|
"runs": 100,
|
|
"order": [
|
|
"x_m",
|
|
"y_m",
|
|
"z_m",
|
|
"roll_deg",
|
|
"pitch_deg",
|
|
"yaw_deg"
|
|
],
|
|
"std": [
|
|
0.003048001100427371,
|
|
0.0025869752895426976,
|
|
0.0014870952541001317,
|
|
0.09174691854497609,
|
|
0.06502786700039134,
|
|
0.11777557058586356
|
|
],
|
|
"p025": [
|
|
1.2892012505330883,
|
|
-0.0051467048024525786,
|
|
0.7035478241042927,
|
|
-0.8634755073850175,
|
|
1.2139289883714506,
|
|
-1.173046710195043
|
|
],
|
|
"p975": [
|
|
1.2997598841406142,
|
|
0.005003259375615847,
|
|
0.7090711194920217,
|
|
-0.48035430043405547,
|
|
1.4534667429791082,
|
|
-0.7593758945747364
|
|
]
|
|
}
|
|
} |