534 lines
14 KiB
JSON
534 lines
14 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.2978831677200011,
|
|
-0.0030997734098957433,
|
|
0.7217892226151688
|
|
],
|
|
"rotation_rpy_deg_xyz": [
|
|
-0.7572070226288585,
|
|
1.1460424368859559,
|
|
-0.8797812288284186
|
|
],
|
|
"quaternion_xyzw": [
|
|
-0.006530524361500762,
|
|
0.01005115598038874,
|
|
-0.007610830022211968,
|
|
0.9998991958099549
|
|
],
|
|
"matrix_4x4": [
|
|
[
|
|
0.9996820990596618,
|
|
0.015088846999329667,
|
|
0.020199690985244836,
|
|
1.2978831677200011
|
|
],
|
|
[
|
|
-0.01535140427529437,
|
|
0.9997988550358736,
|
|
0.012906736835176902,
|
|
-0.0030997734098957433
|
|
],
|
|
[
|
|
-0.020000880141759644,
|
|
-0.013212727393950824,
|
|
0.9997126530300434,
|
|
0.7217892226151688
|
|
],
|
|
[
|
|
0.0,
|
|
0.0,
|
|
0.0,
|
|
1.0
|
|
]
|
|
],
|
|
"estimation": {
|
|
"stations": 38,
|
|
"pairs": 66,
|
|
"residuals": {
|
|
"pairs": 66,
|
|
"translation_m": {
|
|
"rms": 0.10017183831403174,
|
|
"median": 0.055359414994267414,
|
|
"p90": 0.15842638830193137,
|
|
"p95": 0.2228212283177476,
|
|
"max": 0.3308905173432371
|
|
},
|
|
"rotation_deg": {
|
|
"rms": 1.011529772202344,
|
|
"median": 0.80406471347537,
|
|
"p90": 1.4897684651925762,
|
|
"p95": 1.743501596940947,
|
|
"max": 2.0866296585079986
|
|
},
|
|
"per_pair": [
|
|
{
|
|
"pair_index": 0,
|
|
"translation_m": 0.08037293687095128,
|
|
"rotation_deg": 0.5606213555410943
|
|
},
|
|
{
|
|
"pair_index": 1,
|
|
"translation_m": 0.13688783822315873,
|
|
"rotation_deg": 0.5385985764755513
|
|
},
|
|
{
|
|
"pair_index": 2,
|
|
"translation_m": 0.1161820533771873,
|
|
"rotation_deg": 0.6051501049087227
|
|
},
|
|
{
|
|
"pair_index": 3,
|
|
"translation_m": 0.06274731030725329,
|
|
"rotation_deg": 0.43240094308199595
|
|
},
|
|
{
|
|
"pair_index": 4,
|
|
"translation_m": 0.05401417992581746,
|
|
"rotation_deg": 0.5598851592535787
|
|
},
|
|
{
|
|
"pair_index": 5,
|
|
"translation_m": 0.031474943657373466,
|
|
"rotation_deg": 0.4777215600802768
|
|
},
|
|
{
|
|
"pair_index": 6,
|
|
"translation_m": 0.02358754528130127,
|
|
"rotation_deg": 0.31065781541529597
|
|
},
|
|
{
|
|
"pair_index": 7,
|
|
"translation_m": 0.07821720458579819,
|
|
"rotation_deg": 0.8327360477136897
|
|
},
|
|
{
|
|
"pair_index": 8,
|
|
"translation_m": 0.13242931760456017,
|
|
"rotation_deg": 0.7104180024890483
|
|
},
|
|
{
|
|
"pair_index": 9,
|
|
"translation_m": 0.06337205097891703,
|
|
"rotation_deg": 0.7783419276431949
|
|
},
|
|
{
|
|
"pair_index": 10,
|
|
"translation_m": 0.09374967709473093,
|
|
"rotation_deg": 1.0032646553341338
|
|
},
|
|
{
|
|
"pair_index": 11,
|
|
"translation_m": 0.03473040865260945,
|
|
"rotation_deg": 0.38999250019936094
|
|
},
|
|
{
|
|
"pair_index": 12,
|
|
"translation_m": 0.21059850723479812,
|
|
"rotation_deg": 0.3446682830121482
|
|
},
|
|
{
|
|
"pair_index": 13,
|
|
"translation_m": 0.19573146558983065,
|
|
"rotation_deg": 0.48095280922563605
|
|
},
|
|
{
|
|
"pair_index": 14,
|
|
"translation_m": 0.1323566970626505,
|
|
"rotation_deg": 0.7201707943590688
|
|
},
|
|
{
|
|
"pair_index": 15,
|
|
"translation_m": 0.12966351135913337,
|
|
"rotation_deg": 1.112776940821149
|
|
},
|
|
{
|
|
"pair_index": 16,
|
|
"translation_m": 0.05614712317985888,
|
|
"rotation_deg": 0.875368334260281
|
|
},
|
|
{
|
|
"pair_index": 17,
|
|
"translation_m": 0.07051356442391056,
|
|
"rotation_deg": 0.6787378054467239
|
|
},
|
|
{
|
|
"pair_index": 18,
|
|
"translation_m": 0.00234867626016906,
|
|
"rotation_deg": 0.6239120141422153
|
|
},
|
|
{
|
|
"pair_index": 19,
|
|
"translation_m": 0.06798198251653766,
|
|
"rotation_deg": 1.002748878489142
|
|
},
|
|
{
|
|
"pair_index": 20,
|
|
"translation_m": 0.06408705260318404,
|
|
"rotation_deg": 0.03962823745578253
|
|
},
|
|
{
|
|
"pair_index": 21,
|
|
"translation_m": 0.112944365872764,
|
|
"rotation_deg": 1.0217086690617905
|
|
},
|
|
{
|
|
"pair_index": 22,
|
|
"translation_m": 0.052992189070368054,
|
|
"rotation_deg": 0.9852776192856918
|
|
},
|
|
{
|
|
"pair_index": 23,
|
|
"translation_m": 0.15367415365164572,
|
|
"rotation_deg": 1.6994783049152902
|
|
},
|
|
{
|
|
"pair_index": 24,
|
|
"translation_m": 0.034245918976706625,
|
|
"rotation_deg": 0.6364964475716594
|
|
},
|
|
{
|
|
"pair_index": 25,
|
|
"translation_m": 0.032447856067877326,
|
|
"rotation_deg": 1.0563370884814496
|
|
},
|
|
{
|
|
"pair_index": 26,
|
|
"translation_m": 0.013423581617645036,
|
|
"rotation_deg": 2.0866296585079986
|
|
},
|
|
{
|
|
"pair_index": 27,
|
|
"translation_m": 0.020771076323520654,
|
|
"rotation_deg": 0.38738877042810915
|
|
},
|
|
{
|
|
"pair_index": 28,
|
|
"translation_m": 0.025006531842362605,
|
|
"rotation_deg": 1.52954100014841
|
|
},
|
|
{
|
|
"pair_index": 29,
|
|
"translation_m": 0.24776379251997158,
|
|
"rotation_deg": 0.5631330497861866
|
|
},
|
|
{
|
|
"pair_index": 30,
|
|
"translation_m": 0.03125984364955898,
|
|
"rotation_deg": 1.3670046215070957
|
|
},
|
|
{
|
|
"pair_index": 31,
|
|
"translation_m": 0.23303779095818136,
|
|
"rotation_deg": 0.6816682778063402
|
|
},
|
|
{
|
|
"pair_index": 32,
|
|
"translation_m": 0.3308905173432371,
|
|
"rotation_deg": 0.35773823775063585
|
|
},
|
|
{
|
|
"pair_index": 33,
|
|
"translation_m": 0.16317862295221702,
|
|
"rotation_deg": 1.883393614450365
|
|
},
|
|
{
|
|
"pair_index": 34,
|
|
"translation_m": 0.22689546867873073,
|
|
"rotation_deg": 1.1173958780054432
|
|
},
|
|
{
|
|
"pair_index": 35,
|
|
"translation_m": 0.11481327905632552,
|
|
"rotation_deg": 0.9531859192751095
|
|
},
|
|
{
|
|
"pair_index": 36,
|
|
"translation_m": 0.03799144229981835,
|
|
"rotation_deg": 0.7744523894118182
|
|
},
|
|
{
|
|
"pair_index": 37,
|
|
"translation_m": 0.05628293924136787,
|
|
"rotation_deg": 1.14782377649109
|
|
},
|
|
{
|
|
"pair_index": 38,
|
|
"translation_m": 0.044190715841938503,
|
|
"rotation_deg": 0.6522697817009423
|
|
},
|
|
{
|
|
"pair_index": 39,
|
|
"translation_m": 0.01566159386457093,
|
|
"rotation_deg": 0.21165082671261798
|
|
},
|
|
{
|
|
"pair_index": 40,
|
|
"translation_m": 0.025885925200718387,
|
|
"rotation_deg": 1.758176027616166
|
|
},
|
|
{
|
|
"pair_index": 41,
|
|
"translation_m": 0.05672466093666094,
|
|
"rotation_deg": 0.656889656854011
|
|
},
|
|
{
|
|
"pair_index": 42,
|
|
"translation_m": 0.04499649801025904,
|
|
"rotation_deg": 1.202397214867585
|
|
},
|
|
{
|
|
"pair_index": 43,
|
|
"translation_m": 0.05457170680867596,
|
|
"rotation_deg": 1.0831506943354967
|
|
},
|
|
{
|
|
"pair_index": 44,
|
|
"translation_m": 0.061259367696104086,
|
|
"rotation_deg": 0.4788495792916977
|
|
},
|
|
{
|
|
"pair_index": 45,
|
|
"translation_m": 0.11550019477035034,
|
|
"rotation_deg": 0.4484966984286178
|
|
},
|
|
{
|
|
"pair_index": 46,
|
|
"translation_m": 0.11728514823414202,
|
|
"rotation_deg": 0.829787499307545
|
|
},
|
|
{
|
|
"pair_index": 47,
|
|
"translation_m": 0.05724708891657523,
|
|
"rotation_deg": 0.13864261724965515
|
|
},
|
|
{
|
|
"pair_index": 48,
|
|
"translation_m": 0.08594624077085096,
|
|
"rotation_deg": 0.5654259879584598
|
|
},
|
|
{
|
|
"pair_index": 49,
|
|
"translation_m": 0.03620565055727226,
|
|
"rotation_deg": 0.7322933697368991
|
|
},
|
|
{
|
|
"pair_index": 50,
|
|
"translation_m": 0.04214151304995954,
|
|
"rotation_deg": 1.4499959302367427
|
|
},
|
|
{
|
|
"pair_index": 51,
|
|
"translation_m": 0.028423032063821733,
|
|
"rotation_deg": 1.4083884036448566
|
|
},
|
|
{
|
|
"pair_index": 52,
|
|
"translation_m": 0.07837351471415148,
|
|
"rotation_deg": 2.059047791320455
|
|
},
|
|
{
|
|
"pair_index": 53,
|
|
"translation_m": 0.028769288969574303,
|
|
"rotation_deg": 1.678230006332038
|
|
},
|
|
{
|
|
"pair_index": 54,
|
|
"translation_m": 0.017809796347028943,
|
|
"rotation_deg": 1.156650317229778
|
|
},
|
|
{
|
|
"pair_index": 55,
|
|
"translation_m": 0.016503937937620585,
|
|
"rotation_deg": 1.0883396698886323
|
|
},
|
|
{
|
|
"pair_index": 56,
|
|
"translation_m": 0.06654456279831698,
|
|
"rotation_deg": 1.4361320254246386
|
|
},
|
|
{
|
|
"pair_index": 57,
|
|
"translation_m": 0.047435323978454284,
|
|
"rotation_deg": 0.5969029690601318
|
|
},
|
|
{
|
|
"pair_index": 58,
|
|
"translation_m": 0.03126348405840702,
|
|
"rotation_deg": 1.1168540542357488
|
|
},
|
|
{
|
|
"pair_index": 59,
|
|
"translation_m": 0.02474086331243135,
|
|
"rotation_deg": 1.3807442010221649
|
|
},
|
|
{
|
|
"pair_index": 60,
|
|
"translation_m": 0.030093157854206205,
|
|
"rotation_deg": 1.4167630603035772
|
|
},
|
|
{
|
|
"pair_index": 61,
|
|
"translation_m": 0.0541740507536005,
|
|
"rotation_deg": 0.698365025436339
|
|
},
|
|
{
|
|
"pair_index": 62,
|
|
"translation_m": 0.022134680709029235,
|
|
"rotation_deg": 0.2658404010324305
|
|
},
|
|
{
|
|
"pair_index": 63,
|
|
"translation_m": 0.029045352917775814,
|
|
"rotation_deg": 1.1570185249880154
|
|
},
|
|
{
|
|
"pair_index": 64,
|
|
"translation_m": 0.027405495714480508,
|
|
"rotation_deg": 1.03451592246849
|
|
},
|
|
{
|
|
"pair_index": 65,
|
|
"translation_m": 0.026462755506179093,
|
|
"rotation_deg": 1.2477273813337815
|
|
}
|
|
]
|
|
}
|
|
},
|
|
"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.004882663700530851,
|
|
0.005223180397875539,
|
|
0.004609821026450364
|
|
],
|
|
"rotation_deg": [
|
|
0.05337730845362286,
|
|
0.05101978444118743,
|
|
0.13461471349060455
|
|
],
|
|
"warning": "conditional local estimate; bootstrap is the primary stability check"
|
|
},
|
|
"weighted_jacobian_condition_number": 6.280132943609949,
|
|
"solver_multistart": {
|
|
"runs": 12,
|
|
"candidates_relative_to_best": [
|
|
{
|
|
"cost": 257.9158465208353,
|
|
"success": true,
|
|
"translation_m": 1.5339146489710882e-09,
|
|
"rotation_deg": 8.769019455279312e-08
|
|
},
|
|
{
|
|
"cost": 257.915846520835,
|
|
"success": true,
|
|
"translation_m": 1.6096332607990603e-10,
|
|
"rotation_deg": 3.2573047951731743e-09
|
|
},
|
|
{
|
|
"cost": 257.915846520835,
|
|
"success": true,
|
|
"translation_m": 1.7670480374755598e-10,
|
|
"rotation_deg": 6.1834270102153095e-09
|
|
},
|
|
{
|
|
"cost": 257.915846520835,
|
|
"success": true,
|
|
"translation_m": 4.1405468581662865e-10,
|
|
"rotation_deg": 3.068020689667501e-08
|
|
},
|
|
{
|
|
"cost": 257.9158465208356,
|
|
"success": true,
|
|
"translation_m": 2.8335867565734006e-09,
|
|
"rotation_deg": 1.5660913277854904e-07
|
|
},
|
|
{
|
|
"cost": 257.915846520835,
|
|
"success": true,
|
|
"translation_m": 1.0113279249597898e-10,
|
|
"rotation_deg": 1.1726291770865867e-09
|
|
},
|
|
{
|
|
"cost": 257.91584652083503,
|
|
"success": true,
|
|
"translation_m": 8.073503715426879e-10,
|
|
"rotation_deg": 4.276975901573228e-08
|
|
},
|
|
{
|
|
"cost": 257.91584652083486,
|
|
"success": true,
|
|
"translation_m": 3.469446951953614e-18,
|
|
"rotation_deg": 0.0
|
|
},
|
|
{
|
|
"cost": 257.91584652083515,
|
|
"success": true,
|
|
"translation_m": 1.698393313088208e-09,
|
|
"rotation_deg": 8.683351386297902e-08
|
|
},
|
|
{
|
|
"cost": 257.91584652083503,
|
|
"success": true,
|
|
"translation_m": 1.831365187011624e-10,
|
|
"rotation_deg": 1.6896050804471163e-09
|
|
},
|
|
{
|
|
"cost": 257.91584652083503,
|
|
"success": true,
|
|
"translation_m": 1.2207922904627949e-09,
|
|
"rotation_deg": 2.6207051319974274e-08
|
|
},
|
|
{
|
|
"cost": 257.9158465208349,
|
|
"success": true,
|
|
"translation_m": 2.9844783853630704e-10,
|
|
"rotation_deg": 1.1466486750928911e-08
|
|
}
|
|
]
|
|
},
|
|
"bootstrap": {
|
|
"runs": 100,
|
|
"order": [
|
|
"x_m",
|
|
"y_m",
|
|
"z_m",
|
|
"roll_deg",
|
|
"pitch_deg",
|
|
"yaw_deg"
|
|
],
|
|
"std": [
|
|
0.0020832827985508263,
|
|
0.002063603632322515,
|
|
0.001427746471392659,
|
|
0.07576290622767821,
|
|
0.06304875844333606,
|
|
0.07843172452171372
|
|
],
|
|
"p025": [
|
|
1.2941517658812944,
|
|
-0.0068139260683400035,
|
|
0.7194879609149559,
|
|
-0.932759562453139,
|
|
1.0361273609600192,
|
|
-1.0172648960899553
|
|
],
|
|
"p975": [
|
|
1.303011833178259,
|
|
0.0009615093863316334,
|
|
0.7242819230641808,
|
|
-0.6514715860744424,
|
|
1.2471483979735007,
|
|
-0.7328998428204786
|
|
]
|
|
}
|
|
} |