完善 LiDAR–双天线 RTK 手眼标定仓库：补充旧式及多传感器数据导出、small_gicp/Open3D GICP 标定、结果复核与3D可视化流程，并整理三批数据和标定结果说明。
This commit is contained in:
lichun.qu
@@ -0,0 +1,334 @@
|
||||
{
|
||||
"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.3003760202954853,
|
||||
-0.001706690964618711,
|
||||
0.7048770452870675
|
||||
],
|
||||
"rotation_rpy_deg_xyz": [
|
||||
-0.7918916173570606,
|
||||
1.3938232102436765,
|
||||
-0.9707426305626278
|
||||
],
|
||||
"quaternion_xyzw": [
|
||||
-0.006806709954738454,
|
||||
0.01222091143708808,
|
||||
-0.008386347182892065,
|
||||
0.9998669847555559
|
||||
],
|
||||
"matrix_4x4": [
|
||||
[
|
||||
0.9995606370091497,
|
||||
0.016604094942673456,
|
||||
0.024552738604839263,
|
||||
1.3003760202954853
|
||||
],
|
||||
[
|
||||
-0.016936831740812692,
|
||||
0.9997666757610401,
|
||||
0.01340663150469432,
|
||||
-0.001706690964618711
|
||||
],
|
||||
[
|
||||
-0.02432440487342451,
|
||||
-0.013816586729505535,
|
||||
0.9996086360464778,
|
||||
0.7048770452870675
|
||||
],
|
||||
[
|
||||
0.0,
|
||||
0.0,
|
||||
0.0,
|
||||
1.0
|
||||
]
|
||||
],
|
||||
"estimation": {
|
||||
"stations": 34,
|
||||
"pairs": 26,
|
||||
"residuals": {
|
||||
"pairs": 26,
|
||||
"translation_m": {
|
||||
"rms": 0.11761746401526753,
|
||||
"median": 0.05973702338495346,
|
||||
"p90": 0.12346154791373619,
|
||||
"p95": 0.2642880752048252,
|
||||
"max": 0.38818289084930874
|
||||
},
|
||||
"rotation_deg": {
|
||||
"rms": 1.2425719632195558,
|
||||
"median": 0.7690245702483323,
|
||||
"p90": 1.8136122342812846,
|
||||
"p95": 1.9548737964733964,
|
||||
"max": 4.332147922413344
|
||||
},
|
||||
"per_pair": [
|
||||
{
|
||||
"pair_index": 0,
|
||||
"translation_m": 0.04628122614893134,
|
||||
"rotation_deg": 0.6982246240615032
|
||||
},
|
||||
{
|
||||
"pair_index": 1,
|
||||
"translation_m": 0.060020104078054665,
|
||||
"rotation_deg": 0.3948778403656006
|
||||
},
|
||||
{
|
||||
"pair_index": 2,
|
||||
"translation_m": 0.10360591701372288,
|
||||
"rotation_deg": 0.30363546700066535
|
||||
},
|
||||
{
|
||||
"pair_index": 3,
|
||||
"translation_m": 0.06188990107567784,
|
||||
"rotation_deg": 0.5542261589736583
|
||||
},
|
||||
{
|
||||
"pair_index": 4,
|
||||
"translation_m": 0.02429424053491548,
|
||||
"rotation_deg": 0.5086436052507228
|
||||
},
|
||||
{
|
||||
"pair_index": 5,
|
||||
"translation_m": 0.06697411809016678,
|
||||
"rotation_deg": 0.7794510927257128
|
||||
},
|
||||
{
|
||||
"pair_index": 6,
|
||||
"translation_m": 0.012085958852730979,
|
||||
"rotation_deg": 0.7997166092197476
|
||||
},
|
||||
{
|
||||
"pair_index": 7,
|
||||
"translation_m": 0.04528858471141819,
|
||||
"rotation_deg": 0.868879957697597
|
||||
},
|
||||
{
|
||||
"pair_index": 8,
|
||||
"translation_m": 0.05426127100895971,
|
||||
"rotation_deg": 1.8644817833901326
|
||||
},
|
||||
{
|
||||
"pair_index": 9,
|
||||
"translation_m": 0.12845158967421863,
|
||||
"rotation_deg": 1.9850044675011511
|
||||
},
|
||||
{
|
||||
"pair_index": 10,
|
||||
"translation_m": 0.06743761428527982,
|
||||
"rotation_deg": 0.23695300739340452
|
||||
},
|
||||
{
|
||||
"pair_index": 11,
|
||||
"translation_m": 0.060359774544132216,
|
||||
"rotation_deg": 0.3380187067759931
|
||||
},
|
||||
{
|
||||
"pair_index": 12,
|
||||
"translation_m": 0.03420362550416907,
|
||||
"rotation_deg": 0.49547670606543825
|
||||
},
|
||||
{
|
||||
"pair_index": 13,
|
||||
"translation_m": 0.059453942691852245,
|
||||
"rotation_deg": 0.6142581264077737
|
||||
},
|
||||
{
|
||||
"pair_index": 14,
|
||||
"translation_m": 0.048234437308639966,
|
||||
"rotation_deg": 1.7627426851724366
|
||||
},
|
||||
{
|
||||
"pair_index": 15,
|
||||
"translation_m": 0.0572558948305829,
|
||||
"rotation_deg": 0.8826512445544471
|
||||
},
|
||||
{
|
||||
"pair_index": 16,
|
||||
"translation_m": 0.11847150615325375,
|
||||
"rotation_deg": 4.332147922413344
|
||||
},
|
||||
{
|
||||
"pair_index": 17,
|
||||
"translation_m": 0.05084797298915324,
|
||||
"rotation_deg": 0.9691629612561474
|
||||
},
|
||||
{
|
||||
"pair_index": 18,
|
||||
"translation_m": 0.03403536387594384,
|
||||
"rotation_deg": 0.9311969881819248
|
||||
},
|
||||
{
|
||||
"pair_index": 19,
|
||||
"translation_m": 0.05397038183164141,
|
||||
"rotation_deg": 0.5108403673418249
|
||||
},
|
||||
{
|
||||
"pair_index": 20,
|
||||
"translation_m": 0.10079710084559501,
|
||||
"rotation_deg": 0.9132399116834199
|
||||
},
|
||||
{
|
||||
"pair_index": 21,
|
||||
"translation_m": 0.0245653967740859,
|
||||
"rotation_deg": 0.29258746424545673
|
||||
},
|
||||
{
|
||||
"pair_index": 22,
|
||||
"translation_m": 0.06599237622687693,
|
||||
"rotation_deg": 1.130391129168243
|
||||
},
|
||||
{
|
||||
"pair_index": 23,
|
||||
"translation_m": 0.30956690371502743,
|
||||
"rotation_deg": 0.7585980477709516
|
||||
},
|
||||
{
|
||||
"pair_index": 24,
|
||||
"translation_m": 0.38818289084930874,
|
||||
"rotation_deg": 0.6792102747820554
|
||||
},
|
||||
{
|
||||
"pair_index": 25,
|
||||
"translation_m": 0.10874622325422871,
|
||||
"rotation_deg": 0.8215202229484776
|
||||
}
|
||||
]
|
||||
}
|
||||
},
|
||||
"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.00880269284499636,
|
||||
0.00901239388348182,
|
||||
0.0047231303576790815
|
||||
],
|
||||
"rotation_deg": [
|
||||
0.08002846787949729,
|
||||
0.07607548557648909,
|
||||
0.16438009658312316
|
||||
],
|
||||
"warning": "conditional local estimate; bootstrap is the primary stability check"
|
||||
},
|
||||
"weighted_jacobian_condition_number": 7.44293047593025,
|
||||
"solver_multistart": {
|
||||
"runs": 12,
|
||||
"candidates_relative_to_best": [
|
||||
{
|
||||
"cost": 125.63045335315196,
|
||||
"success": true,
|
||||
"translation_m": 2.6261422580681395e-09,
|
||||
"rotation_deg": 5.414246532613018e-08
|
||||
},
|
||||
{
|
||||
"cost": 125.63045335315196,
|
||||
"success": true,
|
||||
"translation_m": 1.4824807208067879e-09,
|
||||
"rotation_deg": 1.72860210982948e-08
|
||||
},
|
||||
{
|
||||
"cost": 125.63045335315223,
|
||||
"success": true,
|
||||
"translation_m": 2.630839730785566e-09,
|
||||
"rotation_deg": 6.406686644059802e-08
|
||||
},
|
||||
{
|
||||
"cost": 125.63045335315202,
|
||||
"success": true,
|
||||
"translation_m": 3.4171046507681323e-09,
|
||||
"rotation_deg": 6.031782751294924e-08
|
||||
},
|
||||
{
|
||||
"cost": 125.63045335315198,
|
||||
"success": true,
|
||||
"translation_m": 1.024465800095368e-09,
|
||||
"rotation_deg": 5.593612335539163e-09
|
||||
},
|
||||
{
|
||||
"cost": 125.63045335315205,
|
||||
"success": true,
|
||||
"translation_m": 3.3380353081804456e-09,
|
||||
"rotation_deg": 5.989779005616406e-08
|
||||
},
|
||||
{
|
||||
"cost": 125.63045335315195,
|
||||
"success": true,
|
||||
"translation_m": 1.3390324575379226e-09,
|
||||
"rotation_deg": 1.669449907197552e-08
|
||||
},
|
||||
{
|
||||
"cost": 125.63045335315194,
|
||||
"success": true,
|
||||
"translation_m": 9.664926809065912e-10,
|
||||
"rotation_deg": 1.725605645088929e-08
|
||||
},
|
||||
{
|
||||
"cost": 125.63045335315195,
|
||||
"success": true,
|
||||
"translation_m": 1.1236440604027455e-09,
|
||||
"rotation_deg": 8.844155186013785e-09
|
||||
},
|
||||
{
|
||||
"cost": 125.63045335315957,
|
||||
"success": true,
|
||||
"translation_m": 4.0330699471902714e-08,
|
||||
"rotation_deg": 2.7706147186959257e-07
|
||||
},
|
||||
{
|
||||
"cost": 125.63045335315196,
|
||||
"success": true,
|
||||
"translation_m": 1.1516332665838399e-10,
|
||||
"rotation_deg": 2.767718681568013e-09
|
||||
},
|
||||
{
|
||||
"cost": 125.63045335315192,
|
||||
"success": true,
|
||||
"translation_m": 2.220446049250313e-16,
|
||||
"rotation_deg": 0.0
|
||||
}
|
||||
]
|
||||
},
|
||||
"bootstrap": {
|
||||
"runs": 100,
|
||||
"order": [
|
||||
"x_m",
|
||||
"y_m",
|
||||
"z_m",
|
||||
"roll_deg",
|
||||
"pitch_deg",
|
||||
"yaw_deg"
|
||||
],
|
||||
"std": [
|
||||
0.004332764631777773,
|
||||
0.0052124106362270465,
|
||||
0.002294080818689292,
|
||||
0.09999053340933307,
|
||||
0.10013087210161215,
|
||||
0.1488688877903013
|
||||
],
|
||||
"p025": [
|
||||
1.2918362278137754,
|
||||
-0.009531330977586527,
|
||||
0.7011199682224338,
|
||||
-0.9599898042168808,
|
||||
1.2066688822355272,
|
||||
-1.2617485460367455
|
||||
],
|
||||
"p975": [
|
||||
1.3082553293462966,
|
||||
0.009443875945124016,
|
||||
0.7092373306937458,
|
||||
-0.5988363907444886,
|
||||
1.5590218787244785,
|
||||
-0.7051603064062103
|
||||
]
|
||||
}
|
||||
}
|
||||
Reference in New Issue
Block a user