Files
appRobotHoming/data/homing/20260625_175916/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:59:25Z",
"source": {
"detection_json": "/app/data/homing/20260625_175916/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,
105,
48,
51,
102,
96,
62,
71,
92,
208,
63,
210,
217,
74,
75,
52,
76,
68,
46,
53,
50,
101,
82,
100,
73,
60,
67,
70,
94,
90,
104,
98,
91,
88
],
"history": {
"iters": [
0,
1,
2,
3
],
"rms": [
0.011863062568042395,
0.0021882720514259653,
0.0021293863444762583,
0.0021293859894700134
],
"lambda": [
0.001,
0.0005,
0.00025,
0.000125
]
},
"residual_rms_px": 4.205255463207004,
"residual_median_px": 1.1858116613812175,
"residual_max_px": 19.118438507028245,
"sigma2_normalized": 4.9019293968833265e-06
},
"camera_pose": {
"world_to_camera": {
"rotation_matrix": [
[
-0.995226263999939,
0.019625136628746986,
-0.09560120105743408
],
[
-0.023808155208826065,
0.9011572599411011,
0.4328380525112152
],
[
0.09464621543884277,
0.4330478608608246,
-0.8963881134986877
]
],
"translation_m": [
0.37944144010543823,
0.08616430312395096,
0.8720222115516663
],
"rvec_rad": [
0.0032728478486759383,
-2.9675124187665194,
-0.6774800690352322
]
},
"camera_in_world": {
"position_m": [
0.2971478998661041,
-0.4627215266227722,
0.7806501984596252
],
"position_mm": [
297.14788818359375,
-462.7215270996094,
780.6502075195312
],
"orientation_deg": {
"roll": 154.2146453857422,
"pitch": -5.430957317352295,
"yaw": -178.6295928955078
}
},
"uncertainty": {
"pose_covariance_6x6": [
[
2.216368778099703e-06,
-1.0420377127470311e-07,
-5.846035681663414e-07,
9.638753004284797e-09,
6.568277931365646e-07,
1.8540529905122184e-07
],
[
-1.0420377127470325e-07,
7.716359917594955e-06,
-8.780258686751835e-07,
-8.798584488389978e-07,
8.337615617564991e-07,
-3.831747509912712e-06
],
[
-5.846035681663423e-07,
-8.780258686751325e-07,
1.8740126796208265e-05,
-6.332974421687337e-07,
-7.826466185078999e-07,
3.040527671220899e-07
],
[
9.638753004284528e-09,
-8.798584488389991e-07,
-6.332974421687222e-07,
2.409326607990254e-07,
-7.666433629844329e-08,
3.751828231192777e-07
],
[
6.568277931365642e-07,
8.337615617564963e-07,
-7.826466185079048e-07,
-7.66643362984426e-08,
4.122731304646649e-07,
-3.5672545335086356e-07
],
[
1.8540529905122184e-07,
-3.831747509912709e-06,
3.040527671221047e-07,
3.7518282311927725e-07,
-3.567254533508643e-07,
2.7716081204320043e-06
]
],
"parameter_std": {
"rvec_std_deg": [
0.08529894195541628,
0.15915814568050488,
0.24803267374807242
],
"tvec_std_m": [
0.0004908489185065252,
0.0006420849869485074,
0.0016648147405738587
]
},
"camera_center_std_m": [
0.0027539612430056413,
0.002145451671454086,
0.0019549734255131183
],
"camera_center_std_mm": [
2.7539612430056413,
2.145451671454086,
1.9549734255131184
],
"orientation_std_deg": {
"roll": 0.19816528973825537,
"pitch": 0.158142424860459,
"yaw": 0.04543296464811841
}
}
},
"observations": {
"markers": [
{
"marker_id": 54,
"observed_center_px": [
735.25,
38.25
],
"projected_center_px": [
735.1257934570312,
38.84978103637695
],
"reprojection_error_px": 0.6125067811164705,
"confidence": 0.29867757253933086
},
{
"marker_id": 95,
"observed_center_px": [
1005.25,
139.0
],
"projected_center_px": [
1004.7445678710938,
139.50558471679688
],
"reprojection_error_px": 0.714896875632619,
"confidence": 0.9333333333333333
},
{
"marker_id": 58,
"observed_center_px": [
1234.75,
235.25
],
"projected_center_px": [
1234.0479736328125,
235.1490020751953
],
"reprojection_error_px": 0.7092542569779415,
"confidence": 0.36770453019575644
},
{
"marker_id": 85,
"observed_center_px": [
458.0,
68.0
],
"projected_center_px": [
458.30291748046875,
69.59838104248047
],
"reprojection_error_px": 1.6268315699341729,
"confidence": 0.875342401743355
},
{
"marker_id": 47,
"observed_center_px": [
731.75,
117.0
],
"projected_center_px": [
731.4143676757812,
117.63695526123047
],
"reprojection_error_px": 0.7199729591239207,
"confidence": 0.9759139241315488
},
{
"marker_id": 103,
"observed_center_px": [
1128.75,
284.5
],
"projected_center_px": [
1128.21533203125,
284.2250061035156
],
"reprojection_error_px": 0.6012416152520633,
"confidence": 0.9144001450649527
},
{
"marker_id": 59,
"observed_center_px": [
262.0,
123.5
],
"projected_center_px": [
263.8606872558594,
125.23478698730469
],
"reprojection_error_px": 2.5439424041120047,
"confidence": 0.9428090418229809
},
{
"marker_id": 105,
"observed_center_px": [
432.25,
147.75
],
"projected_center_px": [
432.2873840332031,
149.19923400878906
],
"reprojection_error_px": 1.449716102610904,
"confidence": 0.9442241264421224
},
{
"marker_id": 48,
"observed_center_px": [
148.5,
50.75
],
"projected_center_px": [
149.40765380859375,
51.741458892822266
],
"reprojection_error_px": 1.3441823434382303,
"confidence": 0.5647167996853729
},
{
"marker_id": 51,
"observed_center_px": [
1019.5,
307.5
],
"projected_center_px": [
1019.1678466796875,
307.8690490722656
],
"reprojection_error_px": 0.49651087191997795,
"confidence": 0.8824030145295596
},
{
"marker_id": 102,
"observed_center_px": [
239.5,
213.75
],
"projected_center_px": [
240.8688507080078,
215.52737426757812
],
"reprojection_error_px": 2.24339286525173,
"confidence": 0.9331395642876747
},
{
"marker_id": 96,
"observed_center_px": [
690.0,
280.75
],
"projected_center_px": [
689.8768310546875,
280.7818908691406
],
"reprojection_error_px": 0.12723056481812098,
"confidence": 0.9012948266053811
},
{
"marker_id": 62,
"observed_center_px": [
634.75,
296.75
],
"projected_center_px": [
634.6005249023438,
297.2737731933594
],
"reprojection_error_px": 0.5446844617769289,
"confidence": 0.8643569912878776
},
{
"marker_id": 71,
"observed_center_px": [
63.25,
113.75
],
"projected_center_px": [
63.99217224121094,
114.01245880126953
],
"reprojection_error_px": 0.7872129686354927,
"confidence": 0.6618010073234457
},
{
"marker_id": 92,
"observed_center_px": [
256.25,
273.25
],
"projected_center_px": [
257.8680114746094,
274.7709045410156
],
"reprojection_error_px": 2.220610671605798,
"confidence": 0.8785732433921414
},
{
"marker_id": 208,
"observed_center_px": [
295.25,
413.75
],
"projected_center_px": [
288.319091796875,
413.3032531738281
],
"reprojection_error_px": 6.945291300358831,
"confidence": 0.7372980849807326
},
{
"marker_id": 63,
"observed_center_px": [
36.0,
190.75
],
"projected_center_px": [
37.349727630615234,
191.05543518066406
],
"reprojection_error_px": 1.3838552404184128,
"confidence": 0.23122213258874602
},
{
"marker_id": 210,
"observed_center_px": [
1059.0,
560.0
],
"projected_center_px": [
1073.5731201171875,
555.7078857421875
],
"reprojection_error_px": 15.192039848292012,
"confidence": 0.6479471317434429
},
{
"marker_id": 217,
"observed_center_px": [
162.0,
532.25
],
"projected_center_px": [
146.59190368652344,
520.931640625
],
"reprojection_error_px": 19.118438507028245,
"confidence": 0.6089399477645175
},
{
"marker_id": 74,
"observed_center_px": [
1085.75,
734.75
],
"projected_center_px": [
1084.8079833984375,
734.9703979492188
],
"reprojection_error_px": 0.9674557011249624,
"confidence": 0.4941465175073702
},
{
"marker_id": 75,
"observed_center_px": [
1251.5,
801.5
],
"projected_center_px": [
1249.0706787109375,
800.055419921875
],
"reprojection_error_px": 2.8263781642957686,
"confidence": 0.07129070123540064
},
{
"marker_id": 52,
"observed_center_px": [
1075.0,
807.0
],
"projected_center_px": [
1073.82666015625,
807.2386474609375
],
"reprojection_error_px": 1.1973633531819778,
"confidence": 0.4747611026689374
},
{
"marker_id": 76,
"observed_center_px": [
273.75,
722.5
],
"projected_center_px": [
274.6397705078125,
723.6699829101562
],
"reprojection_error_px": 1.4698814804706541,
"confidence": 0.4464638052540792
},
{
"marker_id": 68,
"observed_center_px": [
421.5,
733.0
],
"projected_center_px": [
422.1742858886719,
733.5136108398438
],
"reprojection_error_px": 0.847618755377099,
"confidence": 0.453656743367513
},
{
"marker_id": 46,
"observed_center_px": [
472.25,
751.5
],
"projected_center_px": [
472.6407165527344,
751.65087890625
],
"reprojection_error_px": 0.41883632713964764,
"confidence": 0.4433609532391809
},
{
"marker_id": 53,
"observed_center_px": [
541.25,
783.25
],
"projected_center_px": [
541.2369384765625,
783.3223876953125
],
"reprojection_error_px": 0.07355665725931064,
"confidence": 0.41918904165916515
},
{
"marker_id": 50,
"observed_center_px": [
427.0,
777.75
],
"projected_center_px": [
427.4671630859375,
777.926025390625
],
"reprojection_error_px": 0.49922568744740276,
"confidence": 0.4069334148740479
},
{
"marker_id": 101,
"observed_center_px": [
1031.0,
900.25
],
"projected_center_px": [
1029.668212890625,
900.4525146484375
],
"reprojection_error_px": 1.3470965397955643,
"confidence": 0.34672467375183735
},
{
"marker_id": 82,
"observed_center_px": [
894.5,
890.25
],
"projected_center_px": [
893.2540283203125,
890.4962158203125
],
"reprojection_error_px": 1.2700660048814185,
"confidence": 0.39232527116476396
},
{
"marker_id": 100,
"observed_center_px": [
120.0,
723.5
],
"projected_center_px": [
121.81710815429688,
723.7096557617188
],
"reprojection_error_px": 1.8291630826238716,
"confidence": 0.4207088246724057
},
{
"marker_id": 73,
"observed_center_px": [
889.0,
926.25
],
"projected_center_px": [
887.5708618164062,
926.2489624023438
],
"reprojection_error_px": 1.4291385602573807,
"confidence": 0.1469791980355697
},
{
"marker_id": 60,
"observed_center_px": [
613.0,
860.5
],
"projected_center_px": [
612.533935546875,
860.8355102539062
],
"reprojection_error_px": 0.5742675377756796,
"confidence": 0.36564926628565203
},
{
"marker_id": 67,
"observed_center_px": [
497.75,
838.0
],
"projected_center_px": [
497.8586120605469,
838.2026977539062
],
"reprojection_error_px": 0.22996295165716743,
"confidence": 0.363884422773956
},
{
"marker_id": 70,
"observed_center_px": [
401.25,
866.75
],
"projected_center_px": [
401.48388671875,
867.0733032226562
],
"reprojection_error_px": 0.39903379679866513,
"confidence": 0.35896437880813437
},
{
"marker_id": 94,
"observed_center_px": [
29.0,
720.25
],
"projected_center_px": [
31.11460304260254,
720.2709350585938
],
"reprojection_error_px": 2.1147066710213593,
"confidence": 0.09031730482356817
},
{
"marker_id": 90,
"observed_center_px": [
351.5,
880.25
],
"projected_center_px": [
352.0174560546875,
880.55810546875
],
"reprojection_error_px": 0.6022372857988869,
"confidence": 0.36026641726859315
},
{
"marker_id": 104,
"observed_center_px": [
107.5,
792.25
],
"projected_center_px": [
109.0373764038086,
792.3465576171875
],
"reprojection_error_px": 1.540405654502856,
"confidence": 0.40599116793083023
},
{
"marker_id": 98,
"observed_center_px": [
436.5,
882.0
],
"projected_center_px": [
436.4425048828125,
883.1728515625
],
"reprojection_error_px": 1.174259969580457,
"confidence": 0.35391110957760685
},
{
"marker_id": 91,
"observed_center_px": [
254.25,
887.0
],
"projected_center_px": [
255.05325317382812,
887.015869140625
],
"reprojection_error_px": 0.8034099146071898,
"confidence": 0.3494656541641164
},
{
"marker_id": 88,
"observed_center_px": [
199.5,
873.0
],
"projected_center_px": [
200.95053100585938,
872.6802978515625
],
"reprojection_error_px": 1.4853449642002237,
"confidence": 0.33862598740745903
}
]
},
"qa": {
"sanity_notes": []
}
}