Files
appRobotHoming/test/homing/20260616_135403/cam0_camera_pose.json
2026-06-16 16:01:32 +02:00

341 lines
7.8 KiB
JSON

{
"schema_version": "1.0",
"created_utc": "2026-06-16T13:54:06Z",
"source": {
"detection_json": "/app/data/homing/20260616_135403/cam0_aruco_detection.json",
"robot_json": "/app/scripts/robot_1781069752019.json"
},
"camera": {
"camera_id": "cam0",
"camera_matrix": [
[
1424.7584228515625,
0.0,
635.95947265625
],
[
0.0,
1421.5770263671875,
482.1744384765625
],
[
0.0,
0.0,
1.0
]
],
"distortion_coefficients": [
0.05634751915931702,
0.33765655755996704,
0.002130246954038739,
-0.004022662527859211,
-1.182201862335205
]
},
"estimation": {
"method": "single_camera_marker_center_lm",
"description": "Rigid init from per-marker pose estimates, followed by LM on normalized marker-center reprojection residuals.",
"marker_size_m": 0.025,
"num_used_markers": 10,
"used_marker_ids": [
97,
96,
47,
54,
62,
85,
105,
102,
57,
59
],
"history": {
"iters": [
0,
1,
2,
3
],
"rms": [
0.00297150987668363,
0.0002461940604502246,
0.00022805923674527905,
0.0002280590512991819
],
"lambda": [
0.001,
0.0005,
0.00025,
0.000125
]
},
"residual_rms_px": 0.46309374817158255,
"residual_median_px": 0.4260383419221694,
"residual_max_px": 0.8110471927822179,
"sigma2_normalized": 7.430132982639082e-08
},
"camera_pose": {
"world_to_camera": {
"rotation_matrix": [
[
-0.4332370162010193,
-0.8998357057571411,
-0.0510035902261734
],
[
-0.3002627193927765,
0.19745959341526031,
-0.9331945180892944
],
[
0.8497928977012634,
-0.3889799416065216,
-0.3557339012622833
]
],
"translation_m": [
-0.03059636428952217,
0.3266908526420593,
0.29203665256500244
],
"rvec_rad": [
1.119242299194618,
-1.8525955991141305,
1.2330935082472974
]
},
"camera_in_world": {
"position_m": [
-0.16333305835723877,
0.021556459367275238,
0.4071928858757019
],
"position_mm": [
-163.3330535888672,
21.556459426879883,
407.19287109375
],
"orientation_deg": {
"roll": -132.44384765625,
"pitch": -58.189151763916016,
"yaw": -145.275390625
}
},
"uncertainty": {
"pose_covariance_6x6": [
[
7.227588006323877e-07,
2.9303920656916736e-08,
5.384671063273605e-07,
7.605882237904871e-10,
1.680441654688309e-08,
1.1426051605294841e-07
],
[
2.930392065691868e-08,
1.1003513442219108e-06,
5.565209626759047e-07,
-2.652519045621451e-07,
-5.340853554657626e-07,
-5.226176231579231e-07
],
[
5.384671063273979e-07,
5.565209626759146e-07,
2.319354687285001e-06,
2.551507946650087e-07,
-5.787929262591489e-07,
-2.912661805714844e-07
],
[
7.605882237987269e-10,
-2.652519045621417e-07,
2.551507946650191e-07,
1.5790856417639881e-07,
5.5121833627792086e-08,
1.1160408874634451e-07
],
[
1.6804416546875622e-08,
-5.340853554657651e-07,
-5.787929262591501e-07,
5.512183362779438e-08,
3.44928133359627e-07,
3.443723010303455e-07
],
[
1.1426051605294808e-07,
-5.226176231579226e-07,
-2.9126618057147984e-07,
1.1160408874634589e-07,
3.443723010303443e-07,
5.551732669825882e-07
]
],
"parameter_std": {
"rvec_std_deg": [
0.04871013426631951,
0.06010191660883742,
0.0872581932849214
],
"tvec_std_m": [
0.00039737710575270794,
0.0005873058260903147,
0.0007450995013973558
]
},
"camera_center_std_m": [
0.0004380589515914775,
0.0008600663979125257,
0.0008421001328967693
],
"camera_center_std_mm": [
0.4380589515914775,
0.8600663979125257,
0.8421001328967692
],
"orientation_std_deg": {
"roll": 0.09163914629805689,
"pitch": 0.04946121940390761,
"yaw": 0.07431542255357135
}
}
},
"observations": {
"markers": [
{
"marker_id": 97,
"observed_center_px": [
969.75,
871.25
],
"projected_center_px": [
969.1539916992188,
871.4326782226562
],
"reprojection_error_px": 0.623375671351553,
"confidence": 0.8722907081171155
},
{
"marker_id": 96,
"observed_center_px": [
590.5,
908.0
],
"projected_center_px": [
590.39501953125,
907.824951171875
],
"reprojection_error_px": 0.20411514164046116,
"confidence": 0.39473089942559886
},
{
"marker_id": 47,
"observed_center_px": [
796.75,
872.75
],
"projected_center_px": [
797.0742797851562,
872.3286743164062
],
"reprojection_error_px": 0.5316697383872101,
"confidence": 0.7545277738933825
},
{
"marker_id": 54,
"observed_center_px": [
874.0,
847.75
],
"projected_center_px": [
874.1162109375,
847.8966674804688
],
"reprojection_error_px": 0.18712651287746498,
"confidence": 0.7740240946534177
},
{
"marker_id": 62,
"observed_center_px": [
541.0,
875.5
],
"projected_center_px": [
541.011474609375,
875.953857421875
],
"reprojection_error_px": 0.4540024515917624,
"confidence": 0.5296335300596272
},
{
"marker_id": 85,
"observed_center_px": [
691.5,
715.0
],
"projected_center_px": [
692.12548828125,
714.4837036132812
],
"reprojection_error_px": 0.8110471927822179,
"confidence": 0.3363291739196003
},
{
"marker_id": 105,
"observed_center_px": [
607.25,
720.0
],
"projected_center_px": [
607.2650756835938,
720.0259399414062
],
"reprojection_error_px": 0.03000261315249967,
"confidence": 0.29801288537668325
},
{
"marker_id": 102,
"observed_center_px": [
469.0,
653.75
],
"projected_center_px": [
468.6142272949219,
653.6883544921875
],
"reprojection_error_px": 0.390667055965505,
"confidence": 0.17455168671479393
},
{
"marker_id": 57,
"observed_center_px": [
691.0,
629.75
],
"projected_center_px": [
691.397216796875,
630.0008544921875
],
"reprojection_error_px": 0.46979693482427437,
"confidence": 0.20110305644698828
},
{
"marker_id": 59,
"observed_center_px": [
561.0,
647.0
],
"projected_center_px": [
560.620849609375,
647.1212768554688
],
"reprojection_error_px": 0.39807423225257643,
"confidence": 0.20130952501608368
}
]
},
"qa": {
"sanity_notes": []
}
}