414 lines
11 KiB
JSON
414 lines
11 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.2975484155117711,
|
|
-0.0014693441955134902,
|
|
0.7052088406121522
|
|
],
|
|
"rotation_rpy_deg_xyz": [
|
|
-0.8301548470744382,
|
|
1.3787117674135543,
|
|
-0.9873301733452331
|
|
],
|
|
"quaternion_xyzw": [
|
|
-0.007139952974435751,
|
|
0.012092890421885221,
|
|
-0.008527968948116832,
|
|
0.9998650192992987
|
|
],
|
|
"matrix_4x4": [
|
|
[
|
|
0.9995620714937284,
|
|
0.01688095033591077,
|
|
0.02430429482463916,
|
|
1.2975484155117711
|
|
],
|
|
[
|
|
-0.017226321011659856,
|
|
0.9997525896342856,
|
|
0.014071722849138928,
|
|
-0.0014693441955134902
|
|
],
|
|
[
|
|
-0.024060737635611132,
|
|
-0.014484234025182223,
|
|
0.9996055661455342,
|
|
0.7052088406121522
|
|
],
|
|
[
|
|
0.0,
|
|
0.0,
|
|
0.0,
|
|
1.0
|
|
]
|
|
],
|
|
"estimation": {
|
|
"stations": 34,
|
|
"pairs": 42,
|
|
"residuals": {
|
|
"pairs": 42,
|
|
"translation_m": {
|
|
"rms": 0.12183423858445137,
|
|
"median": 0.060649486998667235,
|
|
"p90": 0.11912435755512873,
|
|
"p95": 0.3030566180355447,
|
|
"max": 0.45978165540815585
|
|
},
|
|
"rotation_deg": {
|
|
"rms": 1.0805282705084651,
|
|
"median": 0.7524132662595089,
|
|
"p90": 1.482445248533153,
|
|
"p95": 1.8550286425106393,
|
|
"max": 4.3358524167513774
|
|
},
|
|
"per_pair": [
|
|
{
|
|
"pair_index": 0,
|
|
"translation_m": 0.038624527608401314,
|
|
"rotation_deg": 0.8023305035396044
|
|
},
|
|
{
|
|
"pair_index": 1,
|
|
"translation_m": 0.04180287320767011,
|
|
"rotation_deg": 0.6893264946463747
|
|
},
|
|
{
|
|
"pair_index": 2,
|
|
"translation_m": 0.019127950093528003,
|
|
"rotation_deg": 1.0042991942789465
|
|
},
|
|
{
|
|
"pair_index": 3,
|
|
"translation_m": 0.06137084310587195,
|
|
"rotation_deg": 0.3949193126839051
|
|
},
|
|
{
|
|
"pair_index": 4,
|
|
"translation_m": 0.1071111410675142,
|
|
"rotation_deg": 0.29878675978634545
|
|
},
|
|
{
|
|
"pair_index": 5,
|
|
"translation_m": 0.06364016847596804,
|
|
"rotation_deg": 0.5544336747047969
|
|
},
|
|
{
|
|
"pair_index": 6,
|
|
"translation_m": 0.06293697736756677,
|
|
"rotation_deg": 0.5686016770604462
|
|
},
|
|
{
|
|
"pair_index": 7,
|
|
"translation_m": 0.024970034635953178,
|
|
"rotation_deg": 0.5027938164737027
|
|
},
|
|
{
|
|
"pair_index": 8,
|
|
"translation_m": 0.06609908977135717,
|
|
"rotation_deg": 0.769573579451918
|
|
},
|
|
{
|
|
"pair_index": 9,
|
|
"translation_m": 0.015198604597359418,
|
|
"rotation_deg": 0.7395239518119227
|
|
},
|
|
{
|
|
"pair_index": 10,
|
|
"translation_m": 0.08603113369700931,
|
|
"rotation_deg": 0.38160978353264396
|
|
},
|
|
{
|
|
"pair_index": 11,
|
|
"translation_m": 0.023734833308603348,
|
|
"rotation_deg": 0.5279761588421565
|
|
},
|
|
{
|
|
"pair_index": 12,
|
|
"translation_m": 0.044728554479905425,
|
|
"rotation_deg": 0.8691250339782107
|
|
},
|
|
{
|
|
"pair_index": 13,
|
|
"translation_m": 0.07088160554682986,
|
|
"rotation_deg": 0.450151294217732
|
|
},
|
|
{
|
|
"pair_index": 14,
|
|
"translation_m": 0.08888554602585935,
|
|
"rotation_deg": 0.6592285262192215
|
|
},
|
|
{
|
|
"pair_index": 15,
|
|
"translation_m": 0.05233056995457292,
|
|
"rotation_deg": 1.8589142482602727
|
|
},
|
|
{
|
|
"pair_index": 16,
|
|
"translation_m": 0.12686760514047216,
|
|
"rotation_deg": 1.9773175636228766
|
|
},
|
|
{
|
|
"pair_index": 17,
|
|
"translation_m": 0.06853778836627006,
|
|
"rotation_deg": 0.2507622154612463
|
|
},
|
|
{
|
|
"pair_index": 18,
|
|
"translation_m": 0.0613281598931951,
|
|
"rotation_deg": 0.3396141740929532
|
|
},
|
|
{
|
|
"pair_index": 19,
|
|
"translation_m": 0.03461219125828727,
|
|
"rotation_deg": 0.5120113019840405
|
|
},
|
|
{
|
|
"pair_index": 20,
|
|
"translation_m": 0.003516478473153868,
|
|
"rotation_deg": 0.3641614482709119
|
|
},
|
|
{
|
|
"pair_index": 21,
|
|
"translation_m": 0.059970814104139375,
|
|
"rotation_deg": 0.61595189426212
|
|
},
|
|
{
|
|
"pair_index": 22,
|
|
"translation_m": 0.011156452422652521,
|
|
"rotation_deg": 0.39742394993610364
|
|
},
|
|
{
|
|
"pair_index": 23,
|
|
"translation_m": 0.04780738274324129,
|
|
"rotation_deg": 1.7812021332676105
|
|
},
|
|
{
|
|
"pair_index": 24,
|
|
"translation_m": 0.0580893770008635,
|
|
"rotation_deg": 0.879332260016813
|
|
},
|
|
{
|
|
"pair_index": 25,
|
|
"translation_m": 0.12024661823169551,
|
|
"rotation_deg": 4.3358524167513774
|
|
},
|
|
{
|
|
"pair_index": 26,
|
|
"translation_m": 0.06196910794842297,
|
|
"rotation_deg": 1.5238281010443262
|
|
},
|
|
{
|
|
"pair_index": 27,
|
|
"translation_m": 0.0503874055448458,
|
|
"rotation_deg": 0.972956387575872
|
|
},
|
|
{
|
|
"pair_index": 28,
|
|
"translation_m": 0.01757080571201053,
|
|
"rotation_deg": 0.8111658366205472
|
|
},
|
|
{
|
|
"pair_index": 29,
|
|
"translation_m": 0.032044188496992296,
|
|
"rotation_deg": 0.943436351113904
|
|
},
|
|
{
|
|
"pair_index": 30,
|
|
"translation_m": 0.05418626153418599,
|
|
"rotation_deg": 0.5111200883804832
|
|
},
|
|
{
|
|
"pair_index": 31,
|
|
"translation_m": 0.02622969795541729,
|
|
"rotation_deg": 0.26503765103607685
|
|
},
|
|
{
|
|
"pair_index": 32,
|
|
"translation_m": 0.10034938173040396,
|
|
"rotation_deg": 0.8910089412227198
|
|
},
|
|
{
|
|
"pair_index": 33,
|
|
"translation_m": 0.024232025179701657,
|
|
"rotation_deg": 0.2983628682948933
|
|
},
|
|
{
|
|
"pair_index": 34,
|
|
"translation_m": 0.06450981390919311,
|
|
"rotation_deg": 1.1099995759326005
|
|
},
|
|
{
|
|
"pair_index": 35,
|
|
"translation_m": 0.06841378002467255,
|
|
"rotation_deg": 0.765302580707095
|
|
},
|
|
{
|
|
"pair_index": 36,
|
|
"translation_m": 0.45978165540815585,
|
|
"rotation_deg": 0.8318777085643659
|
|
},
|
|
{
|
|
"pair_index": 37,
|
|
"translation_m": 0.31232972397739145,
|
|
"rotation_deg": 0.7893009066081454
|
|
},
|
|
{
|
|
"pair_index": 38,
|
|
"translation_m": 0.3910017597095041,
|
|
"rotation_deg": 0.6583887677988087
|
|
},
|
|
{
|
|
"pair_index": 39,
|
|
"translation_m": 0.1015358221759577,
|
|
"rotation_deg": 0.8428062435042994
|
|
},
|
|
{
|
|
"pair_index": 40,
|
|
"translation_m": 0.1090240114660279,
|
|
"rotation_deg": 0.8418950507797021
|
|
},
|
|
{
|
|
"pair_index": 41,
|
|
"translation_m": 0.03539906786781987,
|
|
"rotation_deg": 0.7658972874383352
|
|
}
|
|
]
|
|
}
|
|
},
|
|
"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.007068161359903731,
|
|
0.007140938677742994,
|
|
0.00460528013456401
|
|
],
|
|
"rotation_deg": [
|
|
0.07009913972450056,
|
|
0.0632417549466229,
|
|
0.13781143232539678
|
|
],
|
|
"warning": "conditional local estimate; bootstrap is the primary stability check"
|
|
},
|
|
"weighted_jacobian_condition_number": 6.8653146384480275,
|
|
"solver_multistart": {
|
|
"runs": 12,
|
|
"candidates_relative_to_best": [
|
|
{
|
|
"cost": 165.05915287927994,
|
|
"success": true,
|
|
"translation_m": 3.0576433724414325e-08,
|
|
"rotation_deg": 1.5435010182701515e-07
|
|
},
|
|
{
|
|
"cost": 165.05915287928036,
|
|
"success": true,
|
|
"translation_m": 3.132972747129673e-08,
|
|
"rotation_deg": 1.5835217811052665e-07
|
|
},
|
|
{
|
|
"cost": 165.0591528792959,
|
|
"success": true,
|
|
"translation_m": 5.032571008409966e-08,
|
|
"rotation_deg": 6.019987077228086e-07
|
|
},
|
|
{
|
|
"cost": 165.0591528792966,
|
|
"success": true,
|
|
"translation_m": 5.0134365128719625e-08,
|
|
"rotation_deg": 6.036593761377996e-07
|
|
},
|
|
{
|
|
"cost": 165.059152879271,
|
|
"success": true,
|
|
"translation_m": 4.0000992845476256e-09,
|
|
"rotation_deg": 5.9504483976085874e-08
|
|
},
|
|
{
|
|
"cost": 165.0591528792741,
|
|
"success": true,
|
|
"translation_m": 1.71650324878148e-08,
|
|
"rotation_deg": 2.1433774624387286e-07
|
|
},
|
|
{
|
|
"cost": 165.059152879271,
|
|
"success": true,
|
|
"translation_m": 3.8510946546090955e-09,
|
|
"rotation_deg": 5.7484467409642816e-08
|
|
},
|
|
{
|
|
"cost": 165.05915287927274,
|
|
"success": true,
|
|
"translation_m": 1.2609667860271796e-08,
|
|
"rotation_deg": 1.3972470982253386e-07
|
|
},
|
|
{
|
|
"cost": 165.05915287929693,
|
|
"success": true,
|
|
"translation_m": 5.0359957454032455e-08,
|
|
"rotation_deg": 6.053505895170472e-07
|
|
},
|
|
{
|
|
"cost": 165.05915287927098,
|
|
"success": true,
|
|
"translation_m": 0.0,
|
|
"rotation_deg": 0.0
|
|
},
|
|
{
|
|
"cost": 165.0591528792721,
|
|
"success": true,
|
|
"translation_m": 1.123025431013551e-08,
|
|
"rotation_deg": 3.014422244971439e-08
|
|
},
|
|
{
|
|
"cost": 165.0591528792711,
|
|
"success": true,
|
|
"translation_m": 2.4200230224271075e-09,
|
|
"rotation_deg": 6.741856490734345e-08
|
|
}
|
|
]
|
|
},
|
|
"bootstrap": {
|
|
"runs": 100,
|
|
"order": [
|
|
"x_m",
|
|
"y_m",
|
|
"z_m",
|
|
"roll_deg",
|
|
"pitch_deg",
|
|
"yaw_deg"
|
|
],
|
|
"std": [
|
|
0.0030749822448559927,
|
|
0.0034380377435498433,
|
|
0.0016315909218529902,
|
|
0.07586073216888294,
|
|
0.07187134364073751,
|
|
0.11146702425116647
|
|
],
|
|
"p025": [
|
|
1.292007464312339,
|
|
-0.006797525226093335,
|
|
0.701848741787294,
|
|
-0.9789682101604196,
|
|
1.2351532937224006,
|
|
-1.211682139162798
|
|
],
|
|
"p975": [
|
|
1.3029347232892419,
|
|
0.005407572756192536,
|
|
0.7084594772174496,
|
|
-0.705679642362121,
|
|
1.5258122853862286,
|
|
-0.8045746213351143
|
|
]
|
|
}
|
|
} |