Files
appRobotHoming/data/homing/20260625_172504/cam1_camera_pose.json
2026-06-25 20:36:09 +02:00

761 lines
17 KiB
JSON

{
"schema_version": "1.0",
"created_utc": "2026-06-25T17:25:13Z",
"source": {
"detection_json": "/app/data/homing/20260625_172504/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": 40,
"used_marker_ids": [
54,
95,
58,
85,
47,
103,
59,
48,
105,
51,
102,
96,
62,
71,
92,
63,
208,
210,
217,
74,
75,
52,
68,
76,
46,
53,
101,
50,
100,
82,
60,
67,
73,
94,
70,
104,
98,
90,
91,
88
],
"history": {
"iters": [
0,
1,
2,
3
],
"rms": [
0.011372574297308506,
0.0021949616225605375,
0.002143709970633132,
0.002143709690342172
],
"lambda": [
0.001,
0.0005,
0.00025,
0.000125
]
},
"residual_rms_px": 4.23364353800265,
"residual_median_px": 1.0679787737296105,
"residual_max_px": 19.348939630537274,
"sigma2_normalized": 4.968098633993014e-06
},
"camera_pose": {
"world_to_camera": {
"rotation_matrix": [
[
-0.9951881766319275,
0.019756384193897247,
-0.0959698036313057
],
[
-0.02385592833161354,
0.9011316895484924,
0.4328886866569519
],
[
0.09503374248743057,
0.43309515714645386,
-0.8963242769241333
]
],
"translation_m": [
0.37943923473358154,
0.0862211212515831,
0.8719164729118347
],
"rvec_rad": [
0.0032072073338993575,
-2.967110340660477,
-0.6774876643558738
]
},
"camera_in_world": {
"position_m": [
0.2968088686466217,
-0.4628157615661621,
0.7806104421615601
],
"position_mm": [
296.8088684082031,
-462.8157653808594,
780.6104125976562
],
"orientation_deg": {
"roll": 154.21060180664062,
"pitch": -5.453261375427246,
"yaw": -178.62680053710938
}
},
"uncertainty": {
"pose_covariance_6x6": [
[
2.2460757709580997e-06,
-1.0592111231264017e-07,
-5.911479445197522e-07,
9.807677828663091e-09,
6.656021402664132e-07,
1.8807173299942092e-07
],
[
-1.059211123126279e-07,
7.819602866884685e-06,
-8.896995228371429e-07,
-8.928123497147304e-07,
8.447874310868068e-07,
-3.883503279890717e-06
],
[
-5.911479445197253e-07,
-8.896995228370399e-07,
1.8982339503369444e-05,
-6.420456812663701e-07,
-7.934435641861599e-07,
3.082335762957178e-07
],
[
9.807677828661003e-09,
-8.928123497147341e-07,
-6.42045681266356e-07,
2.4448642118127635e-07,
-7.775978286233749e-08,
3.809119252748882e-07
],
[
6.656021402664136e-07,
8.447874310868029e-07,
-7.934435641861794e-07,
-7.775978286233639e-08,
4.178437168687293e-07,
-3.614395664399821e-07
],
[
1.880717329994141e-07,
-3.883503279890717e-06,
3.08233576295777e-07,
3.809119252748862e-07,
-3.614395664399844e-07,
2.809559727575109e-06
]
],
"parameter_std": {
"rvec_std_deg": [
0.08586868930820345,
0.16021935571577825,
0.24963041613501347
],
"tvec_std_m": [
0.0004944556817160425,
0.000646408320544166,
0.001676174134025194
]
},
"camera_center_std_m": [
0.0028646163342597826,
0.0025089246532298257,
0.001967934179216506
],
"camera_center_std_mm": [
2.8646163342597823,
2.5089246532298257,
1.967934179216506
],
"orientation_std_deg": {
"roll": 0.1994418033453169,
"pitch": 0.16062277696661237,
"yaw": 0.07987033548886921
}
}
},
"observations": {
"markers": [
{
"marker_id": 54,
"observed_center_px": [
735.25,
38.5
],
"projected_center_px": [
735.0857543945312,
38.939788818359375
],
"reprojection_error_px": 0.4694580105501786,
"confidence": 0.2985929580100399
},
{
"marker_id": 95,
"observed_center_px": [
1005.5,
139.0
],
"projected_center_px": [
1004.7282104492188,
139.58082580566406
],
"reprojection_error_px": 0.9659284275868637,
"confidence": 0.9357112460666233
},
{
"marker_id": 58,
"observed_center_px": [
1234.75,
235.25
],
"projected_center_px": [
1234.0849609375,
235.2240447998047
],
"reprojection_error_px": 0.6655453606389707,
"confidence": 0.36770453019575644
},
{
"marker_id": 85,
"observed_center_px": [
458.0,
68.5
],
"projected_center_px": [
458.2991027832031,
69.70124816894531
],
"reprojection_error_px": 1.2379255382753527,
"confidence": 0.8685664374455692
},
{
"marker_id": 47,
"observed_center_px": [
731.5,
117.25
],
"projected_center_px": [
731.38525390625,
117.72209930419922
],
"reprojection_error_px": 0.485844027498816,
"confidence": 0.9524913713047937
},
{
"marker_id": 103,
"observed_center_px": [
1128.75,
284.5
],
"projected_center_px": [
1128.236083984375,
284.30267333984375
],
"reprojection_error_px": 0.5504974858473882,
"confidence": 0.9144001450649527
},
{
"marker_id": 59,
"observed_center_px": [
262.25,
123.5
],
"projected_center_px": [
263.9138488769531,
125.33772277832031
],
"reprojection_error_px": 2.479035718842208,
"confidence": 0.9376517069038668
},
{
"marker_id": 48,
"observed_center_px": [
148.5,
51.0
],
"projected_center_px": [
149.4849395751953,
51.862728118896484
],
"reprojection_error_px": 1.3093531891436279,
"confidence": 0.5517245546325658
},
{
"marker_id": 105,
"observed_center_px": [
432.0,
147.75
],
"projected_center_px": [
432.3002014160156,
149.29176330566406
],
"reprojection_error_px": 1.5707179826022124,
"confidence": 0.9442241264421224
},
{
"marker_id": 51,
"observed_center_px": [
1019.75,
308.0
],
"projected_center_px": [
1019.1754150390625,
307.9459228515625
],
"reprojection_error_px": 0.5771240900522866,
"confidence": 0.9297130863840988
},
{
"marker_id": 102,
"observed_center_px": [
239.25,
213.75
],
"projected_center_px": [
240.9429473876953,
215.61300659179688
],
"reprojection_error_px": 2.5173129361648683,
"confidence": 0.9498751926981491
},
{
"marker_id": 96,
"observed_center_px": [
689.75,
280.5
],
"projected_center_px": [
689.872314453125,
280.85595703125
],
"reprojection_error_px": 0.37638575097840954,
"confidence": 0.8766456914396368
},
{
"marker_id": 62,
"observed_center_px": [
634.75,
296.75
],
"projected_center_px": [
634.6029052734375,
297.34588623046875
],
"reprojection_error_px": 0.6137729696270053,
"confidence": 0.8625841801430425
},
{
"marker_id": 71,
"observed_center_px": [
63.5,
113.5
],
"projected_center_px": [
64.10832977294922,
114.1216812133789
],
"reprojection_error_px": 0.8698003470479402,
"confidence": 0.6962965934908386
},
{
"marker_id": 92,
"observed_center_px": [
256.25,
273.25
],
"projected_center_px": [
257.945556640625,
274.84429931640625
],
"reprojection_error_px": 2.327381067178508,
"confidence": 0.8785732433921414
},
{
"marker_id": 63,
"observed_center_px": [
36.75,
191.25
],
"projected_center_px": [
37.489715576171875,
191.14720153808594
],
"reprojection_error_px": 0.7468243819019208,
"confidence": 0.23403229407345516
},
{
"marker_id": 208,
"observed_center_px": [
295.25,
413.75
],
"projected_center_px": [
288.3956298828125,
413.3526916503906
],
"reprojection_error_px": 6.8658752994838395,
"confidence": 0.7372980849807326
},
{
"marker_id": 210,
"observed_center_px": [
1059.0,
559.75
],
"projected_center_px": [
1073.6019287109375,
555.7957763671875
],
"reprojection_error_px": 15.127861931469159,
"confidence": 0.6136138322804316
},
{
"marker_id": 217,
"observed_center_px": [
162.25,
532.5
],
"projected_center_px": [
146.7255401611328,
520.9512939453125
],
"reprojection_error_px": 19.348939630537274,
"confidence": 0.6320655742155583
},
{
"marker_id": 74,
"observed_center_px": [
1086.0,
734.75
],
"projected_center_px": [
1084.8804931640625,
735.0576782226562
],
"reprojection_error_px": 1.1610174177882524,
"confidence": 0.49861888008985367
},
{
"marker_id": 75,
"observed_center_px": [
1251.5,
801.75
],
"projected_center_px": [
1249.17626953125,
800.1643676757812
],
"reprojection_error_px": 2.8131749250632194,
"confidence": 0.06713952659324364
},
{
"marker_id": 52,
"observed_center_px": [
1075.25,
807.5
],
"projected_center_px": [
1073.9066162109375,
807.3248291015625
],
"reprojection_error_px": 1.354756379713829,
"confidence": 0.44660041827617547
},
{
"marker_id": 68,
"observed_center_px": [
421.5,
733.0
],
"projected_center_px": [
422.2747497558594,
733.5101318359375
],
"reprojection_error_px": 0.9276161243969003,
"confidence": 0.453656743367513
},
{
"marker_id": 76,
"observed_center_px": [
274.0,
722.75
],
"projected_center_px": [
274.78045654296875,
723.6485595703125
],
"reprojection_error_px": 1.19017717876916,
"confidence": 0.42914121819077033
},
{
"marker_id": 46,
"observed_center_px": [
472.5,
751.25
],
"projected_center_px": [
472.7325744628906,
751.6512451171875
],
"reprojection_error_px": 0.4637763737575183,
"confidence": 0.42705375163400877
},
{
"marker_id": 53,
"observed_center_px": [
541.0,
783.25
],
"projected_center_px": [
541.320556640625,
783.3278198242188
],
"reprojection_error_px": 0.32986737469810884,
"confidence": 0.4239630899600427
},
{
"marker_id": 101,
"observed_center_px": [
1031.25,
900.5
],
"projected_center_px": [
1029.7542724609375,
900.5302124023438
],
"reprojection_error_px": 1.4960326401403623,
"confidence": 0.3366794154513476
},
{
"marker_id": 50,
"observed_center_px": [
427.25,
777.5
],
"projected_center_px": [
427.572998046875,
777.9152221679688
],
"reprojection_error_px": 0.5260581593870906,
"confidence": 0.3955545216798782
},
{
"marker_id": 100,
"observed_center_px": [
120.0,
723.5
],
"projected_center_px": [
122.01116180419922,
723.669677734375
],
"reprojection_error_px": 2.018306799327716,
"confidence": 0.4621067158671878
},
{
"marker_id": 82,
"observed_center_px": [
894.75,
890.0
],
"projected_center_px": [
893.3291625976562,
890.5499267578125
],
"reprojection_error_px": 1.523547952267044,
"confidence": 0.37908960001789416
},
{
"marker_id": 60,
"observed_center_px": [
613.0,
860.75
],
"projected_center_px": [
612.6180419921875,
860.841552734375
],
"reprojection_error_px": 0.39277706514463534,
"confidence": 0.3907528879258137
},
{
"marker_id": 67,
"observed_center_px": [
497.75,
837.75
],
"projected_center_px": [
497.95806884765625,
838.1924438476562
],
"reprojection_error_px": 0.48892658313275084,
"confidence": 0.3865272468846743
},
{
"marker_id": 73,
"observed_center_px": [
889.25,
925.75
],
"projected_center_px": [
887.6505126953125,
926.299560546875
],
"reprojection_error_px": 1.6912647434798707,
"confidence": 0.15682847151496923
},
{
"marker_id": 94,
"observed_center_px": [
29.0,
720.5
],
"projected_center_px": [
31.336706161499023,
720.2244873046875
],
"reprojection_error_px": 2.3528924604549735,
"confidence": 0.09146699566173024
},
{
"marker_id": 70,
"observed_center_px": [
401.25,
866.75
],
"projected_center_px": [
401.60943603515625,
867.041259765625
],
"reprojection_error_px": 0.46262999734212534,
"confidence": 0.35896437880813437
},
{
"marker_id": 104,
"observed_center_px": [
107.5,
792.0
],
"projected_center_px": [
109.24372100830078,
792.2886352539062
],
"reprojection_error_px": 1.7674482353344945,
"confidence": 0.3880719051456888
},
{
"marker_id": 98,
"observed_center_px": [
436.5,
882.25
],
"projected_center_px": [
436.5618896484375,
883.1439819335938
],
"reprojection_error_px": 0.8961216581333906,
"confidence": 0.36026641726859315
},
{
"marker_id": 90,
"observed_center_px": [
351.75,
880.25
],
"projected_center_px": [
352.1582336425781,
880.5147094726562
],
"reprojection_error_px": 0.4865447685943754,
"confidence": 0.3567245846660417
},
{
"marker_id": 91,
"observed_center_px": [
254.25,
887.0
],
"projected_center_px": [
255.22390747070312,
886.9551391601562
],
"reprojection_error_px": 0.9749401296709685,
"confidence": 0.3494656541641164
},
{
"marker_id": 88,
"observed_center_px": [
199.75,
872.5
],
"projected_center_px": [
201.13644409179688,
872.6148681640625
],
"reprojection_error_px": 1.3911944201992585,
"confidence": 0.347903013426907
}
]
},
"qa": {
"sanity_notes": []
}
}