635 lines
14 KiB
JSON
635 lines
14 KiB
JSON
{
|
|
"schema_version": "1.0",
|
|
"created_utc": "2026-06-16T13:54:13Z",
|
|
"source": {
|
|
"detection_json": "/app/data/homing/20260616_135403/cam1_aruco_detection.json",
|
|
"robot_json": "/app/scripts/robot_1781069752019.json"
|
|
},
|
|
"camera": {
|
|
"camera_id": "cam1",
|
|
"camera_matrix": [
|
|
[
|
|
1367.5723876953125,
|
|
0.0,
|
|
672.1165771484375
|
|
],
|
|
[
|
|
0.0,
|
|
1372.3011474609375,
|
|
445.8396911621094
|
|
],
|
|
[
|
|
0.0,
|
|
0.0,
|
|
1.0
|
|
]
|
|
],
|
|
"distortion_coefficients": [
|
|
0.01016925647854805,
|
|
0.7656787633895874,
|
|
-0.0031530377455055714,
|
|
-0.00288817984983325,
|
|
-2.490830183029175
|
|
]
|
|
},
|
|
"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": 31,
|
|
"used_marker_ids": [
|
|
69,
|
|
64,
|
|
95,
|
|
97,
|
|
51,
|
|
54,
|
|
55,
|
|
75,
|
|
77,
|
|
79,
|
|
52,
|
|
96,
|
|
57,
|
|
81,
|
|
62,
|
|
101,
|
|
59,
|
|
48,
|
|
71,
|
|
102,
|
|
78,
|
|
65,
|
|
80,
|
|
99,
|
|
87,
|
|
67,
|
|
50,
|
|
98,
|
|
90,
|
|
93,
|
|
49
|
|
],
|
|
"history": {
|
|
"iters": [
|
|
0,
|
|
1,
|
|
2,
|
|
3
|
|
],
|
|
"rms": [
|
|
0.0166526002104434,
|
|
0.001547861856607491,
|
|
0.0009010954140942989,
|
|
0.0009010670474135007
|
|
],
|
|
"lambda": [
|
|
0.001,
|
|
0.0005,
|
|
0.00025,
|
|
0.000125
|
|
]
|
|
},
|
|
"residual_rms_px": 1.772902101262499,
|
|
"residual_median_px": 1.078829411239929,
|
|
"residual_max_px": 4.132896609973797,
|
|
"sigma2_normalized": 8.989134466205308e-07
|
|
},
|
|
"camera_pose": {
|
|
"world_to_camera": {
|
|
"rotation_matrix": [
|
|
[
|
|
-0.8299428224563599,
|
|
0.047987256199121475,
|
|
-0.5557806491851807
|
|
],
|
|
[
|
|
-0.2067878544330597,
|
|
0.8988499641418457,
|
|
0.38640326261520386
|
|
],
|
|
[
|
|
0.5181058645248413,
|
|
0.4356212913990021,
|
|
-0.7360709309577942
|
|
]
|
|
],
|
|
"translation_m": [
|
|
0.3115391731262207,
|
|
0.15955179929733276,
|
|
1.010721206665039
|
|
],
|
|
"rvec_rad": [
|
|
0.11388470361679144,
|
|
-2.484845661051424,
|
|
-0.5895193293685591
|
|
]
|
|
},
|
|
"camera_in_world": {
|
|
"position_m": [
|
|
-0.2321075201034546,
|
|
-0.5986547470092773,
|
|
0.8554586172103882
|
|
],
|
|
"position_mm": [
|
|
-232.10751342773438,
|
|
-598.6547241210938,
|
|
855.4586181640625
|
|
],
|
|
"orientation_deg": {
|
|
"roll": 149.38209533691406,
|
|
"pitch": -31.20528221130371,
|
|
"yaw": -166.0091094970703
|
|
}
|
|
},
|
|
"uncertainty": {
|
|
"pose_covariance_6x6": [
|
|
[
|
|
6.177429611549712e-07,
|
|
-3.271435310513194e-07,
|
|
2.0826038527175038e-07,
|
|
1.1745289691018253e-08,
|
|
1.246399175351463e-07,
|
|
2.5938496303806914e-07
|
|
],
|
|
[
|
|
-3.2714353105131786e-07,
|
|
1.818745262675688e-06,
|
|
-7.758187179653276e-07,
|
|
-3.7391240334935067e-07,
|
|
1.2355085126162834e-07,
|
|
-1.0480837144134802e-06
|
|
],
|
|
[
|
|
2.0826038527175115e-07,
|
|
-7.758187179653164e-07,
|
|
3.196631325051651e-06,
|
|
-1.4226982133415135e-07,
|
|
-2.472220165745438e-07,
|
|
-5.7071288101408645e-08
|
|
],
|
|
[
|
|
1.1745289691017904e-08,
|
|
-3.73912403349352e-07,
|
|
-1.422698213341482e-07,
|
|
1.5450238837808334e-07,
|
|
-1.8371188573627686e-08,
|
|
2.69737538270126e-07
|
|
],
|
|
[
|
|
1.246399175351462e-07,
|
|
1.2355085126162715e-07,
|
|
-2.472220165745455e-07,
|
|
-1.8371188573627196e-08,
|
|
1.0508537079793492e-07,
|
|
-3.375059213526172e-08
|
|
],
|
|
[
|
|
2.5938496303806766e-07,
|
|
-1.048083714413481e-06,
|
|
-5.707128810140133e-08,
|
|
2.697375382701256e-07,
|
|
-3.375059213526283e-08,
|
|
1.1991223310707593e-06
|
|
]
|
|
],
|
|
"parameter_std": {
|
|
"rvec_std_deg": [
|
|
0.04503254951204292,
|
|
0.07726958326123887,
|
|
0.10243984387203064
|
|
],
|
|
"tvec_std_m": [
|
|
0.00039306791827632454,
|
|
0.00032416873815643436,
|
|
0.0010950444425094168
|
|
]
|
|
},
|
|
"camera_center_std_m": [
|
|
0.0011416833258602707,
|
|
0.001399943682910595,
|
|
0.0016242027716662328
|
|
],
|
|
"camera_center_std_mm": [
|
|
1.1416833258602708,
|
|
1.3999436829105951,
|
|
1.6242027716662328
|
|
],
|
|
"orientation_std_deg": {
|
|
"roll": 0.10912552250951364,
|
|
"pitch": 0.06634826995916507,
|
|
"yaw": 0.05269160994227188
|
|
}
|
|
}
|
|
},
|
|
"observations": {
|
|
"markers": [
|
|
{
|
|
"marker_id": 69,
|
|
"observed_center_px": [
|
|
1132.25,
|
|
285.75
|
|
],
|
|
"projected_center_px": [
|
|
1135.0460205078125,
|
|
285.681884765625
|
|
],
|
|
"reprojection_error_px": 2.796850079153695,
|
|
"confidence": 0.7848853204330548
|
|
},
|
|
{
|
|
"marker_id": 64,
|
|
"observed_center_px": [
|
|
1159.75,
|
|
422.0
|
|
],
|
|
"projected_center_px": [
|
|
1163.8828125,
|
|
422.0263671875
|
|
],
|
|
"reprojection_error_px": 4.132896609973797,
|
|
"confidence": 0.6665931083934911
|
|
},
|
|
{
|
|
"marker_id": 95,
|
|
"observed_center_px": [
|
|
888.25,
|
|
260.75
|
|
],
|
|
"projected_center_px": [
|
|
888.2636108398438,
|
|
260.42254638671875
|
|
],
|
|
"reprojection_error_px": 0.32773636327420036,
|
|
"confidence": 0.532721681679907
|
|
},
|
|
{
|
|
"marker_id": 97,
|
|
"observed_center_px": [
|
|
747.75,
|
|
130.0
|
|
],
|
|
"projected_center_px": [
|
|
747.532470703125,
|
|
128.94332885742188
|
|
],
|
|
"reprojection_error_px": 1.078829411239929,
|
|
"confidence": 0.46560622960207215
|
|
},
|
|
{
|
|
"marker_id": 51,
|
|
"observed_center_px": [
|
|
907.0,
|
|
393.0
|
|
],
|
|
"projected_center_px": [
|
|
907.0470581054688,
|
|
392.5666809082031
|
|
],
|
|
"reprojection_error_px": 0.4358668381581427,
|
|
"confidence": 0.51593747520078
|
|
},
|
|
{
|
|
"marker_id": 54,
|
|
"observed_center_px": [
|
|
707.25,
|
|
163.0
|
|
],
|
|
"projected_center_px": [
|
|
706.4639892578125,
|
|
162.5380096435547
|
|
],
|
|
"reprojection_error_px": 0.9117280166160364,
|
|
"confidence": 0.39406543798060945
|
|
},
|
|
{
|
|
"marker_id": 55,
|
|
"observed_center_px": [
|
|
773.25,
|
|
258.25
|
|
],
|
|
"projected_center_px": [
|
|
773.2633666992188,
|
|
257.52667236328125
|
|
],
|
|
"reprojection_error_px": 0.7234511308230408,
|
|
"confidence": 0.46078075075842734
|
|
},
|
|
{
|
|
"marker_id": 75,
|
|
"observed_center_px": [
|
|
1118.0,
|
|
858.25
|
|
],
|
|
"projected_center_px": [
|
|
1118.6734619140625,
|
|
858.496826171875
|
|
],
|
|
"reprojection_error_px": 0.7172685053835789,
|
|
"confidence": 0.31814404623997206
|
|
},
|
|
{
|
|
"marker_id": 77,
|
|
"observed_center_px": [
|
|
1064.25,
|
|
835.25
|
|
],
|
|
"projected_center_px": [
|
|
1064.912109375,
|
|
835.7826538085938
|
|
],
|
|
"reprojection_error_px": 0.8497699125482838,
|
|
"confidence": 0.2764879183628208
|
|
},
|
|
{
|
|
"marker_id": 79,
|
|
"observed_center_px": [
|
|
745.5,
|
|
374.75
|
|
],
|
|
"projected_center_px": [
|
|
745.0097045898438,
|
|
374.2278137207031
|
|
],
|
|
"reprojection_error_px": 0.7162877211750871,
|
|
"confidence": 0.4170494444576311
|
|
},
|
|
{
|
|
"marker_id": 52,
|
|
"observed_center_px": [
|
|
975.0,
|
|
818.5
|
|
],
|
|
"projected_center_px": [
|
|
974.7210083007812,
|
|
818.7593383789062
|
|
],
|
|
"reprojection_error_px": 0.38091043961368026,
|
|
"confidence": 0.28365791942355234
|
|
},
|
|
{
|
|
"marker_id": 96,
|
|
"observed_center_px": [
|
|
686.0,
|
|
332.0
|
|
],
|
|
"projected_center_px": [
|
|
685.1288452148438,
|
|
331.39532470703125
|
|
],
|
|
"reprojection_error_px": 1.0604446565603864,
|
|
"confidence": 0.34158615574582396
|
|
},
|
|
{
|
|
"marker_id": 57,
|
|
"observed_center_px": [
|
|
450.5,
|
|
91.0
|
|
],
|
|
"projected_center_px": [
|
|
449.3786926269531,
|
|
91.75985717773438
|
|
],
|
|
"reprojection_error_px": 1.3545158380040203,
|
|
"confidence": 0.2640566098051195
|
|
},
|
|
{
|
|
"marker_id": 81,
|
|
"observed_center_px": [
|
|
935.5,
|
|
766.25
|
|
],
|
|
"projected_center_px": [
|
|
935.0217895507812,
|
|
766.4747314453125
|
|
],
|
|
"reprojection_error_px": 0.5283838152841586,
|
|
"confidence": 0.2860351956805948
|
|
},
|
|
{
|
|
"marker_id": 62,
|
|
"observed_center_px": [
|
|
652.0,
|
|
337.0
|
|
],
|
|
"projected_center_px": [
|
|
651.4396362304688,
|
|
337.208251953125
|
|
],
|
|
"reprojection_error_px": 0.5978096939525563,
|
|
"confidence": 0.29846808668025543
|
|
},
|
|
{
|
|
"marker_id": 101,
|
|
"observed_center_px": [
|
|
947.0,
|
|
889.5
|
|
],
|
|
"projected_center_px": [
|
|
945.738037109375,
|
|
889.663818359375
|
|
],
|
|
"reprojection_error_px": 1.272551292554812,
|
|
"confidence": 0.2368447831748287
|
|
},
|
|
{
|
|
"marker_id": 59,
|
|
"observed_center_px": [
|
|
442.75,
|
|
186.75
|
|
],
|
|
"projected_center_px": [
|
|
441.92218017578125,
|
|
187.2548065185547
|
|
],
|
|
"reprojection_error_px": 0.9695954220936,
|
|
"confidence": 0.2403878054047415
|
|
},
|
|
{
|
|
"marker_id": 48,
|
|
"observed_center_px": [
|
|
384.5,
|
|
132.25
|
|
],
|
|
"projected_center_px": [
|
|
384.16497802734375,
|
|
133.0881805419922
|
|
],
|
|
"reprojection_error_px": 0.9026551629148323,
|
|
"confidence": 0.2302842308363423
|
|
},
|
|
{
|
|
"marker_id": 71,
|
|
"observed_center_px": [
|
|
342.75,
|
|
165.5
|
|
],
|
|
"projected_center_px": [
|
|
342.5614929199219,
|
|
166.22940063476562
|
|
],
|
|
"reprojection_error_px": 0.7533659172248751,
|
|
"confidence": 0.19446237400059435
|
|
},
|
|
{
|
|
"marker_id": 102,
|
|
"observed_center_px": [
|
|
431.5,
|
|
243.5
|
|
],
|
|
"projected_center_px": [
|
|
430.61041259765625,
|
|
244.0597686767578
|
|
],
|
|
"reprojection_error_px": 1.0510502927490641,
|
|
"confidence": 0.21383444473187546
|
|
},
|
|
{
|
|
"marker_id": 78,
|
|
"observed_center_px": [
|
|
275.75,
|
|
91.5
|
|
],
|
|
"projected_center_px": [
|
|
276.2151794433594,
|
|
93.39916229248047
|
|
],
|
|
"reprojection_error_px": 1.955302873649964,
|
|
"confidence": 0.19179473932902583
|
|
},
|
|
{
|
|
"marker_id": 65,
|
|
"observed_center_px": [
|
|
299.5,
|
|
144.75
|
|
],
|
|
"projected_center_px": [
|
|
299.9003601074219,
|
|
145.89024353027344
|
|
],
|
|
"reprojection_error_px": 1.2084881149375393,
|
|
"confidence": 0.18371428147783359
|
|
},
|
|
{
|
|
"marker_id": 80,
|
|
"observed_center_px": [
|
|
248.0,
|
|
96.75
|
|
],
|
|
"projected_center_px": [
|
|
248.6451873779297,
|
|
98.80813598632812
|
|
],
|
|
"reprojection_error_px": 2.15689371338938,
|
|
"confidence": 0.16263927873225353
|
|
},
|
|
{
|
|
"marker_id": 99,
|
|
"observed_center_px": [
|
|
185.25,
|
|
102.75
|
|
],
|
|
"projected_center_px": [
|
|
186.1451873779297,
|
|
105.17755889892578
|
|
],
|
|
"reprojection_error_px": 2.5873543725895725,
|
|
"confidence": 0.1267190569190249
|
|
},
|
|
{
|
|
"marker_id": 87,
|
|
"observed_center_px": [
|
|
211.0,
|
|
180.5
|
|
],
|
|
"projected_center_px": [
|
|
212.29312133789062,
|
|
182.40245056152344
|
|
],
|
|
"reprojection_error_px": 2.300321919547106,
|
|
"confidence": 0.12012255629388194
|
|
},
|
|
{
|
|
"marker_id": 67,
|
|
"observed_center_px": [
|
|
582.75,
|
|
719.5
|
|
],
|
|
"projected_center_px": [
|
|
580.64990234375,
|
|
717.6641845703125
|
|
],
|
|
"reprojection_error_px": 2.789377790415892,
|
|
"confidence": 0.18948869009626315
|
|
},
|
|
{
|
|
"marker_id": 50,
|
|
"observed_center_px": [
|
|
539.75,
|
|
660.5
|
|
],
|
|
"projected_center_px": [
|
|
538.0208129882812,
|
|
659.2553100585938
|
|
],
|
|
"reprojection_error_px": 2.1305728740727727,
|
|
"confidence": 0.17725945005388774
|
|
},
|
|
{
|
|
"marker_id": 98,
|
|
"observed_center_px": [
|
|
547.25,
|
|
741.0
|
|
],
|
|
"projected_center_px": [
|
|
545.20556640625,
|
|
739.264404296875
|
|
],
|
|
"reprojection_error_px": 2.6817906637095117,
|
|
"confidence": 0.15986546546769564
|
|
},
|
|
{
|
|
"marker_id": 90,
|
|
"observed_center_px": [
|
|
498.75,
|
|
723.0
|
|
],
|
|
"projected_center_px": [
|
|
496.80267333984375,
|
|
720.6588134765625
|
|
],
|
|
"reprojection_error_px": 3.045198755234322,
|
|
"confidence": 0.15986546546769564
|
|
},
|
|
{
|
|
"marker_id": 93,
|
|
"observed_center_px": [
|
|
285.5,
|
|
521.25
|
|
],
|
|
"projected_center_px": [
|
|
286.17669677734375,
|
|
519.6380004882812
|
|
],
|
|
"reprojection_error_px": 1.7482737069031569,
|
|
"confidence": 0.12409919873734558
|
|
},
|
|
{
|
|
"marker_id": 49,
|
|
"observed_center_px": [
|
|
244.75,
|
|
518.25
|
|
],
|
|
"projected_center_px": [
|
|
246.22958374023438,
|
|
516.4528198242188
|
|
],
|
|
"reprojection_error_px": 2.3278798569915646,
|
|
"confidence": 0.12349013493926465
|
|
}
|
|
]
|
|
},
|
|
"qa": {
|
|
"sanity_notes": []
|
|
}
|
|
} |