diff --git a/data/evaluations/Scene8/aruco_positions_initial.json b/data/evaluations/Scene8/aruco_positions_initial.json new file mode 100644 index 0000000..750a7db --- /dev/null +++ b/data/evaluations/Scene8/aruco_positions_initial.json @@ -0,0 +1,1076 @@ +{ + "schema_version": "1.2", + "stage": "initial_triangulation", + "created_utc": "2026-06-01T18:36:49Z", + "summary": { + "num_cameras": 7, + "num_markers": 56, + "num_constraints": 163 + }, + "markers": [ + { + "marker_id": 41, + "position_m": [ + 0.2604696179258959, + -0.14289826359306226, + 0.3443845376382856 + ], + "position_mm": [ + 260.4696179258959, + -142.89826359306227, + 344.38453763828556 + ], + "link": "FingerA", + "normal": [ + 0.0, + -0.9375276894468237, + 0.34791066600565723 + ] + }, + { + "marker_id": 42, + "position_m": [ + 0.29142894521099333, + -0.17910742174815197, + 0.3448106425382629 + ], + "position_mm": [ + 291.42894521099333, + -179.10742174815198, + 344.81064253826287 + ], + "link": "FingerA", + "normal": [ + 0.8830215713766957, + -0.3090575499818435, + 0.3532086285506783 + ] + }, + { + "marker_id": 43, + "position_m": [ + 0.24505913693461728, + -0.17536757426841992, + 0.3450428980062189 + ], + "position_mm": [ + 245.05913693461727, + -175.36757426841993, + 345.0428980062189 + ], + "link": "FingerB", + "normal": [ + 0.4224220616915755, + 0.0, + 0.9063992507699015 + ] + }, + { + "marker_id": 44, + "position_m": [ + 0.26172112022130845, + -0.173659507226198, + 0.2992789317400768 + ], + "position_mm": [ + 261.72112022130847, + -173.659507226198, + 299.2789317400768 + ], + "link": "FingerB", + "normal": [ + 0.0, + -0.9375276894468237, + -0.34791066600565723 + ] + }, + { + "marker_id": 46, + "position_m": [ + 0.53671, + 0.18544, + -0.0273 + ], + "position_mm": [ + 536.71, + 185.44, + -27.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 47, + "position_m": [ + 0.34423000000000004, + -0.28654, + -0.0273 + ], + "position_mm": [ + 344.23, + -286.54, + -27.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 51, + "position_m": [ + 0.1678, + -0.17208, + -0.0273 + ], + "position_mm": [ + 167.8, + -172.08, + -27.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 53, + "position_m": [ + 0.48625, + 0.21224, + -0.0273 + ], + "position_mm": [ + 486.25, + 212.24, + -27.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 54, + "position_m": [ + 0.34226999999999996, + -0.33059, + -0.0273 + ], + "position_mm": [ + 342.27, + -330.59, + -27.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 55, + "position_m": [ + 0.28372, + -0.26258, + -0.0273 + ], + "position_mm": [ + 283.72, + -262.58, + -27.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 56, + "position_m": [ + 0.49868, + 0.16867, + -0.0273 + ], + "position_mm": [ + 498.68, + 168.67, + -27.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 58, + "position_m": [ + 0.05009, + -0.21811000000000003, + -0.0273 + ], + "position_mm": [ + 50.09, + -218.11, + -27.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 60, + "position_m": [ + 0.43436, + 0.28381, + -0.0273 + ], + "position_mm": [ + 434.36, + 283.81, + -27.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 61, + "position_m": [ + -0.022420000000000002, + 0.33583, + -0.0273 + ], + "position_mm": [ + -22.42, + 335.83000000000004, + -27.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 62, + "position_m": [ + 0.4047, + -0.1751, + -0.0273 + ], + "position_mm": [ + 404.7, + -175.1, + -27.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 63, + "position_m": [ + 0.7774, + -0.23615, + -0.0273 + ], + "position_mm": [ + 777.4, + -236.15, + -27.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 64, + "position_m": [ + -0.02127, + -0.18822999999999998, + -0.0273 + ], + "position_mm": [ + -21.27, + -188.23, + -27.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 66, + "position_m": [ + 0.20975, + -0.36323000000000005, + -0.0273 + ], + "position_mm": [ + 209.75, + -363.2300000000001, + -27.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 68, + "position_m": [ + 0.5737300000000001, + 0.17064, + -0.0273 + ], + "position_mm": [ + 573.73, + 170.64, + -27.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 69, + "position_m": [ + 0.0076100000000000004, + -0.28120999999999996, + -0.0273 + ], + "position_mm": [ + 7.61, + -281.21, + -27.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 72, + "position_m": [ + 0.44099, + 0.19432, + -0.0273 + ], + "position_mm": [ + 440.99, + 194.32, + -27.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 73, + "position_m": [ + 0.22172999999999998, + 0.33311, + -0.0273 + ], + "position_mm": [ + 221.73, + 333.11, + -27.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 75, + "position_m": [ + -0.0257, + 0.19458, + -0.0273 + ], + "position_mm": [ + -25.7, + 194.58, + -27.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 79, + "position_m": [ + 0.3123, + -0.15911000000000003, + -0.0273 + ], + "position_mm": [ + 312.3, + -159.11000000000004, + -27.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 82, + "position_m": [ + 0.21916, + 0.29724, + -0.0273 + ], + "position_mm": [ + 219.16, + 297.24, + -27.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 83, + "position_m": [ + 0.04416, + 0.33922, + -0.0273 + ], + "position_mm": [ + 44.16, + 339.22, + -27.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 84, + "position_m": [ + 0.40749, + 0.25842000000000004, + -0.0273 + ], + "position_mm": [ + 407.49, + 258.42, + -27.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 85, + "position_m": [ + 0.50458, + -0.31275000000000003, + -0.0273 + ], + "position_mm": [ + 504.58000000000004, + -312.75, + -27.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 86, + "position_m": [ + 0.36289, + 0.29201, + -0.0273 + ], + "position_mm": [ + 362.89, + 292.01, + -27.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 92, + "position_m": [ + 0.64509, + -0.18484, + -0.0273 + ], + "position_mm": [ + 645.09, + -184.84, + -27.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 95, + "position_m": [ + 0.18603999999999998, + -0.27407, + -0.0273 + ], + "position_mm": [ + 186.04, + -274.07, + -27.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 96, + "position_m": [ + 0.36977, + -0.18649000000000002, + -0.0273 + ], + "position_mm": [ + 369.77, + -186.49, + -27.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 97, + "position_m": [ + 0.30435, + -0.35967000000000005, + -0.0273 + ], + "position_mm": [ + 304.35, + -359.6700000000001, + -27.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 102, + "position_m": [ + 0.6496900000000001, + -0.223, + -0.0273 + ], + "position_mm": [ + 649.69, + -223.0, + -27.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 103, + "position_m": [ + 0.10571, + -0.18771000000000002, + -0.0273 + ], + "position_mm": [ + 105.71, + -187.71, + -27.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 105, + "position_m": [ + 0.5248400000000001, + -0.26625, + -0.0273 + ], + "position_mm": [ + 524.84, + -266.25, + -27.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 114, + "position_m": [ + 0.281913958303829, + -0.14729567745079777, + 0.23438880832138625 + ], + "position_mm": [ + 281.91395830382896, + -147.29567745079777, + 234.38880832138625 + ], + "link": "Arm2", + "normal": [ + 0.7071067811865475, + 0.0, + -0.7071067811865475 + ] + }, + { + "marker_id": 115, + "position_m": [ + 0.23533888520701415, + -0.16402876322762236, + 0.2352033933459255 + ], + "position_mm": [ + 235.33888520701416, + -164.02876322762236, + 235.2033933459255 + ], + "link": "Arm2", + "normal": [ + -0.7071067811865475, + 0.0, + -0.7071067811865475 + ] + }, + { + "marker_id": 120, + "position_m": [ + 0.2820357717587118, + -0.1510503251417516, + 0.1647099206425418 + ], + "position_mm": [ + 282.0357717587118, + -151.05032514175159, + 164.70992064254182 + ], + "link": "Arm2", + "normal": [ + 0.7071067811865475, + 0.0, + -0.7071067811865475 + ] + }, + { + "marker_id": 198, + "position_m": [ + 0.15996742027907745, + -0.05309238478466741, + 0.09041937348544336 + ], + "position_mm": [ + 159.96742027907746, + -53.09238478466741, + 90.41937348544336 + ], + "link": "Arm1", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 205, + "position_m": [ + 0.75, + -0.09, + 0.0003 + ], + "position_mm": [ + 750.0, + -90.0, + 0.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 206, + "position_m": [ + 0.65, + -0.01, + 0.0003 + ], + "position_mm": [ + 650.0, + -10.0, + 0.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 207, + "position_m": [ + 0.75, + -0.01, + 0.0003 + ], + "position_mm": [ + 750.0, + -10.0, + 0.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 208, + "position_m": [ + 0.35000000000000003, + -0.09, + 0.0003 + ], + "position_mm": [ + 350.00000000000006, + -90.0, + 0.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 210, + "position_m": [ + 0.02, + -0.02, + 0.0003 + ], + "position_mm": [ + 20.0, + -20.0, + 0.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 211, + "position_m": [ + 0.25, + -0.01, + 0.0003 + ], + "position_mm": [ + 250.0, + -10.0, + 0.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 214, + "position_m": [ + 0.35000000000000003, + -0.01, + 0.0003 + ], + "position_mm": [ + 350.00000000000006, + -10.0, + 0.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 215, + "position_m": [ + 0.25, + -0.09, + 0.0003 + ], + "position_mm": [ + 250.0, + -90.0, + 0.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 217, + "position_m": [ + 0.65, + -0.09, + 0.0003 + ], + "position_mm": [ + 650.0, + -90.0, + 0.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 219, + "position_m": [ + 0.28373842821530076, + -0.11864875843805314, + 0.26999583241494307 + ], + "position_mm": [ + 283.73842821530076, + -118.64875843805314, + 269.9958324149431 + ], + "link": "Arm2", + "normal": [ + 1.0, + 0.0, + 0.0 + ] + }, + { + "marker_id": 229, + "position_m": [ + 0.15997322006826376, + -0.14314860848153363, + 0.08730306053283819 + ], + "position_mm": [ + 159.97322006826374, + -143.14860848153364, + 87.30306053283819 + ], + "link": "Arm1", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 232, + "position_m": [ + 0.2500172750219489, + -0.1685018910572591, + 0.028533350878303273 + ], + "position_mm": [ + 250.01727502194893, + -168.50189105725912, + 28.533350878303274 + ], + "link": "Ellbow", + "normal": [ + 0.0, + 0.7071067811865475, + -0.7071067811865475 + ] + }, + { + "marker_id": 243, + "position_m": [ + 0.15977091466136845, + -0.17728534784518496, + 0.05086946501139717 + ], + "position_mm": [ + 159.77091466136844, + -177.28534784518496, + 50.86946501139717 + ], + "link": "Arm1", + "normal": [ + 0.0, + -1.0, + 0.0 + ] + }, + { + "marker_id": 244, + "position_m": [ + 0.28593192370492515, + -0.14254624001040914, + 0.052179602076133966 + ], + "position_mm": [ + 285.93192370492517, + -142.54624001040915, + 52.17960207613397 + ], + "link": "Ellbow", + "normal": [ + 1.0, + 0.0, + 0.0 + ] + }, + { + "marker_id": 245, + "position_m": [ + 0.25023797739558296, + -0.17715503440515307, + 0.05362377268934036 + ], + "position_mm": [ + 250.23797739558296, + -177.15503440515306, + 53.62377268934036 + ], + "link": "Ellbow", + "normal": [ + 0.0, + 0.0, + -1.0 + ] + }, + { + "marker_id": 248, + "position_m": [ + 0.2125171838886908, + -0.17715024472244992, + 0.05378353772446503 + ], + "position_mm": [ + 212.51718388869082, + -177.1502447224499, + 53.78353772446503 + ], + "link": "Ellbow", + "normal": [ + 0.0, + 0.0, + -1.0 + ] + } + ] +} \ No newline at end of file diff --git a/data/evaluations/Scene8/aruco_positions_optimized.json b/data/evaluations/Scene8/aruco_positions_optimized.json new file mode 100644 index 0000000..fc1c307 --- /dev/null +++ b/data/evaluations/Scene8/aruco_positions_optimized.json @@ -0,0 +1,1075 @@ +{ + "schema_version": "1.2", + "created_utc": "2026-06-01T18:37:01Z", + "summary": { + "num_cameras": 7, + "num_markers": 56, + "num_constraints": 163 + }, + "markers": [ + { + "marker_id": 41, + "position_m": [ + 0.26049995321898956, + -0.14324312525620367, + 0.3445672581183753 + ], + "position_mm": [ + 260.49995321898956, + -143.24312525620365, + 344.5672581183753 + ], + "link": "FingerA", + "normal": [ + 0.0, + -0.9375276894468237, + 0.34791066600565723 + ] + }, + { + "marker_id": 42, + "position_m": [ + 0.2914570710781906, + -0.17915739832667119, + 0.3448155785156926 + ], + "position_mm": [ + 291.45707107819055, + -179.1573983266712, + 344.8155785156926 + ], + "link": "FingerA", + "normal": [ + 0.8830215713766957, + -0.3090575499818435, + 0.3532086285506783 + ] + }, + { + "marker_id": 43, + "position_m": [ + 0.24503062811257265, + -0.17540761033656532, + 0.3450432154883349 + ], + "position_mm": [ + 245.03062811257266, + -175.4076103365653, + 345.0432154883349 + ], + "link": "FingerB", + "normal": [ + 0.4224220616915755, + 0.0, + 0.9063992507699015 + ] + }, + { + "marker_id": 44, + "position_m": [ + 0.2617374306339859, + -0.17309016437089178, + 0.2992287802748165 + ], + "position_mm": [ + 261.7374306339859, + -173.09016437089178, + 299.2287802748165 + ], + "link": "FingerB", + "normal": [ + 0.0, + -0.9375276894468237, + -0.34791066600565723 + ] + }, + { + "marker_id": 46, + "position_m": [ + 0.5367099999996267, + 0.1854399999993049, + -0.027300000000316856 + ], + "position_mm": [ + 536.7099999996267, + 185.43999999930492, + -27.300000000316857 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 47, + "position_m": [ + 0.34423000000046733, + -0.28654000000046165, + -0.027299999999823587 + ], + "position_mm": [ + 344.2300000004673, + -286.54000000046165, + -27.299999999823587 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 51, + "position_m": [ + 0.167800000000231, + -0.1720799999997127, + -0.027300000000188215 + ], + "position_mm": [ + 167.800000000231, + -172.07999999971273, + -27.300000000188216 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 53, + "position_m": [ + 0.4862500000007278, + 0.21224000000026363, + -0.02729999999969242 + ], + "position_mm": [ + 486.2500000007278, + 212.24000000026362, + -27.29999999969242 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 54, + "position_m": [ + 0.34227000000027796, + -0.33059000000006933, + -0.02729999999995071 + ], + "position_mm": [ + 342.27000000027795, + -330.5900000000693, + -27.29999999995071 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 55, + "position_m": [ + 0.28371999999999303, + -0.2625800000002415, + -0.02729999999998384 + ], + "position_mm": [ + 283.71999999999304, + -262.5800000002415, + -27.29999999998384 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 56, + "position_m": [ + 0.49867999999987467, + 0.16867000000012627, + -0.027300000000010576 + ], + "position_mm": [ + 498.67999999987467, + 168.67000000012627, + -27.300000000010577 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 58, + "position_m": [ + 0.050090000000153206, + -0.21810999999946723, + -0.027299999999801608 + ], + "position_mm": [ + 50.0900000001532, + -218.10999999946722, + -27.299999999801607 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 60, + "position_m": [ + 0.43435999999996955, + 0.2838099999999524, + -0.027300000000045534 + ], + "position_mm": [ + 434.35999999996955, + 283.80999999995237, + -27.300000000045536 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 61, + "position_m": [ + -0.022420000000095835, + 0.3358300000002168, + -0.02729999999981459 + ], + "position_mm": [ + -22.420000000095836, + 335.8300000002168, + -27.29999999981459 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 62, + "position_m": [ + 0.4047000000000739, + -0.17509999999977685, + -0.027300000000285374 + ], + "position_mm": [ + 404.7000000000739, + -175.09999999977686, + -27.300000000285372 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 63, + "position_m": [ + 0.7773999999997002, + -0.2361500000002749, + -0.027300000000314236 + ], + "position_mm": [ + 777.3999999997002, + -236.1500000002749, + -27.300000000314235 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 64, + "position_m": [ + -0.021270000000128412, + -0.1882300000000859, + -0.027299999999901587 + ], + "position_mm": [ + -21.270000000128412, + -188.2300000000859, + -27.299999999901587 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 66, + "position_m": [ + 0.20975000000019012, + -0.3632299999997856, + -0.027300000000158777 + ], + "position_mm": [ + 209.7500000001901, + -363.2299999997856, + -27.30000000015878 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 68, + "position_m": [ + 0.5737299999999939, + 0.1706399999996911, + -0.027300000000106094 + ], + "position_mm": [ + 573.7299999999939, + 170.6399999996911, + -27.300000000106092 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 69, + "position_m": [ + 0.007610000000193365, + -0.2812099999985484, + -0.02730000000039978 + ], + "position_mm": [ + 7.610000000193365, + -281.2099999985484, + -27.30000000039978 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 72, + "position_m": [ + 0.4409899999988313, + 0.19431999999917843, + -0.027299999999699228 + ], + "position_mm": [ + 440.9899999988313, + 194.31999999917844, + -27.299999999699228 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 73, + "position_m": [ + 0.22172999999984083, + 0.33310999999966306, + -0.027300000000112522 + ], + "position_mm": [ + 221.72999999984083, + 333.10999999966305, + -27.300000000112522 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 75, + "position_m": [ + -0.025700000000004105, + 0.19457999999989567, + -0.02730000000010799 + ], + "position_mm": [ + -25.700000000004106, + 194.57999999989568, + -27.300000000107993 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 79, + "position_m": [ + 0.3123000000002769, + -0.15910999999885458, + -0.027300000000013244 + ], + "position_mm": [ + 312.3000000002769, + -159.1099999988546, + -27.300000000013245 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 82, + "position_m": [ + 0.21916000000021985, + 0.2972400000001464, + -0.027299999999950055 + ], + "position_mm": [ + 219.16000000021984, + 297.2400000001464, + -27.299999999950057 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 83, + "position_m": [ + 0.04416000000008248, + 0.3392200000000236, + -0.027300000000031334 + ], + "position_mm": [ + 44.16000000008248, + 339.2200000000236, + -27.300000000031336 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 84, + "position_m": [ + 0.4074899999995396, + 0.25841999999976273, + -0.027300000000120173 + ], + "position_mm": [ + 407.48999999953963, + 258.41999999976275, + -27.30000000012017 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 85, + "position_m": [ + 0.5045799999999991, + -0.31274999999938374, + -0.027300000000350388 + ], + "position_mm": [ + 504.57999999999913, + -312.74999999938376, + -27.300000000350387 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 86, + "position_m": [ + 0.3628900000017979, + 0.2920100000003413, + -0.02729999999999367 + ], + "position_mm": [ + 362.8900000017979, + 292.0100000003413, + -27.29999999999367 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 92, + "position_m": [ + 0.6450900000004091, + -0.1848400000004422, + -0.02729999999986366 + ], + "position_mm": [ + 645.0900000004091, + -184.84000000044222, + -27.299999999863658 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 95, + "position_m": [ + 0.1860399999997524, + -0.2740700000003523, + -0.027299999999967284 + ], + "position_mm": [ + 186.0399999997524, + -274.0700000003523, + -27.299999999967284 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 96, + "position_m": [ + 0.3697699999999026, + -0.18648999999996202, + -0.027299999999914965 + ], + "position_mm": [ + 369.7699999999026, + -186.489999999962, + -27.299999999914967 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 97, + "position_m": [ + 0.30434999999945905, + -0.35967000000058796, + -0.027299999999546368 + ], + "position_mm": [ + 304.34999999945904, + -359.67000000058795, + -27.29999999954637 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 102, + "position_m": [ + 0.6496899999998036, + -0.2229999999997836, + -0.0273000000003147 + ], + "position_mm": [ + 649.6899999998036, + -222.9999999997836, + -27.3000000003147 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 103, + "position_m": [ + 0.1057100000003755, + -0.1877099999997814, + -0.02729999999991397 + ], + "position_mm": [ + 105.7100000003755, + -187.70999999978142, + -27.299999999913968 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 105, + "position_m": [ + 0.5248399999991372, + -0.2662500000010908, + -0.027299999999337996 + ], + "position_mm": [ + 524.8399999991373, + -266.25000000109077, + -27.299999999337995 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 114, + "position_m": [ + 0.2901128906698489, + -0.17587019669520298, + 0.2359571272029921 + ], + "position_mm": [ + 290.1128906698489, + -175.870196695203, + 235.95712720299213 + ], + "link": "Arm2", + "normal": [ + 0.7071067811865475, + 0.0, + -0.7071067811865475 + ] + }, + { + "marker_id": 115, + "position_m": [ + 0.24109585009058732, + -0.1689745239013547, + 0.236372767398788 + ], + "position_mm": [ + 241.0958500905873, + -168.9745239013547, + 236.372767398788 + ], + "link": "Arm2", + "normal": [ + -0.7071067811865475, + 0.0, + -0.7071067811865475 + ] + }, + { + "marker_id": 120, + "position_m": [ + 0.31011744859978313, + -0.22947159364089295, + 0.19561991694978856 + ], + "position_mm": [ + 310.11744859978313, + -229.47159364089296, + 195.61991694978855 + ], + "link": "Arm2", + "normal": [ + 0.7071067811865475, + 0.0, + -0.7071067811865475 + ] + }, + { + "marker_id": 198, + "position_m": [ + 0.15215307004183598, + -0.0535230658667324, + 0.09110677205353056 + ], + "position_mm": [ + 152.15307004183597, + -53.5230658667324, + 91.10677205353056 + ], + "link": "Arm1", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 205, + "position_m": [ + 0.7500000000002738, + -0.08999999999993481, + 0.0003000000001682296 + ], + "position_mm": [ + 750.0000000002738, + -89.99999999993481, + 0.3000000001682296 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 206, + "position_m": [ + 0.6500000000009252, + -0.009999999999228081, + 0.0002999999997306501 + ], + "position_mm": [ + 650.0000000009252, + -9.99999999922808, + 0.2999999997306501 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 207, + "position_m": [ + 0.7500000000005664, + -0.010000000000251384, + 0.0002999999999712242 + ], + "position_mm": [ + 750.0000000005664, + -10.000000000251385, + 0.29999999997122423 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 208, + "position_m": [ + 0.34999999999987735, + -0.08999999999988054, + 0.0003000000004329039 + ], + "position_mm": [ + 349.99999999987733, + -89.99999999988054, + 0.3000000004329039 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 210, + "position_m": [ + 0.019999999999695622, + -0.020000000000526735, + 0.00029999999988919804 + ], + "position_mm": [ + 19.99999999969562, + -20.000000000526736, + 0.299999999889198 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 211, + "position_m": [ + 0.24999999999926867, + -0.010000000000759908, + 0.00029999999955836827 + ], + "position_mm": [ + 249.99999999926868, + -10.000000000759908, + 0.29999999955836826 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 214, + "position_m": [ + 0.34999999999907455, + -0.010000000000522676, + 0.00029999999980760103 + ], + "position_mm": [ + 349.99999999907453, + -10.000000000522675, + 0.29999999980760106 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 215, + "position_m": [ + 0.24999999999952763, + -0.09000000000038667, + 0.0003000000002370847 + ], + "position_mm": [ + 249.99999999952763, + -90.00000000038668, + 0.3000000002370847 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 217, + "position_m": [ + 0.6500000000007565, + -0.08999999999883199, + 0.00029999999977357893 + ], + "position_mm": [ + 650.0000000007565, + -89.99999999883198, + 0.29999999977357894 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 219, + "position_m": [ + 0.30359101071736105, + -0.15023058470875128, + 0.2712786697444754 + ], + "position_mm": [ + 303.59101071736103, + -150.23058470875128, + 271.2786697444754 + ], + "link": "Arm2", + "normal": [ + 1.0, + 0.0, + 0.0 + ] + }, + { + "marker_id": 229, + "position_m": [ + 0.16001670704894239, + -0.14308129133186565, + 0.08692479867639784 + ], + "position_mm": [ + 160.01670704894238, + -143.08129133186566, + 86.92479867639784 + ], + "link": "Arm1", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 232, + "position_m": [ + 0.2302931530003997, + -0.09276301264006315, + 0.01395286428478417 + ], + "position_mm": [ + 230.2931530003997, + -92.76301264006315, + 13.952864284784171 + ], + "link": "Ellbow", + "normal": [ + 0.0, + 0.7071067811865475, + -0.7071067811865475 + ] + }, + { + "marker_id": 243, + "position_m": [ + 0.16002569672521705, + -0.17674405987144298, + 0.050636757872106024 + ], + "position_mm": [ + 160.02569672521705, + -176.74405987144297, + 50.636757872106024 + ], + "link": "Arm1", + "normal": [ + 0.0, + -1.0, + 0.0 + ] + }, + { + "marker_id": 244, + "position_m": [ + 0.2771463546934564, + -0.11747452803675207, + 0.04012135475939938 + ], + "position_mm": [ + 277.1463546934564, + -117.47452803675206, + 40.12135475939938 + ], + "link": "Ellbow", + "normal": [ + 1.0, + 0.0, + 0.0 + ] + }, + { + "marker_id": 245, + "position_m": [ + 0.2307917251434679, + -0.11805720690942209, + 0.02277363833736442 + ], + "position_mm": [ + 230.79172514346791, + -118.05720690942209, + 22.77363833736442 + ], + "link": "Ellbow", + "normal": [ + 0.0, + 0.0, + -1.0 + ] + }, + { + "marker_id": 248, + "position_m": [ + 0.2091157716160431, + -0.14567683413597038, + 0.03595414293355679 + ], + "position_mm": [ + 209.1157716160431, + -145.67683413597038, + 35.95414293355679 + ], + "link": "Ellbow", + "normal": [ + 0.0, + 0.0, + -1.0 + ] + } + ] +} \ No newline at end of file diff --git a/data/evaluations/Scene8/render_a_aruco_detection.json b/data/evaluations/Scene8/render_a_aruco_detection.json new file mode 100644 index 0000000..01ec1d0 --- /dev/null +++ b/data/evaluations/Scene8/render_a_aruco_detection.json @@ -0,0 +1,1938 @@ +{ + "schema_version": "1.0", + "created_utc": "2026-06-01T18:36:41Z", + "vision_config": { + "MarkerType": "DICT_4X4_250", + "MarkerSize": 0.025 + }, + "camera": { + "camera_id": "a", + "intrinsics_file": "C:\\Users\\kech\\SynologyDrive\\2026-AppServer-AppRobot\\appRobotRendering\\data\\simulation\\Scene8\\render_a.npz", + "camera_matrix": [ + [ + 1777.77783203125, + 0.0, + 640.0 + ], + [ + 0.0, + 1777.77783203125, + 360.0 + ], + [ + 0.0, + 0.0, + 1.0 + ] + ], + "distortion_coefficients": [ + 0.0, + 0.0, + 0.0, + 0.0, + 0.0 + ] + }, + "image": { + "image_file": "C:\\Users\\kech\\SynologyDrive\\2026-AppServer-AppRobot\\appRobotRendering\\data\\simulation\\Scene8\\render_a.png", + "image_sha256": "452efbd0df4d87bec69eb8d0157e6ffcd3322f9790be6a8d99600317f70cf098", + "width_px": 1280, + "height_px": 720 + }, + "aruco": { + "dictionary": "DICT_4X4_250", + "num_detected_markers": 28, + "num_rejected_candidates": 15 + }, + "detections": [ + { + "observation_id": "5274cf80-2868-46ce-bf0c-5649e24be148", + "type": "aruco", + "marker_id": 45, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 787.0, + 182.0 + ], + [ + 799.0, + 149.0 + ], + [ + 844.0, + 156.0 + ], + [ + 831.0, + 189.0 + ] + ], + "center_px": [ + 815.25, + 169.0 + ], + "quality": { + "area_px": 1556.0, + "perimeter_px": 160.6769256591797, + "sharpness": { + "laplacian_var": 1884.7728985568926 + }, + "contrast": { + "p05": 23.050000000000004, + "p95": 185.0, + "dynamic_range": 161.95, + "mean_gray": 102.2984934086629, + "std_gray": 74.79305018212338 + }, + "geometry": { + "distance_to_center_norm": 0.3530115485191345, + "distance_to_border_px": 149.0 + }, + "edge_ratio": 1.2969487833232356, + "edge_lengths_px": [ + 35.11410140991211, + 45.54119110107422, + 35.46829605102539, + 44.55333709716797 + ] + }, + "confidence": 0.771040470416766 + }, + { + "observation_id": "d2dd18bb-ca42-4b77-9bdd-6c8334fd08ea", + "type": "aruco", + "marker_id": 115, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 763.0, + 333.0 + ], + [ + 722.0, + 339.0 + ], + [ + 722.0, + 302.0 + ], + [ + 764.0, + 297.0 + ] + ], + "center_px": [ + 742.75, + 317.75 + ], + "quality": { + "area_px": 1512.0, + "perimeter_px": 156.7471580505371, + "sharpness": { + "laplacian_var": 2072.7021204739626 + }, + "contrast": { + "p05": 23.0, + "p95": 189.0, + "dynamic_range": 166.0, + "mean_gray": 59.65856129685917, + "std_gray": 62.63989761492874 + }, + "geometry": { + "distance_to_center_norm": 0.1512964814901352, + "distance_to_border_px": 297.0 + }, + "edge_ratio": 1.1744518275099716, + "edge_lengths_px": [ + 41.43669891357422, + 37.0, + 42.296573638916016, + 36.013885498046875 + ] + }, + "confidence": 0.8514610617279742 + }, + { + "observation_id": "2d19aed0-4fd4-450f-93e5-39b49f0757e2", + "type": "aruco", + "marker_id": 124, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 713.0, + 282.0 + ], + [ + 677.0, + 271.0 + ], + [ + 676.0, + 233.0 + ], + [ + 713.0, + 244.0 + ] + ], + "center_px": [ + 694.75, + 257.5 + ], + "quality": { + "area_px": 1381.5, + "perimeter_px": 152.25673294067383, + "sharpness": { + "laplacian_var": 2794.8808983352155 + }, + "contrast": { + "p05": 23.0, + "p95": 185.0, + "dynamic_range": 162.0, + "mean_gray": 92.91675231243576, + "std_gray": 73.635070407888 + }, + "geometry": { + "distance_to_center_norm": 0.158253476023674, + "distance_to_border_px": 233.0 + }, + "edge_ratio": 1.025435193823368, + "edge_lengths_px": [ + 37.64305877685547, + 38.01315689086914, + 38.60051727294922, + 38.0 + ] + }, + "confidence": 0.8981552472038941 + }, + { + "observation_id": "9dd05509-127c-4428-a2e0-c3948b18f21d", + "type": "aruco", + "marker_id": 41, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 735.0, + 114.0 + ], + [ + 755.0, + 92.0 + ], + [ + 787.0, + 122.0 + ], + [ + 769.0, + 144.0 + ] + ], + "center_px": [ + 761.5, + 118.0 + ], + "quality": { + "area_px": 1296.0, + "perimeter_px": 147.36404037475586, + "sharpness": { + "laplacian_var": 3099.0323703815475 + }, + "contrast": { + "p05": 12.0, + "p95": 185.0, + "dynamic_range": 173.0, + "mean_gray": 61.550827423167846, + "std_gray": 70.34625032155978 + }, + "geometry": { + "distance_to_center_norm": 0.3687693476676941, + "distance_to_border_px": 92.0 + }, + "edge_ratio": 1.595165960827521, + "edge_lengths_px": [ + 29.73213768005371, + 43.863426208496094, + 28.42534065246582, + 45.343135833740234 + ] + }, + "confidence": 0.541636432331959 + }, + { + "observation_id": "71ad6f2e-5979-4194-95b1-d5cf8b8daaad", + "type": "aruco", + "marker_id": 122, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 714.0, + 438.0 + ], + [ + 680.0, + 426.0 + ], + [ + 679.0, + 392.0 + ], + [ + 714.0, + 404.0 + ] + ], + "center_px": [ + 696.75, + 415.0 + ], + "quality": { + "area_px": 1167.0, + "perimeter_px": 141.0702133178711, + "sharpness": { + "laplacian_var": 2621.5445564656843 + }, + "contrast": { + "p05": 22.0, + "p95": 183.0, + "dynamic_range": 161.0, + "mean_gray": 70.1486146095718, + "std_gray": 68.1378479759675 + }, + "geometry": { + "distance_to_center_norm": 0.10762442648410797, + "distance_to_border_px": 282.0 + }, + "edge_ratio": 1.088235294117647, + "edge_lengths_px": [ + 36.055511474609375, + 34.01470184326172, + 37.0, + 34.0 + ] + }, + "confidence": 0.714918918918919 + }, + { + "observation_id": "2739652e-9823-4a21-b433-7fb36d10a516", + "type": "aruco", + "marker_id": 229, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 587.0, + 543.0 + ], + [ + 619.0, + 528.0 + ], + [ + 642.0, + 551.0 + ], + [ + 609.0, + 566.0 + ] + ], + "center_px": [ + 614.25, + 547.0 + ], + "quality": { + "area_px": 1085.0, + "perimeter_px": 135.9449062347412, + "sharpness": { + "laplacian_var": 3235.04788499762 + }, + "contrast": { + "p05": 12.0, + "p95": 181.0, + "dynamic_range": 169.0, + "mean_gray": 63.97222222222222, + "std_gray": 70.76769523386021 + }, + "geometry": { + "distance_to_center_norm": 0.257066547870636, + "distance_to_border_px": 154.0 + }, + "edge_ratio": 1.138919297044543, + "edge_lengths_px": [ + 35.34119415283203, + 32.526912689208984, + 36.24913787841797, + 31.827661514282227 + ] + }, + "confidence": 0.6351049940152554 + }, + { + "observation_id": "90a03cbc-e897-455b-88ec-ed6e0d3c53b3", + "type": "aruco", + "marker_id": 47, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 984.0, + 710.0 + ], + [ + 957.0, + 687.0 + ], + [ + 985.0, + 672.0 + ], + [ + 1011.0, + 694.0 + ] + ], + "center_px": [ + 984.25, + 690.75 + ], + "quality": { + "area_px": 1029.5, + "perimeter_px": 132.67654037475586, + "sharpness": { + "laplacian_var": 4016.1608887125567 + }, + "contrast": { + "p05": 10.0, + "p95": 176.0, + "dynamic_range": 166.0, + "mean_gray": 69.43943661971831, + "std_gray": 72.32612852412493 + }, + "geometry": { + "distance_to_center_norm": 0.6501306891441345, + "distance_to_border_px": 10.0 + }, + "edge_ratio": 1.13011385794403, + "edge_lengths_px": [ + 35.46829605102539, + 31.764760971069336, + 34.058773040771484, + 31.38471031188965 + ] + }, + "confidence": 0.12146268776527554 + }, + { + "observation_id": "07eefb9e-29d3-41f8-84b9-6f108856fce0", + "type": "aruco", + "marker_id": 248, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 733.0, + 561.0 + ], + [ + 732.0, + 592.0 + ], + [ + 702.0, + 607.0 + ], + [ + 701.0, + 577.0 + ] + ], + "center_px": [ + 717.0, + 584.25 + ], + "quality": { + "area_px": 945.5, + "perimeter_px": 130.35089492797852, + "sharpness": { + "laplacian_var": 3372.2735133733277 + }, + "contrast": { + "p05": 21.0, + "p95": 179.0, + "dynamic_range": 158.0, + "mean_gray": 89.61990950226244, + "std_gray": 70.13968197979732 + }, + "geometry": { + "distance_to_center_norm": 0.3228933811187744, + "distance_to_border_px": 113.0 + }, + "edge_ratio": 1.191907596285429, + "edge_lengths_px": [ + 31.016124725341797, + 33.541019439697266, + 30.01666259765625, + 35.7770881652832 + ] + }, + "confidence": 0.5288441279322007 + }, + { + "observation_id": "d3eb334b-744d-4792-a328-c4420439a449", + "type": "aruco", + "marker_id": 210, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 298.0, + 629.0 + ], + [ + 333.0, + 614.0 + ], + [ + 350.0, + 635.0 + ], + [ + 315.0, + 650.0 + ] + ], + "center_px": [ + 324.0, + 632.0 + ], + "quality": { + "area_px": 990.0, + "perimeter_px": 130.19475555419922, + "sharpness": { + "laplacian_var": 3719.8279100425507 + }, + "contrast": { + "p05": 20.0, + "p95": 181.0, + "dynamic_range": 161.0, + "mean_gray": 81.0811209439528, + "std_gray": 68.45075031584739 + }, + "geometry": { + "distance_to_center_norm": 0.5678059458732605, + "distance_to_border_px": 70.0 + }, + "edge_ratio": 1.4093619970008786, + "edge_lengths_px": [ + 38.07886505126953, + 27.018512725830078, + 38.07886505126953, + 27.018512725830078 + ] + }, + "confidence": 0.46829700346999537 + }, + { + "observation_id": "d61be010-2c31-4907-b3b2-918aa1f4e53a", + "type": "aruco", + "marker_id": 243, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 632.0, + 618.0 + ], + [ + 665.0, + 601.0 + ], + [ + 663.0, + 630.0 + ], + [ + 631.0, + 646.0 + ] + ], + "center_px": [ + 647.75, + 623.75 + ], + "quality": { + "area_px": 901.5, + "perimeter_px": 129.98524475097656, + "sharpness": { + "laplacian_var": 3127.526931401588 + }, + "contrast": { + "p05": 23.0, + "p95": 177.0, + "dynamic_range": 154.0, + "mean_gray": 78.13101160862355, + "std_gray": 67.61397416677319 + }, + "geometry": { + "distance_to_center_norm": 0.35933947563171387, + "distance_to_border_px": 74.0 + }, + "edge_ratio": 1.3249203865938097, + "edge_lengths_px": [ + 37.121421813964844, + 29.068883895874023, + 35.7770881652832, + 28.017850875854492 + ] + }, + "confidence": 0.45361216121452347 + }, + { + "observation_id": "9c501e37-1363-4bfc-a65a-64da8a320098", + "type": "aruco", + "marker_id": 245, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 780.0, + 538.0 + ], + [ + 779.0, + 567.0 + ], + [ + 750.0, + 583.0 + ], + [ + 750.0, + 553.0 + ] + ], + "center_px": [ + 764.75, + 560.25 + ], + "quality": { + "area_px": 862.5, + "perimeter_px": 125.67924690246582, + "sharpness": { + "laplacian_var": 3106.9204530342054 + }, + "contrast": { + "p05": 19.0, + "p95": 178.0, + "dynamic_range": 159.0, + "mean_gray": 83.07578253706754, + "std_gray": 70.35797516180159 + }, + "geometry": { + "distance_to_center_norm": 0.32129716873168945, + "distance_to_border_px": 137.0 + }, + "edge_ratio": 1.1558998458528866, + "edge_lengths_px": [ + 29.017236709594727, + 33.12099075317383, + 30.0, + 33.541019439697266 + ] + }, + "confidence": 0.4974479424519113 + }, + { + "observation_id": "effc2a93-a615-41b8-a334-2d21f07b041c", + "type": "aruco", + "marker_id": 198, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 506.0, + 463.0 + ], + [ + 538.0, + 450.0 + ], + [ + 558.0, + 470.0 + ], + [ + 526.0, + 483.0 + ] + ], + "center_px": [ + 532.0, + 466.5 + ], + "quality": { + "area_px": 900.0, + "perimeter_px": 125.64820861816406, + "sharpness": { + "laplacian_var": 4772.492698756085 + }, + "contrast": { + "p05": 10.0, + "p95": 178.0, + "dynamic_range": 168.0, + "mean_gray": 85.54651162790698, + "std_gray": 73.10693025938691 + }, + "geometry": { + "distance_to_center_norm": 0.20656083524227142, + "distance_to_border_px": 237.0 + }, + "edge_ratio": 1.2211675095137238, + "edge_lengths_px": [ + 34.539833068847656, + 28.284271240234375, + 34.539833068847656, + 28.284271240234375 + ] + }, + "confidence": 0.49133308520378466 + }, + { + "observation_id": "95cd21ab-90ef-43f0-af3f-5d7cdc851ff9", + "type": "aruco", + "marker_id": 85, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 1186.0, + 628.0 + ], + [ + 1158.0, + 607.0 + ], + [ + 1181.0, + 593.0 + ], + [ + 1210.0, + 613.0 + ] + ], + "center_px": [ + 1183.75, + 610.25 + ], + "quality": { + "area_px": 895.0, + "perimeter_px": 125.45559501647949, + "sharpness": { + "laplacian_var": 3877.4702820845573 + }, + "contrast": { + "p05": 9.0, + "p95": 172.0, + "dynamic_range": 163.0, + "mean_gray": 114.16363636363636, + "std_gray": 68.12100075455184 + }, + "geometry": { + "distance_to_center_norm": 0.8151581883430481, + "distance_to_border_px": 70.0 + }, + "edge_ratio": 1.3083287631564071, + "edge_lengths_px": [ + 35.0, + 26.925823211669922, + 35.22782897949219, + 28.301942825317383 + ] + }, + "confidence": 0.4560525484643318 + }, + { + "observation_id": "2903bb6e-d2be-44b1-a71d-5e4d0258ce59", + "type": "aruco", + "marker_id": 79, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 812.0, + 616.0 + ], + [ + 789.0, + 596.0 + ], + [ + 816.0, + 582.0 + ], + [ + 839.0, + 602.0 + ] + ], + "center_px": [ + 814.0, + 599.0 + ], + "quality": { + "area_px": 862.0, + "perimeter_px": 121.78662872314453, + "sharpness": { + "laplacian_var": 4199.987348229773 + }, + "contrast": { + "p05": 13.0, + "p95": 174.0, + "dynamic_range": 161.0, + "mean_gray": 96.36363636363636, + "std_gray": 69.126432919622 + }, + "geometry": { + "distance_to_center_norm": 0.402599573135376, + "distance_to_border_px": 104.0 + }, + "edge_ratio": 1.0021598438741428, + "edge_lengths_px": [ + 30.479501724243164, + 30.4138126373291, + 30.479501724243164, + 30.4138126373291 + ] + }, + "confidence": 0.5734281513866332 + }, + { + "observation_id": "77949281-29a0-43ae-b38d-8dc057ea4041", + "type": "aruco", + "marker_id": 96, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 904.0, + 604.0 + ], + [ + 880.0, + 584.0 + ], + [ + 907.0, + 571.0 + ], + [ + 930.0, + 590.0 + ] + ], + "center_px": [ + 905.25, + 587.25 + ], + "quality": { + "area_px": 834.0, + "perimeter_px": 120.57016181945801, + "sharpness": { + "laplacian_var": 3511.7835782691755 + }, + "contrast": { + "p05": 11.0, + "p95": 174.0, + "dynamic_range": 163.0, + "mean_gray": 85.89929328621908, + "std_gray": 73.32881629928247 + }, + "geometry": { + "distance_to_center_norm": 0.47566938400268555, + "distance_to_border_px": 116.0 + }, + "edge_ratio": 1.057953735938787, + "edge_lengths_px": [ + 31.240999221801758, + 29.96664810180664, + 29.832868576049805, + 29.529645919799805 + ] + }, + "confidence": 0.525542829627259 + }, + { + "observation_id": "e818ff66-15a7-455f-b31f-40edcf4f6326", + "type": "aruco", + "marker_id": 62, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 930.0, + 573.0 + ], + [ + 906.0, + 555.0 + ], + [ + 932.0, + 542.0 + ], + [ + 956.0, + 560.0 + ] + ], + "center_px": [ + 931.0, + 557.5 + ], + "quality": { + "area_px": 780.0, + "perimeter_px": 118.13776779174805, + "sharpness": { + "laplacian_var": 2255.1631305200085 + }, + "contrast": { + "p05": 11.0, + "p95": 172.0, + "dynamic_range": 161.0, + "mean_gray": 41.578034682080926, + "std_gray": 54.64618353501844 + }, + "geometry": { + "distance_to_center_norm": 0.47894710302352905, + "distance_to_border_px": 147.0 + }, + "edge_ratio": 1.03203136754274, + "edge_lengths_px": [ + 30.0, + 29.068883895874023, + 30.0, + 29.068883895874023 + ] + }, + "confidence": 0.5038606541951498 + }, + { + "observation_id": "770364da-1252-4258-b222-e906c271bd71", + "type": "aruco", + "marker_id": 105, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 1151.0, + 576.0 + ], + [ + 1125.0, + 557.0 + ], + [ + 1150.0, + 545.0 + ], + [ + 1175.0, + 563.0 + ] + ], + "center_px": [ + 1150.25, + 560.25 + ], + "quality": { + "area_px": 772.0, + "perimeter_px": 118.03386306762695, + "sharpness": { + "laplacian_var": 2165.3406379290254 + }, + "contrast": { + "p05": 9.0, + "p95": 169.0, + "dynamic_range": 160.0, + "mean_gray": 38.08206106870229, + "std_gray": 54.08121316248408 + }, + "geometry": { + "distance_to_center_norm": 0.7464743256568909, + "distance_to_border_px": 105.0 + }, + "edge_ratio": 1.1798077703177934, + "edge_lengths_px": [ + 32.202484130859375, + 27.73084831237793, + 30.805843353271484, + 27.294687271118164 + ] + }, + "confidence": 0.43622925667631085 + }, + { + "observation_id": "571b3338-e4c9-4340-8815-d76224fac638", + "type": "aruco", + "marker_id": 75, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 119.0, + 530.0 + ], + [ + 106.0, + 512.0 + ], + [ + 138.0, + 500.0 + ], + [ + 151.0, + 517.0 + ] + ], + "center_px": [ + 128.5, + 514.75 + ], + "quality": { + "area_px": 722.5, + "perimeter_px": 112.32038497924805, + "sharpness": { + "laplacian_var": 3773.2261386138607 + }, + "contrast": { + "p05": 10.0, + "p95": 173.0, + "dynamic_range": 163.0, + "mean_gray": 103.09306930693069, + "std_gray": 67.28836460615932 + }, + "geometry": { + "distance_to_center_norm": 0.7277610301971436, + "distance_to_border_px": 106.0 + }, + "edge_ratio": 1.6139404343199748, + "edge_lengths_px": [ + 22.203603744506836, + 34.1760139465332, + 21.40093421936035, + 34.539833068847656 + ] + }, + "confidence": 0.29844141482805986 + }, + { + "observation_id": "99c073eb-661c-439f-b72d-789840f4d9f9", + "type": "aruco", + "marker_id": 102, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 1220.0, + 475.0 + ], + [ + 1194.0, + 459.0 + ], + [ + 1216.0, + 448.0 + ], + [ + 1241.0, + 464.0 + ] + ], + "center_px": [ + 1217.75, + 461.5 + ], + "quality": { + "area_px": 624.5, + "perimeter_px": 108.51360702514648, + "sharpness": { + "laplacian_var": 2999.5568367791234 + }, + "contrast": { + "p05": 9.0, + "p95": 167.0, + "dynamic_range": 158.0, + "mean_gray": 100.75615212527964, + "std_gray": 63.67992565911185 + }, + "geometry": { + "distance_to_center_norm": 0.7988508939743042, + "distance_to_border_px": 39.0 + }, + "edge_ratio": 1.2877744356086955, + "edge_lengths_px": [ + 30.528675079345703, + 24.59674835205078, + 29.681644439697266, + 23.706539154052734 + ] + }, + "confidence": 0.2521714913889437 + }, + { + "observation_id": "618982c5-61e0-4145-aeff-62f42fd722b3", + "type": "aruco", + "marker_id": 92, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 1174.0, + 451.0 + ], + [ + 1151.0, + 435.0 + ], + [ + 1172.0, + 425.0 + ], + [ + 1196.0, + 440.0 + ] + ], + "center_px": [ + 1173.25, + 437.75 + ], + "quality": { + "area_px": 580.0, + "perimeter_px": 104.17594909667969, + "sharpness": { + "laplacian_var": 2399.4602878848 + }, + "contrast": { + "p05": 10.0, + "p95": 166.2, + "dynamic_range": 156.2, + "mean_gray": 64.23021582733813, + "std_gray": 62.56783176214634 + }, + "geometry": { + "distance_to_center_norm": 0.733877956867218, + "distance_to_border_px": 84.0 + }, + "edge_ratio": 1.2167955430866773, + "edge_lengths_px": [ + 28.017850875854492, + 23.25940704345703, + 28.301942825317383, + 24.59674835205078 + ] + }, + "confidence": 0.31777455864589965 + }, + { + "observation_id": "3143d8a2-c201-43d8-9986-8f11428f37eb", + "type": "aruco", + "marker_id": 217, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 1066.0, + 345.0 + ], + [ + 1087.0, + 335.0 + ], + [ + 1110.0, + 349.0 + ], + [ + 1088.0, + 359.0 + ] + ], + "center_px": [ + 1087.75, + 347.0 + ], + "quality": { + "area_px": 526.0, + "perimeter_px": 100.42813110351562, + "sharpness": { + "laplacian_var": 2699.530849509037 + }, + "contrast": { + "p05": 9.0, + "p95": 163.0, + "dynamic_range": 154.0, + "mean_gray": 70.710027100271, + "std_gray": 60.38996966419693 + }, + "geometry": { + "distance_to_center_norm": 0.6100193858146667, + "distance_to_border_px": 170.0 + }, + "edge_ratio": 1.1576315407079247, + "edge_lengths_px": [ + 23.25940704345703, + 26.925823211669922, + 24.166091918945312, + 26.07680892944336 + ] + }, + "confidence": 0.3029173397022545 + }, + { + "observation_id": "30ef43bd-ab2e-4187-aac6-1cdd79ced4a5", + "type": "aruco", + "marker_id": 61, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 49.0, + 428.0 + ], + [ + 38.0, + 414.0 + ], + [ + 68.0, + 403.0 + ], + [ + 79.0, + 417.0 + ] + ], + "center_px": [ + 58.5, + 415.5 + ], + "quality": { + "area_px": 541.0, + "perimeter_px": 99.51516723632812, + "sharpness": { + "laplacian_var": 3838.7209214938143 + }, + "contrast": { + "p05": 9.55, + "p95": 168.0, + "dynamic_range": 158.45, + "mean_gray": 100.15591397849462, + "std_gray": 64.25731532325125 + }, + "geometry": { + "distance_to_center_norm": 0.7955067753791809, + "distance_to_border_px": 38.0 + }, + "edge_ratio": 1.7946644567002925, + "edge_lengths_px": [ + 17.804492950439453, + 31.95309066772461, + 17.804492950439453, + 31.95309066772461 + ] + }, + "confidence": 0.1527342148240039 + }, + { + "observation_id": "d0ebec43-0633-4d46-9e89-9998ccb5dee4", + "type": "aruco", + "marker_id": 83, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 130.0, + 395.0 + ], + [ + 119.0, + 381.0 + ], + [ + 147.0, + 371.0 + ], + [ + 160.0, + 385.0 + ] + ], + "center_px": [ + 139.0, + 383.0 + ], + "quality": { + "area_px": 526.0, + "perimeter_px": 98.26437950134277, + "sharpness": { + "laplacian_var": 3502.8386959876543 + }, + "contrast": { + "p05": 10.0, + "p95": 167.0, + "dynamic_range": 157.0, + "mean_gray": 99.26666666666667, + "std_gray": 60.72415774083106 + }, + "geometry": { + "distance_to_center_norm": 0.6829988360404968, + "distance_to_border_px": 119.0 + }, + "edge_ratio": 1.7761121375104154, + "edge_lengths_px": [ + 17.804492950439453, + 29.73213768005371, + 19.10497283935547, + 31.62277603149414 + ] + }, + "confidence": 0.19743498130596515 + }, + { + "observation_id": "72d5fa90-7342-453b-9caa-cebba061d211", + "type": "aruco", + "marker_id": 206, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 992.0, + 299.0 + ], + [ + 1013.0, + 290.0 + ], + [ + 1034.0, + 303.0 + ], + [ + 1013.0, + 312.0 + ] + ], + "center_px": [ + 1013.0, + 301.0 + ], + "quality": { + "area_px": 462.0, + "perimeter_px": 95.09099197387695, + "sharpness": { + "laplacian_var": 2259.910631309085 + }, + "contrast": { + "p05": 11.0, + "p95": 161.0, + "dynamic_range": 150.0, + "mean_gray": 75.7246835443038, + "std_gray": 57.59222234179668 + }, + "geometry": { + "distance_to_center_norm": 0.5142804980278015, + "distance_to_border_px": 246.0 + }, + "edge_ratio": 1.0810098864013458, + "edge_lengths_px": [ + 22.847318649291992, + 24.698177337646484, + 22.847318649291992, + 24.698177337646484 + ] + }, + "confidence": 0.2849187633475991 + }, + { + "observation_id": "f905b30f-c9e0-4c5f-a7c2-4b06f1cbf129", + "type": "aruco", + "marker_id": 207, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 1078.0, + 260.0 + ], + [ + 1098.0, + 252.0 + ], + [ + 1118.0, + 264.0 + ], + [ + 1098.0, + 272.0 + ] + ], + "center_px": [ + 1098.0, + 262.0 + ], + "quality": { + "area_px": 400.0, + "perimeter_px": 89.72893142700195, + "sharpness": { + "laplacian_var": 1929.1192009066358 + }, + "contrast": { + "p05": 11.0, + "p95": 159.0, + "dynamic_range": 148.0, + "mean_gray": 75.6875, + "std_gray": 56.63926650669716 + }, + "geometry": { + "distance_to_center_norm": 0.6378399133682251, + "distance_to_border_px": 162.0 + }, + "edge_ratio": 1.0827805600544524, + "edge_lengths_px": [ + 21.540658950805664, + 23.323806762695312, + 21.540658950805664, + 23.323806762695312 + ] + }, + "confidence": 0.24627951083020566 + }, + { + "observation_id": "353c8750-dfb9-4e6d-9c27-16e2bdfc3d2c", + "type": "aruco", + "marker_id": 84, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 576.0, + 290.0 + ], + [ + 560.0, + 278.0 + ], + [ + 583.0, + 270.0 + ], + [ + 598.0, + 281.0 + ] + ], + "center_px": [ + 579.25, + 279.75 + ], + "quality": { + "area_px": 390.5, + "perimeter_px": 86.7223949432373, + "sharpness": { + "laplacian_var": 2419.58984375 + }, + "contrast": { + "p05": 11.0, + "p95": 157.0, + "dynamic_range": 146.0, + "mean_gray": 88.72916666666667, + "std_gray": 51.87039387180963 + }, + "geometry": { + "distance_to_center_norm": 0.13707025349140167, + "distance_to_border_px": 270.0 + }, + "edge_ratio": 1.309149586031879, + "edge_lengths_px": [ + 20.0, + 24.351591110229492, + 18.601076126098633, + 23.76972770690918 + ] + }, + "confidence": 0.1988568274481309 + }, + { + "observation_id": "034d5a27-cb1e-4cbe-9188-0b72d7759bb8", + "type": "aruco", + "marker_id": 86, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 509.0, + 289.0 + ], + [ + 496.0, + 277.0 + ], + [ + 518.0, + 269.0 + ], + [ + 533.0, + 280.0 + ] + ], + "center_px": [ + 514.0, + 278.75 + ], + "quality": { + "area_px": 383.5, + "perimeter_px": 85.33429336547852, + "sharpness": { + "laplacian_var": 2992.6218059891316 + }, + "contrast": { + "p05": 9.9, + "p95": 157.0, + "dynamic_range": 147.1, + "mean_gray": 82.01075268817205, + "std_gray": 59.88037560493073 + }, + "geometry": { + "distance_to_center_norm": 0.20417363941669464, + "distance_to_border_px": 269.0 + }, + "edge_ratio": 1.448806880674699, + "edge_lengths_px": [ + 17.69180679321289, + 23.409399032592773, + 18.601076126098633, + 25.63201141357422 + ] + }, + "confidence": 0.17646704338372862 + }, + { + "observation_id": "7b7c6c5e-aad2-4915-ac37-55ab7b950d26", + "type": "aruco", + "marker_id": 93, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 1103.0, + 162.0 + ], + [ + 1088.0, + 153.0 + ], + [ + 1105.0, + 147.0 + ], + [ + 1121.0, + 156.0 + ] + ], + "center_px": [ + 1104.25, + 154.5 + ], + "quality": { + "area_px": 250.5, + "perimeter_px": 72.85183525085449, + "sharpness": { + "laplacian_var": 2764.4578213610584 + }, + "contrast": { + "p05": 12.0, + "p95": 141.24999999999997, + "dynamic_range": 129.24999999999997, + "mean_gray": 71.72282608695652, + "std_gray": 45.503873708158245 + }, + "geometry": { + "distance_to_center_norm": 0.6914032101631165, + "distance_to_border_px": 147.0 + }, + "edge_ratio": 1.0846522857079928, + "edge_lengths_px": [ + 17.492855072021484, + 18.027755737304688, + 18.357559204101562, + 18.973665237426758 + ] + }, + "confidence": 0.15396639291733288 + } + ], + "rejected_candidates": [ + { + "image_points_px": [ + [ + 1022.0, + 382.0 + ], + [ + 882.0, + 460.0 + ], + [ + 829.0, + 444.0 + ], + [ + 963.0, + 382.0 + ] + ], + "center_px": [ + 924.0, + 417.0 + ], + "area_px": 5016.0 + }, + { + "image_points_px": [ + [ + 1152.0, + 303.0 + ], + [ + 1172.0, + 294.0 + ], + [ + 1194.0, + 307.0 + ], + [ + 1174.0, + 316.0 + ] + ], + "center_px": [ + 1173.0, + 305.0 + ], + "area_px": 458.0 + }, + { + "image_points_px": [ + [ + 343.0, + 572.0 + ], + [ + 315.0, + 586.0 + ], + [ + 305.0, + 578.0 + ], + [ + 337.0, + 563.0 + ] + ], + "center_px": [ + 325.0, + 574.75 + ], + "area_px": 371.0 + }, + { + "image_points_px": [ + [ + 570.0, + 255.0 + ], + [ + 592.0, + 248.0 + ], + [ + 607.0, + 258.0 + ], + [ + 584.0, + 266.0 + ] + ], + "center_px": [ + 588.25, + 256.75 + ], + "area_px": 345.0 + }, + { + "image_points_px": [ + [ + 875.0, + 223.0 + ], + [ + 896.0, + 216.0 + ], + [ + 912.0, + 226.0 + ], + [ + 892.0, + 234.0 + ] + ], + "center_px": [ + 893.75, + 224.75 + ], + "area_px": 339.0 + }, + { + "image_points_px": [ + [ + 965.0, + 181.0 + ], + [ + 985.0, + 175.0 + ], + [ + 1001.0, + 185.0 + ], + [ + 983.0, + 192.0 + ] + ], + "center_px": [ + 983.5, + 183.25 + ], + "area_px": 310.0 + }, + { + "image_points_px": [ + [ + 1020.0, + 158.0 + ], + [ + 1037.0, + 152.0 + ], + [ + 1054.0, + 161.0 + ], + [ + 1037.0, + 168.0 + ] + ], + "center_px": [ + 1037.0, + 159.75 + ], + "area_px": 272.0 + }, + { + "image_points_px": [ + [ + 935.0, + 146.0 + ], + [ + 950.0, + 140.0 + ], + [ + 968.0, + 149.0 + ], + [ + 951.0, + 156.0 + ] + ], + "center_px": [ + 951.0, + 147.75 + ], + "area_px": 262.5 + }, + { + "image_points_px": [ + [ + 501.0, + 566.0 + ], + [ + 511.0, + 581.0 + ], + [ + 515.0, + 595.0 + ], + [ + 508.0, + 586.0 + ] + ], + "center_px": [ + 508.75, + 582.0 + ], + "area_px": 78.5 + }, + { + "image_points_px": [ + [ + 542.0, + 434.0 + ], + [ + 565.0, + 456.0 + ], + [ + 555.0, + 450.0 + ], + [ + 544.0, + 439.0 + ] + ], + "center_px": [ + 551.5, + 444.75 + ], + "area_px": 57.5 + }, + { + "image_points_px": [ + [ + 753.0, + 103.0 + ], + [ + 771.0, + 118.0 + ], + [ + 768.0, + 124.0 + ], + [ + 749.0, + 107.0 + ] + ], + "center_px": [ + 760.25, + 113.0 + ], + "area_px": 148.5 + }, + { + "image_points_px": [ + [ + 1009.0, + 294.0 + ], + [ + 1014.0, + 292.0 + ], + [ + 1031.0, + 303.0 + ], + [ + 1024.0, + 305.0 + ] + ], + "center_px": [ + 1019.5, + 298.5 + ], + "area_px": 98.0 + }, + { + "image_points_px": [ + [ + 744.0, + 317.0 + ], + [ + 743.0, + 325.0 + ], + [ + 727.0, + 326.0 + ], + [ + 728.0, + 318.0 + ] + ], + "center_px": [ + 735.5, + 321.5 + ], + "area_px": 127.0 + }, + { + "image_points_px": [ + [ + 770.0, + 498.0 + ], + [ + 769.0, + 515.0 + ], + [ + 765.0, + 519.0 + ], + [ + 766.0, + 502.0 + ] + ], + "center_px": [ + 767.5, + 508.5 + ], + "area_px": 64.0 + }, + { + "image_points_px": [ + [ + 789.0, + 524.0 + ], + [ + 789.0, + 537.0 + ], + [ + 787.0, + 543.0 + ], + [ + 787.0, + 527.0 + ] + ], + "center_px": [ + 788.0, + 532.75 + ], + "area_px": 29.0 + } + ] +} \ No newline at end of file diff --git a/data/evaluations/Scene8/render_a_camera_pose.json b/data/evaluations/Scene8/render_a_camera_pose.json new file mode 100644 index 0000000..005447f --- /dev/null +++ b/data/evaluations/Scene8/render_a_camera_pose.json @@ -0,0 +1,453 @@ +{ + "schema_version": "1.0", + "created_utc": "2026-06-01T18:36:46Z", + "source": { + "detection_json": "C:\\Users\\kech\\SynologyDrive\\2026-AppServer-AppRobot\\appRobotRendering\\data\\evaluations\\Scene8\\render_a_aruco_detection.json", + "robot_json": "C:\\Users\\kech\\SynologyDrive\\2026-AppServer-AppRobot\\appRobotRendering\\data\\robot\\robot.json" + }, + "camera": { + "camera_id": "a", + "camera_matrix": [ + [ + 1777.77783203125, + 0.0, + 640.0 + ], + [ + 0.0, + 1777.77783203125, + 360.0 + ], + [ + 0.0, + 0.0, + 1.0 + ] + ], + "distortion_coefficients": [ + 0.0, + 0.0, + 0.0, + 0.0, + 0.0 + ] + }, + "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": 18, + "used_marker_ids": [ + 47, + 210, + 85, + 79, + 96, + 62, + 105, + 75, + 102, + 92, + 217, + 61, + 83, + 206, + 207, + 84, + 86, + 93 + ], + "history": { + "iters": [ + 0, + 1, + 2, + 3 + ], + "rms": [ + 0.013441296790671579, + 0.0009558010419370985, + 8.508680576429123e-05, + 8.500249149030952e-05 + ], + "lambda": [ + 0.001, + 0.0005, + 0.00025, + 0.000125 + ] + }, + "residual_rms_px": 0.2137082535265442, + "residual_median_px": 0.17923585982646273, + "residual_max_px": 0.3627677590402337, + "sigma2_normalized": 8.67050826886587e-09 + }, + "camera_pose": { + "world_to_camera": { + "rotation_matrix": [ + [ + 0.808061420917511, + -0.5890982151031494, + 0.00016743359446991235 + ], + [ + -0.3431582450866699, + -0.47093844413757324, + -0.812686562538147 + ], + [ + 0.47883105278015137, + 0.6566431522369385, + -0.5827010869979858 + ] + ], + "translation_m": [ + -0.2288912832736969, + 0.17077402770519257, + 1.1346460580825806 + ], + "rvec_rad": [ + 2.1062721704584626, + -0.6861604143367729, + 0.3525529851457585 + ] + }, + "camera_in_world": { + "position_m": [ + -0.29974305629730225, + -0.799472987651825, + 0.7999836206436157 + ], + "position_mm": [ + -299.7430419921875, + -799.4729614257812, + 799.983642578125 + ], + "orientation_deg": { + "roll": 131.5856475830078, + "pitch": -28.60908317565918, + "yaw": -23.009401321411133 + } + }, + "uncertainty": { + "pose_covariance_6x6": [ + [ + 4.619516113690007e-08, + -1.397013616170484e-08, + 6.77165387146007e-10, + 2.6255328604640674e-09, + 6.9221642875853046e-09, + 1.1551146891620539e-08 + ], + [ + -1.397013616170492e-08, + 2.1346982374784157e-08, + -1.0945260787939212e-08, + -5.056690816415971e-09, + -5.392222017373122e-09, + -1.0216059919932632e-09 + ], + [ + 6.771653871460158e-10, + -1.0945260787939108e-08, + 5.758944809931949e-08, + 9.452206570751754e-09, + -5.2965880605660184e-09, + -1.2892253725614578e-08 + ], + [ + 2.625532860464083e-09, + -5.056690816415959e-09, + 9.452206570751771e-09, + 3.05558688629712e-09, + 3.175839917780105e-10, + -1.0899016346683564e-10 + ], + [ + 6.922164287585328e-09, + -5.392222017373144e-09, + -5.296588060565982e-09, + 3.175839917780176e-10, + 3.66582146497886e-09, + 3.97012482221086e-09 + ], + [ + 1.1551146891620583e-08, + -1.0216059919933101e-09, + -1.2892253725614462e-08, + -1.089901634668158e-10, + 3.970124822210858e-09, + 2.1045876808511416e-08 + ] + ], + "parameter_std": { + "rvec_std_deg": [ + 0.012314616044360916, + 0.008371260914195077, + 0.013749727485085577 + ], + "tvec_std_m": [ + 5.5277363235750675e-05, + 6.054602765647685e-05, + 0.0001450719711333358 + ] + }, + "camera_center_std_m": [ + 0.00023994135596817505, + 0.00024214683459045368, + 0.0002648537946420537 + ], + "camera_center_std_mm": [ + 0.23994135596817504, + 0.2421468345904537, + 0.2648537946420537 + ], + "orientation_std_deg": { + "roll": 0.01717226512443145, + "pitch": 0.011125285518906196, + "yaw": 0.008426889172714924 + } + } + }, + "observations": { + "markers": [ + { + "marker_id": 47, + "observed_center_px": [ + 984.25, + 690.75 + ], + "projected_center_px": [ + 983.9130859375, + 690.8455810546875 + ], + "reprojection_error_px": 0.3502096850822786, + "confidence": 0.12146268776527554 + }, + { + "marker_id": 210, + "observed_center_px": [ + 324.0, + 632.0 + ], + "projected_center_px": [ + 324.11334228515625, + 632.0877685546875 + ], + "reprojection_error_px": 0.14335198916085318, + "confidence": 0.46829700346999537 + }, + { + "marker_id": 85, + "observed_center_px": [ + 1183.75, + 610.25 + ], + "projected_center_px": [ + 1183.8746337890625, + 610.302978515625 + ], + "reprojection_error_px": 0.13542638034705098, + "confidence": 0.4560525484643318 + }, + { + "marker_id": 79, + "observed_center_px": [ + 814.0, + 599.0 + ], + "projected_center_px": [ + 814.25634765625, + 598.981689453125 + ], + "reprojection_error_px": 0.25700077235629026, + "confidence": 0.5734281513866332 + }, + { + "marker_id": 96, + "observed_center_px": [ + 905.25, + 587.25 + ], + "projected_center_px": [ + 905.1751708984375, + 587.0191650390625 + ], + "reprojection_error_px": 0.24266061409233286, + "confidence": 0.525542829627259 + }, + { + "marker_id": 62, + "observed_center_px": [ + 931.0, + 557.5 + ], + "projected_center_px": [ + 931.0681762695312, + 557.4588012695312 + ], + "reprojection_error_px": 0.07965763691846725, + "confidence": 0.5038606541951498 + }, + { + "marker_id": 105, + "observed_center_px": [ + 1150.25, + 560.25 + ], + "projected_center_px": [ + 1150.072021484375, + 560.2947387695312 + ], + "reprojection_error_px": 0.1835154203963489, + "confidence": 0.43622925667631085 + }, + { + "marker_id": 75, + "observed_center_px": [ + 128.5, + 514.75 + ], + "projected_center_px": [ + 128.4539031982422, + 514.6677856445312 + ], + "reprojection_error_px": 0.09425558539121726, + "confidence": 0.29844141482805986 + }, + { + "marker_id": 102, + "observed_center_px": [ + 1217.75, + 461.5 + ], + "projected_center_px": [ + 1217.802001953125, + 461.4224853515625 + ], + "reprojection_error_px": 0.0933419726125601, + "confidence": 0.2521714913889437 + }, + { + "marker_id": 92, + "observed_center_px": [ + 1173.25, + 437.75 + ], + "projected_center_px": [ + 1173.1270751953125, + 437.9108581542969 + ], + "reprojection_error_px": 0.20244963178839637, + "confidence": 0.31777455864589965 + }, + { + "marker_id": 217, + "observed_center_px": [ + 1087.75, + 347.0 + ], + "projected_center_px": [ + 1087.92431640625, + 347.0018310546875 + ], + "reprojection_error_px": 0.17432602286860002, + "confidence": 0.3029173397022545 + }, + { + "marker_id": 61, + "observed_center_px": [ + 58.5, + 415.5 + ], + "projected_center_px": [ + 58.642295837402344, + 415.5400390625 + ], + "reprojection_error_px": 0.1478216217875895, + "confidence": 0.1527342148240039 + }, + { + "marker_id": 83, + "observed_center_px": [ + 139.0, + 383.0 + ], + "projected_center_px": [ + 138.90614318847656, + 383.0179748535156 + ], + "reprojection_error_px": 0.095562526276016, + "confidence": 0.19743498130596515 + }, + { + "marker_id": 206, + "observed_center_px": [ + 1013.0, + 301.0 + ], + "projected_center_px": [ + 1013.3571166992188, + 300.93621826171875 + ], + "reprojection_error_px": 0.3627677590402337, + "confidence": 0.2849187633475991 + }, + { + "marker_id": 207, + "observed_center_px": [ + 1098.0, + 262.0 + ], + "projected_center_px": [ + 1097.9405517578125, + 261.8127136230469 + ], + "reprojection_error_px": 0.196494988463858, + "confidence": 0.24627951083020566 + }, + { + "marker_id": 84, + "observed_center_px": [ + 579.25, + 279.75 + ], + "projected_center_px": [ + 579.1668090820312, + 279.55206298828125 + ], + "reprojection_error_px": 0.21470861519890594, + "confidence": 0.1988568274481309 + }, + { + "marker_id": 86, + "observed_center_px": [ + 514.0, + 278.75 + ], + "projected_center_px": [ + 513.7302856445312, + 278.986572265625 + ], + "reprojection_error_px": 0.358764923604397, + "confidence": 0.17646704338372862 + }, + { + "marker_id": 93, + "observed_center_px": [ + 1104.25, + 154.5 + ], + "projected_center_px": [ + 1104.2188720703125, + 154.6721649169922 + ], + "reprojection_error_px": 0.17495629925657652, + "confidence": 0.15396639291733288 + } + ] + }, + "qa": { + "sanity_notes": [] + } +} \ No newline at end of file diff --git a/data/evaluations/Scene8/render_a_camera_pose_v8.json b/data/evaluations/Scene8/render_a_camera_pose_v8.json new file mode 100644 index 0000000..a726cce --- /dev/null +++ b/data/evaluations/Scene8/render_a_camera_pose_v8.json @@ -0,0 +1,454 @@ +{ + "schema_version": "1.0", + "created_utc": "2026-06-01T18:37:02Z", + "source": { + "detection_json": "C:\\Users\\kech\\SynologyDrive\\2026-AppServer-AppRobot\\appRobotRendering\\data\\evaluations\\Scene8\\render_a_aruco_detection.json", + "robot_json": "C:\\Users\\kech\\SynologyDrive\\2026-AppServer-AppRobot\\appRobotRendering\\data\\robot\\robot.json" + }, + "camera": { + "camera_id": "a", + "camera_matrix": [ + [ + 1777.77783203125, + 0.0, + 640.0 + ], + [ + 0.0, + 1777.77783203125, + 360.0 + ], + [ + 0.0, + 0.0, + 1.0 + ] + ], + "distortion_coefficients": [ + 0.0, + 0.0, + 0.0, + 0.0, + 0.0 + ] + }, + "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": 18, + "used_marker_ids": [ + 47, + 210, + 85, + 79, + 96, + 62, + 105, + 75, + 102, + 92, + 217, + 61, + 83, + 206, + 207, + 84, + 86, + 93 + ], + "history": { + "iters": [ + 0, + 1, + 2, + 3 + ], + "rms": [ + 0.013441296790671579, + 0.0009558010419370985, + 8.508680576429123e-05, + 8.500249149030952e-05 + ], + "lambda": [ + 0.001, + 0.0005, + 0.00025, + 0.000125 + ] + }, + "residual_rms_px": 0.2137082535265442, + "residual_median_px": 0.17923585982646273, + "residual_max_px": 0.3627677590402337, + "sigma2_normalized": 8.67050826886587e-09 + }, + "camera_pose": { + "world_to_camera": { + "rotation_matrix": [ + [ + 0.808061420917511, + -0.5890982151031494, + 0.00016743359446991235 + ], + [ + -0.3431582450866699, + -0.47093844413757324, + -0.812686562538147 + ], + [ + 0.47883105278015137, + 0.6566431522369385, + -0.5827010869979858 + ] + ], + "translation_m": [ + -0.2288931196113117, + 0.17983708427797915, + 1.141144257462032 + ], + "rvec_rad": [ + 2.1062721704584626, + -0.6861604143367729, + 0.3525529851457585 + ] + }, + "camera_in_world": { + "position_m": [ + -0.29974303527305857, + -0.7994729557751761, + 0.8111355085080784 + ], + "position_mm": [ + -299.7430352730586, + -799.472955775176, + 811.1355085080784 + ], + "orientation_deg": { + "roll": 131.5856475830078, + "pitch": -28.60908317565918, + "yaw": -23.009401321411133 + } + }, + "uncertainty": { + "pose_covariance_6x6": [ + [ + 4.619516113690007e-08, + -1.397013616170484e-08, + 6.77165387146007e-10, + 2.6255328604640674e-09, + 6.9221642875853046e-09, + 1.1551146891620539e-08 + ], + [ + -1.397013616170492e-08, + 2.1346982374784157e-08, + -1.0945260787939212e-08, + -5.056690816415971e-09, + -5.392222017373122e-09, + -1.0216059919932632e-09 + ], + [ + 6.771653871460158e-10, + -1.0945260787939108e-08, + 5.758944809931949e-08, + 9.452206570751754e-09, + -5.2965880605660184e-09, + -1.2892253725614578e-08 + ], + [ + 2.625532860464083e-09, + -5.056690816415959e-09, + 9.452206570751771e-09, + 3.05558688629712e-09, + 3.175839917780105e-10, + -1.0899016346683564e-10 + ], + [ + 6.922164287585328e-09, + -5.392222017373144e-09, + -5.296588060565982e-09, + 3.175839917780176e-10, + 3.66582146497886e-09, + 3.97012482221086e-09 + ], + [ + 1.1551146891620583e-08, + -1.0216059919933101e-09, + -1.2892253725614462e-08, + -1.089901634668158e-10, + 3.970124822210858e-09, + 2.1045876808511416e-08 + ] + ], + "parameter_std": { + "rvec_std_deg": [ + 0.012314616044360916, + 0.008371260914195077, + 0.013749727485085577 + ], + "tvec_std_m": [ + 5.5277363235750675e-05, + 6.054602765647685e-05, + 0.0001450719711333358 + ] + }, + "camera_center_std_m": [ + 0.00023994135596817505, + 0.00024214683459045368, + 0.0002648537946420537 + ], + "camera_center_std_mm": [ + 0.23994135596817504, + 0.2421468345904537, + 0.2648537946420537 + ], + "orientation_std_deg": { + "roll": 0.01717226512443145, + "pitch": 0.011125285518906196, + "yaw": 0.008426889172714924 + } + } + }, + "observations": { + "markers": [ + { + "marker_id": 47, + "observed_center_px": [ + 984.25, + 690.75 + ], + "projected_center_px": [ + 983.9130859375, + 690.8455810546875 + ], + "reprojection_error_px": 0.3502096850822786, + "confidence": 0.12146268776527554 + }, + { + "marker_id": 210, + "observed_center_px": [ + 324.0, + 632.0 + ], + "projected_center_px": [ + 324.11334228515625, + 632.0877685546875 + ], + "reprojection_error_px": 0.14335198916085318, + "confidence": 0.46829700346999537 + }, + { + "marker_id": 85, + "observed_center_px": [ + 1183.75, + 610.25 + ], + "projected_center_px": [ + 1183.8746337890625, + 610.302978515625 + ], + "reprojection_error_px": 0.13542638034705098, + "confidence": 0.4560525484643318 + }, + { + "marker_id": 79, + "observed_center_px": [ + 814.0, + 599.0 + ], + "projected_center_px": [ + 814.25634765625, + 598.981689453125 + ], + "reprojection_error_px": 0.25700077235629026, + "confidence": 0.5734281513866332 + }, + { + "marker_id": 96, + "observed_center_px": [ + 905.25, + 587.25 + ], + "projected_center_px": [ + 905.1751708984375, + 587.0191650390625 + ], + "reprojection_error_px": 0.24266061409233286, + "confidence": 0.525542829627259 + }, + { + "marker_id": 62, + "observed_center_px": [ + 931.0, + 557.5 + ], + "projected_center_px": [ + 931.0681762695312, + 557.4588012695312 + ], + "reprojection_error_px": 0.07965763691846725, + "confidence": 0.5038606541951498 + }, + { + "marker_id": 105, + "observed_center_px": [ + 1150.25, + 560.25 + ], + "projected_center_px": [ + 1150.072021484375, + 560.2947387695312 + ], + "reprojection_error_px": 0.1835154203963489, + "confidence": 0.43622925667631085 + }, + { + "marker_id": 75, + "observed_center_px": [ + 128.5, + 514.75 + ], + "projected_center_px": [ + 128.4539031982422, + 514.6677856445312 + ], + "reprojection_error_px": 0.09425558539121726, + "confidence": 0.29844141482805986 + }, + { + "marker_id": 102, + "observed_center_px": [ + 1217.75, + 461.5 + ], + "projected_center_px": [ + 1217.802001953125, + 461.4224853515625 + ], + "reprojection_error_px": 0.0933419726125601, + "confidence": 0.2521714913889437 + }, + { + "marker_id": 92, + "observed_center_px": [ + 1173.25, + 437.75 + ], + "projected_center_px": [ + 1173.1270751953125, + 437.9108581542969 + ], + "reprojection_error_px": 0.20244963178839637, + "confidence": 0.31777455864589965 + }, + { + "marker_id": 217, + "observed_center_px": [ + 1087.75, + 347.0 + ], + "projected_center_px": [ + 1087.92431640625, + 347.0018310546875 + ], + "reprojection_error_px": 0.17432602286860002, + "confidence": 0.3029173397022545 + }, + { + "marker_id": 61, + "observed_center_px": [ + 58.5, + 415.5 + ], + "projected_center_px": [ + 58.642295837402344, + 415.5400390625 + ], + "reprojection_error_px": 0.1478216217875895, + "confidence": 0.1527342148240039 + }, + { + "marker_id": 83, + "observed_center_px": [ + 139.0, + 383.0 + ], + "projected_center_px": [ + 138.90614318847656, + 383.0179748535156 + ], + "reprojection_error_px": 0.095562526276016, + "confidence": 0.19743498130596515 + }, + { + "marker_id": 206, + "observed_center_px": [ + 1013.0, + 301.0 + ], + "projected_center_px": [ + 1013.3571166992188, + 300.93621826171875 + ], + "reprojection_error_px": 0.3627677590402337, + "confidence": 0.2849187633475991 + }, + { + "marker_id": 207, + "observed_center_px": [ + 1098.0, + 262.0 + ], + "projected_center_px": [ + 1097.9405517578125, + 261.8127136230469 + ], + "reprojection_error_px": 0.196494988463858, + "confidence": 0.24627951083020566 + }, + { + "marker_id": 84, + "observed_center_px": [ + 579.25, + 279.75 + ], + "projected_center_px": [ + 579.1668090820312, + 279.55206298828125 + ], + "reprojection_error_px": 0.21470861519890594, + "confidence": 0.1988568274481309 + }, + { + "marker_id": 86, + "observed_center_px": [ + 514.0, + 278.75 + ], + "projected_center_px": [ + 513.7302856445312, + 278.986572265625 + ], + "reprojection_error_px": 0.358764923604397, + "confidence": 0.17646704338372862 + }, + { + "marker_id": 93, + "observed_center_px": [ + 1104.25, + 154.5 + ], + "projected_center_px": [ + 1104.2188720703125, + 154.6721649169922 + ], + "reprojection_error_px": 0.17495629925657652, + "confidence": 0.15396639291733288 + } + ] + }, + "qa": { + "sanity_notes": [] + }, + "v8_z_correction_mm": 11.151935468550299 +} \ No newline at end of file diff --git a/data/evaluations/Scene8/render_b_aruco_detection.json b/data/evaluations/Scene8/render_b_aruco_detection.json new file mode 100644 index 0000000..f12fa4e --- /dev/null +++ b/data/evaluations/Scene8/render_b_aruco_detection.json @@ -0,0 +1,3097 @@ +{ + "schema_version": "1.0", + "created_utc": "2026-06-01T18:36:42Z", + "vision_config": { + "MarkerType": "DICT_4X4_250", + "MarkerSize": 0.025 + }, + "camera": { + "camera_id": "b", + "intrinsics_file": "C:\\Users\\kech\\SynologyDrive\\2026-AppServer-AppRobot\\appRobotRendering\\data\\simulation\\Scene8\\render_a.npz", + "camera_matrix": [ + [ + 1777.77783203125, + 0.0, + 640.0 + ], + [ + 0.0, + 1777.77783203125, + 360.0 + ], + [ + 0.0, + 0.0, + 1.0 + ] + ], + "distortion_coefficients": [ + 0.0, + 0.0, + 0.0, + 0.0, + 0.0 + ] + }, + "image": { + "image_file": "C:\\Users\\kech\\SynologyDrive\\2026-AppServer-AppRobot\\appRobotRendering\\data\\simulation\\Scene8\\render_b.png", + "image_sha256": "8c7c0f308ddcde8845d9457724fc5a1eec76eed6cceac8c87a6cfb652a5c932b", + "width_px": 1280, + "height_px": 720 + }, + "aruco": { + "dictionary": "DICT_4X4_250", + "num_detected_markers": 49, + "num_rejected_candidates": 16 + }, + "detections": [ + { + "observation_id": "d2a7f4d9-e03d-4e24-926a-4f1404a6fc2a", + "type": "aruco", + "marker_id": 41, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 539.0, + 266.0 + ], + [ + 573.0, + 251.0 + ], + [ + 588.0, + 286.0 + ], + [ + 554.0, + 300.0 + ] + ], + "center_px": [ + 563.5, + 275.75 + ], + "quality": { + "area_px": 1390.5, + "perimeter_px": 149.17203521728516, + "sharpness": { + "laplacian_var": 2099.837569635909 + }, + "contrast": { + "p05": 29.0, + "p95": 186.0, + "dynamic_range": 157.0, + "mean_gray": 68.58680203045685, + "std_gray": 61.86201140647808 + }, + "geometry": { + "distance_to_center_norm": 0.1549762636423111, + "distance_to_border_px": 251.0 + }, + "edge_ratio": 1.0356085610438848, + "edge_lengths_px": [ + 37.161808013916016, + 38.07886505126953, + 36.769554138183594, + 37.161808013916016 + ] + }, + "confidence": 0.8951258563038449 + }, + { + "observation_id": "4c2f22de-8bad-4af3-a4aa-98766272fdb2", + "type": "aruco", + "marker_id": 114, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 607.0, + 387.0 + ], + [ + 593.0, + 411.0 + ], + [ + 593.0, + 386.0 + ], + [ + 607.0, + 361.0 + ] + ], + "center_px": [ + 600.0, + 386.25 + ], + "quality": { + "area_px": 357.0, + "perimeter_px": 107.43798446655273, + "sharpness": { + "laplacian_var": 2521.546996095799 + }, + "contrast": { + "p05": 27.0, + "p95": 97.0, + "dynamic_range": 70.0, + "mean_gray": 48.38549618320611, + "std_gray": 25.881561187197086 + }, + "geometry": { + "distance_to_center_norm": 0.06515592336654663, + "distance_to_border_px": 309.0 + }, + "edge_ratio": 1.1461238861083984, + "edge_lengths_px": [ + 27.784887313842773, + 25.0, + 28.65309715270996, + 26.0 + ] + }, + "confidence": 0.1816993804283249 + }, + { + "observation_id": "d2ded3a0-e67c-42ea-a95e-9c7e325bec15", + "type": "aruco", + "marker_id": 63, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 1234.0, + 693.0 + ], + [ + 1227.0, + 665.0 + ], + [ + 1258.0, + 665.0 + ], + [ + 1265.0, + 692.0 + ] + ], + "center_px": [ + 1246.0, + 678.75 + ], + "quality": { + "area_px": 856.0, + "perimeter_px": 118.77051544189453, + "sharpness": { + "laplacian_var": 2503.5188490063556 + }, + "contrast": { + "p05": 8.0, + "p95": 163.0, + "dynamic_range": 155.0, + "mean_gray": 46.501628664495115, + "std_gray": 60.621395401370805 + }, + "geometry": { + "distance_to_center_norm": 0.9324730634689331, + "distance_to_border_px": 15.0 + }, + "edge_ratio": 1.1119819756612892, + "edge_lengths_px": [ + 28.861740112304688, + 31.0, + 27.892650604248047, + 31.016124725341797 + ] + }, + "confidence": 0.1539593300495616 + }, + { + "observation_id": "17d545fa-5af1-4a3e-a985-caa04d302fc3", + "type": "aruco", + "marker_id": 229, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 427.0, + 490.0 + ], + [ + 458.0, + 490.0 + ], + [ + 457.0, + 516.0 + ], + [ + 425.0, + 517.0 + ] + ], + "center_px": [ + 441.75, + 503.25 + ], + "quality": { + "area_px": 834.0, + "perimeter_px": 116.10881805419922, + "sharpness": { + "laplacian_var": 2980.4215647600263 + }, + "contrast": { + "p05": 14.0, + "p95": 181.0, + "dynamic_range": 167.0, + "mean_gray": 65.93333333333334, + "std_gray": 70.56248246500354 + }, + "geometry": { + "distance_to_center_norm": 0.3330898880958557, + "distance_to_border_px": 203.0 + }, + "edge_ratio": 1.230460254309494, + "edge_lengths_px": [ + 31.0, + 26.019224166870117, + 32.015621185302734, + 27.073972702026367 + ] + }, + "confidence": 0.45186343732168294 + }, + { + "observation_id": "d303f365-f6f5-425d-b072-eda0d1538465", + "type": "aruco", + "marker_id": 102, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 1065.0, + 679.0 + ], + [ + 1061.0, + 652.0 + ], + [ + 1091.0, + 652.0 + ], + [ + 1096.0, + 679.0 + ] + ], + "center_px": [ + 1078.25, + 665.5 + ], + "quality": { + "area_px": 823.5, + "perimeter_px": 115.75374794006348, + "sharpness": { + "laplacian_var": 3067.383275918611 + }, + "contrast": { + "p05": 9.0, + "p95": 167.0, + "dynamic_range": 158.0, + "mean_gray": 93.25894378194208, + "std_gray": 69.61951400333008 + }, + "geometry": { + "distance_to_center_norm": 0.7275234460830688, + "distance_to_border_px": 41.0 + }, + "edge_ratio": 1.1357521590951734, + "edge_lengths_px": [ + 27.294687271118164, + 30.0, + 27.459060668945312, + 31.0 + ] + }, + "confidence": 0.39637168760361213 + }, + { + "observation_id": "1bc55b6e-38fd-4125-911c-b29659819621", + "type": "aruco", + "marker_id": 64, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 203.0, + 649.0 + ], + [ + 207.0, + 622.0 + ], + [ + 238.0, + 622.0 + ], + [ + 234.0, + 648.0 + ] + ], + "center_px": [ + 220.5, + 635.25 + ], + "quality": { + "area_px": 819.5, + "perimeter_px": 115.6167049407959, + "sharpness": { + "laplacian_var": 3119.738667550197 + }, + "contrast": { + "p05": 16.0, + "p95": 182.0, + "dynamic_range": 166.0, + "mean_gray": 73.89897260273973, + "std_gray": 71.40070026928626 + }, + "geometry": { + "distance_to_center_norm": 0.6832876801490784, + "distance_to_border_px": 71.0 + }, + "edge_ratio": 1.1790561449851884, + "edge_lengths_px": [ + 27.294687271118164, + 31.0, + 26.305892944335938, + 31.016124725341797 + ] + }, + "confidence": 0.4633649853376546 + }, + { + "observation_id": "2b1b5e4a-8a86-44d6-9545-d524e31b6133", + "type": "aruco", + "marker_id": 58, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 290.0, + 682.0 + ], + [ + 294.0, + 655.0 + ], + [ + 324.0, + 654.0 + ], + [ + 321.0, + 681.0 + ] + ], + "center_px": [ + 307.25, + 668.0 + ], + "quality": { + "area_px": 820.0, + "perimeter_px": 115.4936294555664, + "sharpness": { + "laplacian_var": 3374.3013669309444 + }, + "contrast": { + "p05": 17.0, + "p95": 182.0, + "dynamic_range": 165.0, + "mean_gray": 76.57876712328768, + "std_gray": 71.05417546164905 + }, + "geometry": { + "distance_to_center_norm": 0.6174793243408203, + "distance_to_border_px": 38.0 + }, + "edge_ratio": 1.1417193520219107, + "edge_lengths_px": [ + 27.294687271118164, + 30.01666259765625, + 27.166154861450195, + 31.016124725341797 + ] + }, + "confidence": 0.3638956157928849 + }, + { + "observation_id": "b601ec66-12e0-40a7-af65-da90bc43459c", + "type": "aruco", + "marker_id": 92, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 1052.0, + 636.0 + ], + [ + 1047.0, + 610.0 + ], + [ + 1077.0, + 609.0 + ], + [ + 1082.0, + 636.0 + ] + ], + "center_px": [ + 1064.5, + 622.75 + ], + "quality": { + "area_px": 797.5, + "perimeter_px": 113.95212745666504, + "sharpness": { + "laplacian_var": 2834.8901337960865 + }, + "contrast": { + "p05": 9.0, + "p95": 167.0, + "dynamic_range": 158.0, + "mean_gray": 56.6063829787234, + "std_gray": 64.94193556338288 + }, + "geometry": { + "distance_to_center_norm": 0.6798796653747559, + "distance_to_border_px": 84.0 + }, + "edge_ratio": 1.1337137166428901, + "edge_lengths_px": [ + 26.476404190063477, + 30.01666259765625, + 27.459060668945312, + 30.0 + ] + }, + "confidence": 0.46896024883690896 + }, + { + "observation_id": "9e9dba9a-5ed3-4191-b40a-37fb853c9d6b", + "type": "aruco", + "marker_id": 115, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 548.0, + 423.0 + ], + [ + 516.0, + 411.0 + ], + [ + 514.0, + 389.0 + ], + [ + 546.0, + 400.0 + ] + ], + "center_px": [ + 531.0, + 405.75 + ], + "quality": { + "area_px": 697.0, + "perimeter_px": 113.19137573242188, + "sharpness": { + "laplacian_var": 3244.2219145691315 + }, + "contrast": { + "p05": 31.0, + "p95": 188.0, + "dynamic_range": 157.0, + "mean_gray": 66.95178197064989, + "std_gray": 57.59873286126096 + }, + "geometry": { + "distance_to_center_norm": 0.16098536550998688, + "distance_to_border_px": 297.0 + }, + "edge_ratio": 1.5470755230143587, + "edge_lengths_px": [ + 34.1760139465332, + 22.090721130371094, + 33.83784866333008, + 23.0867919921875 + ] + }, + "confidence": 0.30035163749556265 + }, + { + "observation_id": "5b22561b-58eb-48e8-9b1c-cc2a26f3ce0a", + "type": "aruco", + "marker_id": 96, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 702.0, + 641.0 + ], + [ + 701.0, + 615.0 + ], + [ + 731.0, + 615.0 + ], + [ + 733.0, + 641.0 + ] + ], + "center_px": [ + 716.75, + 628.0 + ], + "quality": { + "area_px": 793.0, + "perimeter_px": 113.09603309631348, + "sharpness": { + "laplacian_var": 2708.827405861064 + }, + "contrast": { + "p05": 12.0, + "p95": 174.0, + "dynamic_range": 162.0, + "mean_gray": 82.44563279857398, + "std_gray": 73.19327808524073 + }, + "geometry": { + "distance_to_center_norm": 0.3796437680721283, + "distance_to_border_px": 79.0 + }, + "edge_ratio": 1.1914267620428063, + "edge_lengths_px": [ + 26.019224166870117, + 30.0, + 26.07680892944336, + 31.0 + ] + }, + "confidence": 0.44372569385651617 + }, + { + "observation_id": "6bee121a-af52-4b6e-a7f8-92297d6772c6", + "type": "aruco", + "marker_id": 103, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 366.0, + 646.0 + ], + [ + 368.0, + 620.0 + ], + [ + 398.0, + 620.0 + ], + [ + 396.0, + 646.0 + ] + ], + "center_px": [ + 382.0, + 633.0 + ], + "quality": { + "area_px": 780.0, + "perimeter_px": 112.15361785888672, + "sharpness": { + "laplacian_var": 3194.8306247933883 + }, + "contrast": { + "p05": 18.0, + "p95": 181.0, + "dynamic_range": 163.0, + "mean_gray": 114.26727272727273, + "std_gray": 72.23967319604287 + }, + "geometry": { + "distance_to_center_norm": 0.5115378499031067, + "distance_to_border_px": 74.0 + }, + "edge_ratio": 1.150447513772552, + "edge_lengths_px": [ + 26.07680892944336, + 30.0, + 26.07680892944336, + 30.0 + ] + }, + "confidence": 0.45199802144368495 + }, + { + "observation_id": "8a957c54-bd5f-4eb7-891e-a4a0ee47b895", + "type": "aruco", + "marker_id": 62, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 746.0, + 628.0 + ], + [ + 745.0, + 602.0 + ], + [ + 774.0, + 602.0 + ], + [ + 776.0, + 628.0 + ] + ], + "center_px": [ + 760.25, + 615.0 + ], + "quality": { + "area_px": 767.0, + "perimeter_px": 111.09603309631348, + "sharpness": { + "laplacian_var": 2073.6673975375274 + }, + "contrast": { + "p05": 11.0, + "p95": 172.0, + "dynamic_range": 161.0, + "mean_gray": 39.593692022263454, + "std_gray": 53.8193228770151 + }, + "geometry": { + "distance_to_center_norm": 0.38394394516944885, + "distance_to_border_px": 92.0 + }, + "edge_ratio": 1.1529936406865868, + "edge_lengths_px": [ + 26.019224166870117, + 29.0, + 26.07680892944336, + 30.0 + ] + }, + "confidence": 0.44348322079976393 + }, + { + "observation_id": "4a206a27-87ee-4f8a-8470-2071efcfe6f8", + "type": "aruco", + "marker_id": 51, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 446.0, + 628.0 + ], + [ + 448.0, + 602.0 + ], + [ + 477.0, + 602.0 + ], + [ + 476.0, + 628.0 + ] + ], + "center_px": [ + 461.75, + 615.0 + ], + "quality": { + "area_px": 767.0, + "perimeter_px": 111.09603309631348, + "sharpness": { + "laplacian_var": 3710.8536456917054 + }, + "contrast": { + "p05": 16.0, + "p95": 180.0, + "dynamic_range": 164.0, + "mean_gray": 76.65491651205937, + "std_gray": 69.9729316134013 + }, + "geometry": { + "distance_to_center_norm": 0.4236999452114105, + "distance_to_border_px": 92.0 + }, + "edge_ratio": 1.1529936406865868, + "edge_lengths_px": [ + 26.07680892944336, + 29.0, + 26.019224166870117, + 30.0 + ] + }, + "confidence": 0.44348322079976393 + }, + { + "observation_id": "aa6c037f-d9f2-4462-b602-ca63ea499252", + "type": "aruco", + "marker_id": 42, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 594.0, + 298.0 + ], + [ + 612.0, + 308.0 + ], + [ + 630.0, + 337.0 + ], + [ + 612.0, + 329.0 + ] + ], + "center_px": [ + 612.0, + 318.0 + ], + "quality": { + "area_px": 378.0, + "perimeter_px": 110.26796913146973, + "sharpness": { + "laplacian_var": 1297.9380881966806 + }, + "contrast": { + "p05": 19.0, + "p95": 80.0, + "dynamic_range": 61.0, + "mean_gray": 38.43494423791822, + "std_gray": 21.75053830245828 + }, + "geometry": { + "distance_to_center_norm": 0.06874241679906845, + "distance_to_border_px": 298.0 + }, + "edge_ratio": 1.8198504620192197, + "edge_lengths_px": [ + 20.59126091003418, + 34.13209533691406, + 19.697715759277344, + 35.84689712524414 + ] + }, + "confidence": 0.10558559838306686 + }, + { + "observation_id": "9a9f0b58-d93c-4886-ba65-0c2d451b8116", + "type": "aruco", + "marker_id": 198, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 433.0, + 394.0 + ], + [ + 464.0, + 394.0 + ], + [ + 463.0, + 418.0 + ], + [ + 432.0, + 418.0 + ] + ], + "center_px": [ + 448.0, + 406.0 + ], + "quality": { + "area_px": 744.0, + "perimeter_px": 110.0416488647461, + "sharpness": { + "laplacian_var": 3919.1268935024996 + }, + "contrast": { + "p05": 12.0, + "p95": 178.0, + "dynamic_range": 166.0, + "mean_gray": 84.7078431372549, + "std_gray": 71.61659174377822 + }, + "geometry": { + "distance_to_center_norm": 0.2688722610473633, + "distance_to_border_px": 302.0 + }, + "edge_ratio": 1.2905468789081638, + "edge_lengths_px": [ + 31.0, + 24.020824432373047, + 31.0, + 24.020824432373047 + ] + }, + "confidence": 0.38433319091796875 + }, + { + "observation_id": "f3cc69db-73fc-48f0-a70b-d54c21c1fcdf", + "type": "aruco", + "marker_id": 79, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 629.0, + 612.0 + ], + [ + 629.0, + 586.0 + ], + [ + 658.0, + 586.0 + ], + [ + 659.0, + 611.0 + ] + ], + "center_px": [ + 643.75, + 598.75 + ], + "quality": { + "area_px": 752.5, + "perimeter_px": 110.03665542602539, + "sharpness": { + "laplacian_var": 4340.318821602797 + }, + "contrast": { + "p05": 13.0, + "p95": 175.0, + "dynamic_range": 162.0, + "mean_gray": 93.7639405204461, + "std_gray": 70.52547089838423 + }, + "geometry": { + "distance_to_center_norm": 0.3251786530017853, + "distance_to_border_px": 108.0 + }, + "edge_ratio": 1.1997070823945877, + "edge_lengths_px": [ + 26.0, + 29.0, + 25.01999282836914, + 30.01666259765625 + ] + }, + "confidence": 0.41815762699787656 + }, + { + "observation_id": "7a0ec476-0df8-464f-a4bb-dcb274664d21", + "type": "aruco", + "marker_id": 205, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 1163.0, + 490.0 + ], + [ + 1193.0, + 490.0 + ], + [ + 1199.0, + 514.0 + ], + [ + 1169.0, + 514.0 + ] + ], + "center_px": [ + 1181.0, + 502.0 + ], + "quality": { + "area_px": 720.0, + "perimeter_px": 109.47726821899414, + "sharpness": { + "laplacian_var": 3340.3491000000004 + }, + "contrast": { + "p05": 8.0, + "p95": 163.0, + "dynamic_range": 155.0, + "mean_gray": 71.452, + "std_gray": 65.95710496982112 + }, + "geometry": { + "distance_to_center_norm": 0.7617100477218628, + "distance_to_border_px": 81.0 + }, + "edge_ratio": 1.2126781077409245, + "edge_lengths_px": [ + 30.0, + 24.73863410949707, + 30.0, + 24.73863410949707 + ] + }, + "confidence": 0.3958181457519531 + }, + { + "observation_id": "b1e00578-8ecf-4ea1-808c-2352339ea725", + "type": "aruco", + "marker_id": 217, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 1041.0, + 491.0 + ], + [ + 1070.0, + 491.0 + ], + [ + 1075.0, + 515.0 + ], + [ + 1046.0, + 516.0 + ] + ], + "center_px": [ + 1058.0, + 503.25 + ], + "quality": { + "area_px": 713.0, + "perimeter_px": 108.02763557434082, + "sharpness": { + "laplacian_var": 3209.7008801980032 + }, + "contrast": { + "p05": 8.0, + "p95": 165.0, + "dynamic_range": 157.0, + "mean_gray": 65.69838056680162, + "std_gray": 65.80464368857774 + }, + "geometry": { + "distance_to_center_norm": 0.6017478704452515, + "distance_to_border_px": 204.0 + }, + "edge_ratio": 1.1836378025559324, + "edge_lengths_px": [ + 29.0, + 24.515300750732422, + 29.017236709594727, + 25.495098114013672 + ] + }, + "confidence": 0.4015868133874269 + }, + { + "observation_id": "40e95219-7f39-4113-903f-16cab95f8da3", + "type": "aruco", + "marker_id": 208, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 674.0, + 495.0 + ], + [ + 703.0, + 495.0 + ], + [ + 704.0, + 519.0 + ], + [ + 674.0, + 519.0 + ] + ], + "center_px": [ + 688.75, + 507.0 + ], + "quality": { + "area_px": 708.0, + "perimeter_px": 107.02082443237305, + "sharpness": { + "laplacian_var": 2285.871584 + }, + "contrast": { + "p05": 7.0, + "p95": 151.0, + "dynamic_range": 144.0, + "mean_gray": 57.19, + "std_gray": 59.93114298926728 + }, + "geometry": { + "distance_to_center_norm": 0.21091137826442719, + "distance_to_border_px": 201.0 + }, + "edge_ratio": 1.25, + "edge_lengths_px": [ + 29.0, + 24.020824432373047, + 30.0, + 24.0 + ] + }, + "confidence": 0.3776 + }, + { + "observation_id": "a99ed65b-5b65-4e57-9464-47b93128f024", + "type": "aruco", + "marker_id": 210, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 278.0, + 431.0 + ], + [ + 307.0, + 430.0 + ], + [ + 304.0, + 453.0 + ], + [ + 275.0, + 453.0 + ] + ], + "center_px": [ + 291.0, + 441.75 + ], + "quality": { + "area_px": 651.0, + "perimeter_px": 103.4156665802002, + "sharpness": { + "laplacian_var": 3380.2084596609407 + }, + "contrast": { + "p05": 17.0, + "p95": 181.0, + "dynamic_range": 164.0, + "mean_gray": 80.77200902934537, + "std_gray": 69.4560609909542 + }, + "geometry": { + "distance_to_center_norm": 0.48814597725868225, + "distance_to_border_px": 267.0 + }, + "edge_ratio": 1.306870589274211, + "edge_lengths_px": [ + 29.017236709594727, + 23.194826126098633, + 29.0, + 22.203603744506836 + ] + }, + "confidence": 0.3320910299473707 + }, + { + "observation_id": "10d65a0c-0662-486a-a381-5b000d3a0b96", + "type": "aruco", + "marker_id": 206, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 1027.0, + 413.0 + ], + [ + 1055.0, + 413.0 + ], + [ + 1059.0, + 436.0 + ], + [ + 1031.0, + 436.0 + ] + ], + "center_px": [ + 1043.0, + 424.5 + ], + "quality": { + "area_px": 644.0, + "perimeter_px": 102.69047164916992, + "sharpness": { + "laplacian_var": 2988.130945247934 + }, + "contrast": { + "p05": 8.0, + "p95": 163.0, + "dynamic_range": 155.0, + "mean_gray": 66.72045454545454, + "std_gray": 63.960510116311944 + }, + "geometry": { + "distance_to_center_norm": 0.5558050274848938, + "distance_to_border_px": 221.0 + }, + "edge_ratio": 1.1993881839699854, + "edge_lengths_px": [ + 28.0, + 23.34523582458496, + 28.0, + 23.34523582458496 + ] + }, + "confidence": 0.3579602826436361 + }, + { + "observation_id": "78dd2dfd-89fe-4f18-84f3-7533096614a3", + "type": "aruco", + "marker_id": 207, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 1145.0, + 412.0 + ], + [ + 1173.0, + 412.0 + ], + [ + 1179.0, + 434.0 + ], + [ + 1151.0, + 435.0 + ] + ], + "center_px": [ + 1162.0, + 423.25 + ], + "quality": { + "area_px": 633.0, + "perimeter_px": 102.5910873413086, + "sharpness": { + "laplacian_var": 2912.7964964328603 + }, + "contrast": { + "p05": 8.0, + "p95": 162.0, + "dynamic_range": 154.0, + "mean_gray": 66.32167832167832, + "std_gray": 64.80909042240171 + }, + "geometry": { + "distance_to_center_norm": 0.7160782814025879, + "distance_to_border_px": 101.0 + }, + "edge_ratio": 1.2286640258971397, + "edge_lengths_px": [ + 28.0, + 22.803508758544922, + 28.017850875854492, + 23.76972770690918 + ] + }, + "confidence": 0.343462485354258 + }, + { + "observation_id": "1e1ae5da-c9bc-4f17-abc9-e5463f48d7d6", + "type": "aruco", + "marker_id": 214, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 672.0, + 417.0 + ], + [ + 700.0, + 416.0 + ], + [ + 701.0, + 439.0 + ], + [ + 672.0, + 439.0 + ] + ], + "center_px": [ + 686.25, + 427.75 + ], + "quality": { + "area_px": 641.5, + "perimeter_px": 102.03957939147949, + "sharpness": { + "laplacian_var": 2062.432285703196 + }, + "contrast": { + "p05": 6.0, + "p95": 144.0, + "dynamic_range": 138.0, + "mean_gray": 71.8237885462555, + "std_gray": 59.376865202953724 + }, + "geometry": { + "distance_to_center_norm": 0.11171316355466843, + "distance_to_border_px": 281.0 + }, + "edge_ratio": 1.3181818181818181, + "edge_lengths_px": [ + 28.017850875854492, + 23.021728515625, + 29.0, + 22.0 + ] + }, + "confidence": 0.3244367816091954 + }, + { + "observation_id": "1fccd10d-ecdb-4c3c-b2b7-beda99037ab2", + "type": "aruco", + "marker_id": 248, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 528.0, + 556.0 + ], + [ + 529.0, + 574.0 + ], + [ + 497.0, + 574.0 + ], + [ + 495.0, + 556.0 + ] + ], + "center_px": [ + 512.25, + 565.0 + ], + "quality": { + "area_px": 585.0, + "perimeter_px": 101.1385269165039, + "sharpness": { + "laplacian_var": 3988.932783018868 + }, + "contrast": { + "p05": 25.0, + "p95": 179.0, + "dynamic_range": 154.0, + "mean_gray": 92.51179245283019, + "std_gray": 67.1394272475327 + }, + "geometry": { + "distance_to_center_norm": 0.32894790172576904, + "distance_to_border_px": 146.0 + }, + "edge_ratio": 1.830510712529423, + "edge_lengths_px": [ + 18.027755737304688, + 32.0, + 18.11077117919922, + 33.0 + ] + }, + "confidence": 0.21305529507723722 + }, + { + "observation_id": "37eab4f4-b90b-48c7-a92c-0c8afd95f782", + "type": "aruco", + "marker_id": 120, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 609.0, + 449.0 + ], + [ + 595.0, + 473.0 + ], + [ + 595.0, + 450.0 + ], + [ + 609.0, + 427.0 + ] + ], + "center_px": [ + 602.0, + 449.75 + ], + "quality": { + "area_px": 315.0, + "perimeter_px": 99.7107105255127, + "sharpness": { + "laplacian_var": 3721.5158117614915 + }, + "contrast": { + "p05": 28.0, + "p95": 99.89999999999998, + "dynamic_range": 71.89999999999998, + "mean_gray": 48.28099173553719, + "std_gray": 24.182236202981546 + }, + "geometry": { + "distance_to_center_norm": 0.13272888958454132, + "distance_to_border_px": 247.0 + }, + "edge_ratio": 1.2629494233564897, + "edge_lengths_px": [ + 27.784887313842773, + 23.0, + 26.925823211669922, + 22.0 + ] + }, + "confidence": 0.14944185135965293 + }, + { + "observation_id": "c70094d9-3ab2-4887-917c-d88c776308a4", + "type": "aruco", + "marker_id": 245, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 577.0, + 555.0 + ], + [ + 578.0, + 573.0 + ], + [ + 547.0, + 574.0 + ], + [ + 545.0, + 556.0 + ] + ], + "center_px": [ + 561.75, + 564.5 + ], + "quality": { + "area_px": 568.5, + "perimeter_px": 99.17027282714844, + "sharpness": { + "laplacian_var": 3128.3572393883455 + }, + "contrast": { + "p05": 24.0, + "p95": 178.0, + "dynamic_range": 154.0, + "mean_gray": 84.8273381294964, + "std_gray": 66.98150301860561 + }, + "geometry": { + "distance_to_center_norm": 0.298187255859375, + "distance_to_border_px": 146.0 + }, + "edge_ratio": 1.7759071984236547, + "edge_lengths_px": [ + 18.027755737304688, + 31.016124725341797, + 18.11077117919922, + 32.015621185302734 + ] + }, + "confidence": 0.21341205235071464 + }, + { + "observation_id": "f96f0265-f69c-4ee7-a267-b4431498d249", + "type": "aruco", + "marker_id": 243, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 426.0, + 560.0 + ], + [ + 458.0, + 560.0 + ], + [ + 460.0, + 576.0 + ], + [ + 429.0, + 576.0 + ] + ], + "center_px": [ + 443.25, + 568.0 + ], + "quality": { + "area_px": 504.0, + "perimeter_px": 95.40333557128906, + "sharpness": { + "laplacian_var": 2622.1327366119103 + }, + "contrast": { + "p05": 28.0, + "p95": 177.0, + "dynamic_range": 149.0, + "mean_gray": 78.06738544474393, + "std_gray": 62.62495466722876 + }, + "geometry": { + "distance_to_center_norm": 0.3899102509021759, + "distance_to_border_px": 144.0 + }, + "edge_ratio": 1.9845557488919303, + "edge_lengths_px": [ + 32.0, + 16.124515533447266, + 31.0, + 16.278820037841797 + ] + }, + "confidence": 0.1693074131011963 + }, + { + "observation_id": "cb326e84-2a79-4107-b094-4a0ec8c434b6", + "type": "aruco", + "marker_id": 94, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 1242.0, + 289.0 + ], + [ + 1236.0, + 270.0 + ], + [ + 1262.0, + 270.0 + ], + [ + 1268.0, + 289.0 + ] + ], + "center_px": [ + 1252.0, + 279.5 + ], + "quality": { + "area_px": 494.0, + "perimeter_px": 91.84971618652344, + "sharpness": { + "laplacian_var": 2255.793293655482 + }, + "contrast": { + "p05": 7.0, + "p95": 152.0, + "dynamic_range": 145.0, + "mean_gray": 58.92391304347826, + "std_gray": 58.07645517382802 + }, + "geometry": { + "distance_to_center_norm": 0.8406231999397278, + "distance_to_border_px": 12.0 + }, + "edge_ratio": 1.3049026436375375, + "edge_lengths_px": [ + 19.92485809326172, + 26.0, + 19.92485809326172, + 26.0 + ] + }, + "confidence": 0.06057156860351561 + }, + { + "observation_id": "94cd5b9d-a993-466b-85f3-22225783768b", + "type": "aruco", + "marker_id": 76, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 1035.0, + 297.0 + ], + [ + 1031.0, + 278.0 + ], + [ + 1057.0, + 278.0 + ], + [ + 1061.0, + 297.0 + ] + ], + "center_px": [ + 1046.0, + 287.5 + ], + "quality": { + "area_px": 494.0, + "perimeter_px": 90.83297729492188, + "sharpness": { + "laplacian_var": 2577.678136814745 + }, + "contrast": { + "p05": 7.0, + "p95": 155.0, + "dynamic_range": 148.0, + "mean_gray": 74.08152173913044, + "std_gray": 61.026534551975345 + }, + "geometry": { + "distance_to_center_norm": 0.5616520643234253, + "distance_to_border_px": 219.0 + }, + "edge_ratio": 1.339068071064434, + "edge_lengths_px": [ + 19.416488647460938, + 26.0, + 19.416488647460938, + 26.0 + ] + }, + "confidence": 0.2459421895345052 + }, + { + "observation_id": "850f87df-3b32-42a3-a664-0800dfb12b84", + "type": "aruco", + "marker_id": 100, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 1163.0, + 291.0 + ], + [ + 1158.0, + 272.0 + ], + [ + 1183.0, + 272.0 + ], + [ + 1189.0, + 291.0 + ] + ], + "center_px": [ + 1173.25, + 281.5 + ], + "quality": { + "area_px": 484.5, + "perimeter_px": 90.57174110412598, + "sharpness": { + "laplacian_var": 2290.676253251587 + }, + "contrast": { + "p05": 7.0, + "p95": 154.0, + "dynamic_range": 147.0, + "mean_gray": 80.01939058171745, + "std_gray": 61.630587080560396 + }, + "geometry": { + "distance_to_center_norm": 0.7340260744094849, + "distance_to_border_px": 91.0 + }, + "edge_ratio": 1.3233651356107032, + "edge_lengths_px": [ + 19.646883010864258, + 25.0, + 19.92485809326172, + 26.0 + ] + }, + "confidence": 0.24407473894265982 + }, + { + "observation_id": "b3a07b34-9d03-4bbe-ad52-fde26a69568d", + "type": "aruco", + "marker_id": 75, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 257.0, + 281.0 + ], + [ + 261.0, + 262.0 + ], + [ + 286.0, + 262.0 + ], + [ + 283.0, + 281.0 + ] + ], + "center_px": [ + 271.75, + 271.5 + ], + "quality": { + "area_px": 484.5, + "perimeter_px": 89.6518726348877, + "sharpness": { + "laplacian_var": 3839.9311200378065 + }, + "contrast": { + "p05": 10.0, + "p95": 173.0, + "dynamic_range": 163.0, + "mean_gray": 100.90760869565217, + "std_gray": 65.85022652513884 + }, + "geometry": { + "distance_to_center_norm": 0.5157754421234131, + "distance_to_border_px": 257.0 + }, + "edge_ratio": 1.3516756419832816, + "edge_lengths_px": [ + 19.416488647460938, + 25.0, + 19.235383987426758, + 26.0 + ] + }, + "confidence": 0.23896265492072474 + }, + { + "observation_id": "d3df025c-0b1b-4ade-b007-0ec4835f9644", + "type": "aruco", + "marker_id": 68, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 913.0, + 295.0 + ], + [ + 910.0, + 275.0 + ], + [ + 935.0, + 276.0 + ], + [ + 938.0, + 295.0 + ] + ], + "center_px": [ + 924.0, + 285.25 + ], + "quality": { + "area_px": 486.0, + "perimeter_px": 89.4791259765625, + "sharpness": { + "laplacian_var": 2700.93802471833 + }, + "contrast": { + "p05": 7.0, + "p95": 153.14999999999998, + "dynamic_range": 146.14999999999998, + "mean_gray": 62.114525139664806, + "std_gray": 58.75225668955441 + }, + "geometry": { + "distance_to_center_norm": 0.3999340832233429, + "distance_to_border_px": 275.0 + }, + "edge_ratio": 1.300727494950114, + "edge_lengths_px": [ + 20.2237491607666, + 25.01999282836914, + 19.235383987426758, + 25.0 + ] + }, + "confidence": 0.24909137483284013 + }, + { + "observation_id": "7207d2d9-0e29-4d49-920d-16c59fb63959", + "type": "aruco", + "marker_id": 46, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 870.0, + 283.0 + ], + [ + 868.0, + 264.0 + ], + [ + 893.0, + 264.0 + ], + [ + 896.0, + 283.0 + ] + ], + "center_px": [ + 881.75, + 273.5 + ], + "quality": { + "area_px": 484.5, + "perimeter_px": 89.34035682678223, + "sharpness": { + "laplacian_var": 2313.818381605031 + }, + "contrast": { + "p05": 7.0, + "p95": 155.0, + "dynamic_range": 148.0, + "mean_gray": 79.32697547683924, + "std_gray": 61.43326196445541 + }, + "geometry": { + "distance_to_center_norm": 0.34966418147087097, + "distance_to_border_px": 264.0 + }, + "edge_ratio": 1.360902222610914, + "edge_lengths_px": [ + 19.10497283935547, + 25.0, + 19.235383987426758, + 26.0 + ] + }, + "confidence": 0.23734254719660833 + }, + { + "observation_id": "ead51915-770b-4bc8-b5f4-dbdc2a53a8c9", + "type": "aruco", + "marker_id": 50, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 908.0, + 261.0 + ], + [ + 905.0, + 242.0 + ], + [ + 930.0, + 242.0 + ], + [ + 933.0, + 261.0 + ] + ], + "center_px": [ + 919.0, + 251.5 + ], + "quality": { + "area_px": 475.0, + "perimeter_px": 88.47076797485352, + "sharpness": { + "laplacian_var": 2635.6283823850695 + }, + "contrast": { + "p05": 7.0, + "p95": 156.0, + "dynamic_range": 149.0, + "mean_gray": 54.52513966480447, + "std_gray": 56.52604268897183 + }, + "geometry": { + "distance_to_center_norm": 0.40767231583595276, + "distance_to_border_px": 242.0 + }, + "edge_ratio": 1.299688117291617, + "edge_lengths_px": [ + 19.235383987426758, + 25.0, + 19.235383987426758, + 25.0 + ] + }, + "confidence": 0.24364819717407224 + }, + { + "observation_id": "27d79769-2399-43b4-b719-87f7cea0c419", + "type": "aruco", + "marker_id": 72, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 766.0, + 277.0 + ], + [ + 764.0, + 258.0 + ], + [ + 790.0, + 258.0 + ], + [ + 791.0, + 276.0 + ] + ], + "center_px": [ + 777.75, + 267.25 + ], + "quality": { + "area_px": 472.5, + "perimeter_px": 88.1527214050293, + "sharpness": { + "laplacian_var": 2275.5658184842564 + }, + "contrast": { + "p05": 7.0, + "p95": 158.0, + "dynamic_range": 151.0, + "mean_gray": 55.787114845938376, + "std_gray": 59.85027585773783 + }, + "geometry": { + "distance_to_center_norm": 0.22615359723567963, + "distance_to_border_px": 258.0 + }, + "edge_ratio": 1.4422205613868182, + "edge_lengths_px": [ + 19.10497283935547, + 26.0, + 18.027755737304688, + 25.01999282836914 + ] + }, + "confidence": 0.21841319450965294 + }, + { + "observation_id": "df5381cf-4f16-408b-a276-0b85ce93c298", + "type": "aruco", + "marker_id": 104, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 1174.0, + 237.0 + ], + [ + 1169.0, + 219.0 + ], + [ + 1194.0, + 219.0 + ], + [ + 1199.0, + 237.0 + ] + ], + "center_px": [ + 1184.0, + 228.0 + ], + "quality": { + "area_px": 450.0, + "perimeter_px": 87.36308288574219, + "sharpness": { + "laplacian_var": 1959.752232142857 + }, + "contrast": { + "p05": 7.0, + "p95": 153.0, + "dynamic_range": 146.0, + "mean_gray": 85.58630952380952, + "std_gray": 61.229308872073794 + }, + "geometry": { + "distance_to_center_norm": 0.7623366713523865, + "distance_to_border_px": 81.0 + }, + "edge_ratio": 1.3382193367956818, + "edge_lengths_px": [ + 18.681541442871094, + 25.0, + 18.681541442871094, + 25.0 + ] + }, + "confidence": 0.22417849731445313 + }, + { + "observation_id": "9937d88e-3c39-4baf-a10c-6ebb6050b70d", + "type": "aruco", + "marker_id": 53, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 814.0, + 262.0 + ], + [ + 812.0, + 243.0 + ], + [ + 837.0, + 243.0 + ], + [ + 839.0, + 261.0 + ] + ], + "center_px": [ + 825.5, + 252.25 + ], + "quality": { + "area_px": 463.5, + "perimeter_px": 87.23573684692383, + "sharpness": { + "laplacian_var": 2530.198110031937 + }, + "contrast": { + "p05": 7.0, + "p95": 159.0, + "dynamic_range": 152.0, + "mean_gray": 89.96561604584527, + "std_gray": 61.7530340401115 + }, + "geometry": { + "distance_to_center_norm": 0.2921459376811981, + "distance_to_border_px": 243.0 + }, + "edge_ratio": 1.3814979263337708, + "edge_lengths_px": [ + 19.10497283935547, + 25.0, + 18.11077117919922, + 25.01999282836914 + ] + }, + "confidence": 0.22367025973033955 + }, + { + "observation_id": "f595bfc7-8361-499f-85b1-0d694ef52fcb", + "type": "aruco", + "marker_id": 60, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 754.0, + 206.0 + ], + [ + 752.0, + 189.0 + ], + [ + 776.0, + 188.0 + ], + [ + 778.0, + 206.0 + ] + ], + "center_px": [ + 765.0, + 197.25 + ], + "quality": { + "area_px": 421.0, + "perimeter_px": 83.24883842468262, + "sharpness": { + "laplacian_var": 2066.712440938369 + }, + "contrast": { + "p05": 8.0, + "p95": 159.0, + "dynamic_range": 151.0, + "mean_gray": 98.51446945337621, + "std_gray": 61.45768640526303 + }, + "geometry": { + "distance_to_center_norm": 0.27946722507476807, + "distance_to_border_px": 188.0 + }, + "edge_ratio": 1.4033115434908208, + "edge_lengths_px": [ + 17.11724281311035, + 24.020824432373047, + 18.11077117919922, + 24.0 + ] + }, + "confidence": 0.2000031054889577 + }, + { + "observation_id": "827004bb-c1d0-4acb-93ec-ee896e4fb938", + "type": "aruco", + "marker_id": 67, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 848.0, + 218.0 + ], + [ + 846.0, + 201.0 + ], + [ + 870.0, + 200.0 + ], + [ + 873.0, + 218.0 + ] + ], + "center_px": [ + 859.25, + 209.25 + ], + "quality": { + "area_px": 430.0, + "perimeter_px": 84.38635444641113, + "sharpness": { + "laplacian_var": 2637.279213058048 + }, + "contrast": { + "p05": 8.0, + "p95": 157.0, + "dynamic_range": 149.0, + "mean_gray": 58.41692789968652, + "std_gray": 56.18971303875155 + }, + "geometry": { + "distance_to_center_norm": 0.36235129833221436, + "distance_to_border_px": 200.0 + }, + "edge_ratio": 1.4605155907966747, + "edge_lengths_px": [ + 17.11724281311035, + 24.020824432373047, + 18.248287200927734, + 25.0 + ] + }, + "confidence": 0.19627771759033205 + }, + { + "observation_id": "c9d66342-7361-4b16-a6c4-379ce3bf3c94", + "type": "aruco", + "marker_id": 86, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 679.0, + 201.0 + ], + [ + 677.0, + 184.0 + ], + [ + 702.0, + 183.0 + ], + [ + 703.0, + 200.0 + ] + ], + "center_px": [ + 690.25, + 192.0 + ], + "quality": { + "area_px": 418.0, + "perimeter_px": 83.18744659423828, + "sharpness": { + "laplacian_var": 2080.2582222971832 + }, + "contrast": { + "p05": 7.0, + "p95": 156.0, + "dynamic_range": 149.0, + "mean_gray": 78.06818181818181, + "std_gray": 62.388955071198566 + }, + "geometry": { + "distance_to_center_norm": 0.2388036847114563, + "distance_to_border_px": 183.0 + }, + "edge_ratio": 1.4692245547670144, + "edge_lengths_px": [ + 17.11724281311035, + 25.01999282836914, + 17.029386520385742, + 24.020824432373047 + ] + }, + "confidence": 0.18966921411877496 + }, + { + "observation_id": "3f70dec4-f1b6-4d49-b74f-931b1bd56c7a", + "type": "aruco", + "marker_id": 88, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 1096.0, + 179.0 + ], + [ + 1091.0, + 161.0 + ], + [ + 1114.0, + 161.0 + ], + [ + 1119.0, + 178.0 + ] + ], + "center_px": [ + 1105.0, + 169.75 + ], + "quality": { + "area_px": 405.0, + "perimeter_px": 82.42331504821777, + "sharpness": { + "laplacian_var": 2396.499506903353 + }, + "contrast": { + "p05": 7.0, + "p95": 153.0, + "dynamic_range": 146.0, + "mean_gray": 73.15384615384616, + "std_gray": 59.86872967500988 + }, + "geometry": { + "distance_to_center_norm": 0.6842061877250671, + "distance_to_border_px": 161.0 + }, + "edge_ratio": 1.2991913056123376, + "edge_lengths_px": [ + 18.681541442871094, + 23.0, + 17.72004508972168, + 23.021728515625 + ] + }, + "confidence": 0.20782158780899712 + }, + { + "observation_id": "2d236f23-7c4d-467e-b90d-38c8c903387a", + "type": "aruco", + "marker_id": 70, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 927.0, + 192.0 + ], + [ + 925.0, + 175.0 + ], + [ + 949.0, + 175.0 + ], + [ + 951.0, + 192.0 + ] + ], + "center_px": [ + 938.0, + 183.5 + ], + "quality": { + "area_px": 408.0, + "perimeter_px": 82.2344856262207, + "sharpness": { + "laplacian_var": 2501.2391555555555 + }, + "contrast": { + "p05": 7.0, + "p95": 157.0, + "dynamic_range": 150.0, + "mean_gray": 79.91666666666667, + "std_gray": 60.431639523974155 + }, + "geometry": { + "distance_to_center_norm": 0.4716681241989136, + "distance_to_border_px": 175.0 + }, + "edge_ratio": 1.4020949671648077, + "edge_lengths_px": [ + 17.11724281311035, + 24.0, + 17.11724281311035, + 24.0 + ] + }, + "confidence": 0.193995418548584 + }, + { + "observation_id": "63b18745-2a4e-4cba-a539-f967bcc6e053", + "type": "aruco", + "marker_id": 73, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 531.0, + 171.0 + ], + [ + 532.0, + 154.0 + ], + [ + 556.0, + 154.0 + ], + [ + 555.0, + 171.0 + ] + ], + "center_px": [ + 543.5, + 162.5 + ], + "quality": { + "area_px": 408.0, + "perimeter_px": 82.05877304077148, + "sharpness": { + "laplacian_var": 2955.8061831547116 + }, + "contrast": { + "p05": 8.0, + "p95": 159.0, + "dynamic_range": 151.0, + "mean_gray": 89.98671096345515, + "std_gray": 57.21974738825394 + }, + "geometry": { + "distance_to_center_norm": 0.2993517518043518, + "distance_to_border_px": 154.0 + }, + "edge_ratio": 1.4093285140524465, + "edge_lengths_px": [ + 17.029386520385742, + 24.0, + 17.029386520385742, + 24.0 + ] + }, + "confidence": 0.1929997138977051 + }, + { + "observation_id": "56b0861b-faf6-4e14-9274-37eb9a5fd1c2", + "type": "aruco", + "marker_id": 82, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 528.0, + 198.0 + ], + [ + 528.0, + 181.0 + ], + [ + 552.0, + 180.0 + ], + [ + 552.0, + 197.0 + ] + ], + "center_px": [ + 540.0, + 189.0 + ], + "quality": { + "area_px": 408.0, + "perimeter_px": 82.0416488647461, + "sharpness": { + "laplacian_var": 2217.554166666667 + }, + "contrast": { + "p05": 7.950000000000001, + "p95": 157.0, + "dynamic_range": 149.05, + "mean_gray": 78.80666666666667, + "std_gray": 61.69124158978233 + }, + "geometry": { + "distance_to_center_norm": 0.26977089047431946, + "distance_to_border_px": 180.0 + }, + "edge_ratio": 1.4129896724925322, + "edge_lengths_px": [ + 17.0, + 24.020824432373047, + 17.0, + 24.020824432373047 + ] + }, + "confidence": 0.19249963767972095 + }, + { + "observation_id": "055f2058-0ea0-4d5e-bb69-715e6d1af25d", + "type": "aruco", + "marker_id": 98, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 898.0, + 181.0 + ], + [ + 896.0, + 164.0 + ], + [ + 919.0, + 164.0 + ], + [ + 922.0, + 181.0 + ] + ], + "center_px": [ + 908.75, + 172.5 + ], + "quality": { + "area_px": 399.5, + "perimeter_px": 81.37991905212402, + "sharpness": { + "laplacian_var": 2482.449052355038 + }, + "contrast": { + "p05": 7.0, + "p95": 157.0, + "dynamic_range": 150.0, + "mean_gray": 73.75342465753425, + "std_gray": 60.998434927579794 + }, + "geometry": { + "distance_to_center_norm": 0.4462646245956421, + "distance_to_border_px": 164.0 + }, + "edge_ratio": 1.4020949671648077, + "edge_lengths_px": [ + 17.11724281311035, + 23.0, + 17.262676239013672, + 24.0 + ] + }, + "confidence": 0.1899538473288218 + }, + { + "observation_id": "14fe3dcc-d6a1-4c86-bc03-7e4d98385030", + "type": "aruco", + "marker_id": 83, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 348.0, + 168.0 + ], + [ + 350.0, + 152.0 + ], + [ + 374.0, + 151.0 + ], + [ + 372.0, + 168.0 + ] + ], + "center_px": [ + 361.0, + 159.75 + ], + "quality": { + "area_px": 395.0, + "perimeter_px": 81.26258277893066, + "sharpness": { + "laplacian_var": 3409.882544509764 + }, + "contrast": { + "p05": 10.0, + "p95": 167.0, + "dynamic_range": 157.0, + "mean_gray": 97.84429065743944, + "std_gray": 59.914933731185954 + }, + "geometry": { + "distance_to_center_norm": 0.4676894545555115, + "distance_to_border_px": 151.0 + }, + "edge_ratio": 1.489708288137177, + "edge_lengths_px": [ + 16.124515533447266, + 24.020824432373047, + 17.11724281311035, + 24.0 + ] + }, + "confidence": 0.17676838843571283 + }, + { + "observation_id": "11a736c2-17c7-4737-befb-79001835b82e", + "type": "aruco", + "marker_id": 61, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 279.0, + 171.0 + ], + [ + 281.0, + 155.0 + ], + [ + 305.0, + 154.0 + ], + [ + 304.0, + 170.0 + ] + ], + "center_px": [ + 292.25, + 162.5 + ], + "quality": { + "area_px": 390.5, + "perimeter_px": 81.19655227661133, + "sharpness": { + "laplacian_var": 3398.117658565211 + }, + "contrast": { + "p05": 9.0, + "p95": 169.0, + "dynamic_range": 160.0, + "mean_gray": 98.06293706293707, + "std_gray": 62.94149984360456 + }, + "geometry": { + "distance_to_center_norm": 0.5446262955665588, + "distance_to_border_px": 154.0 + }, + "edge_ratio": 1.560704278037201, + "edge_lengths_px": [ + 16.124515533447266, + 24.020824432373047, + 16.031219482421875, + 25.01999282836914 + ] + }, + "confidence": 0.1668050360320266 + }, + { + "observation_id": "f685d1a6-6e03-4b55-96e4-0394e51315de", + "type": "aruco", + "marker_id": 90, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 968.0, + 179.0 + ], + [ + 965.0, + 163.0 + ], + [ + 988.0, + 162.0 + ], + [ + 992.0, + 179.0 + ] + ], + "center_px": [ + 978.25, + 170.75 + ], + "quality": { + "area_px": 389.5, + "perimeter_px": 80.76479721069336, + "sharpness": { + "laplacian_var": 2144.868341186335 + }, + "contrast": { + "p05": 7.0, + "p95": 156.0, + "dynamic_range": 149.0, + "mean_gray": 79.12027491408935, + "std_gray": 61.5951416831086 + }, + "geometry": { + "distance_to_center_norm": 0.527838945388794, + "distance_to_border_px": 162.0 + }, + "edge_ratio": 1.4743083309606915, + "edge_lengths_px": [ + 16.278820037841797, + 23.021728515625, + 17.464248657226562, + 24.0 + ] + }, + "confidence": 0.17612778902053833 + }, + { + "observation_id": "6ebcf684-a959-4374-95df-67ad180f4755", + "type": "aruco", + "marker_id": 91, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 1049.0, + 170.0 + ], + [ + 1046.0, + 154.0 + ], + [ + 1069.0, + 153.0 + ], + [ + 1073.0, + 170.0 + ] + ], + "center_px": [ + 1059.25, + 161.75 + ], + "quality": { + "area_px": 389.5, + "perimeter_px": 80.76479721069336, + "sharpness": { + "laplacian_var": 1854.4396027444175 + }, + "contrast": { + "p05": 7.0, + "p95": 153.0, + "dynamic_range": 146.0, + "mean_gray": 69.28178694158076, + "std_gray": 61.10558979922066 + }, + "geometry": { + "distance_to_center_norm": 0.6315658688545227, + "distance_to_border_px": 153.0 + }, + "edge_ratio": 1.4743083309606915, + "edge_lengths_px": [ + 16.278820037841797, + 23.021728515625, + 17.464248657226562, + 24.0 + ] + }, + "confidence": 0.17612778902053833 + } + ], + "rejected_candidates": [ + { + "image_points_px": [ + [ + 759.0, + 486.0 + ], + [ + 943.0, + 475.0 + ], + [ + 971.0, + 502.0 + ], + [ + 794.0, + 516.0 + ] + ], + "center_px": [ + 866.75, + 494.75 + ], + "area_px": 5538.0 + }, + { + "image_points_px": [ + [ + 497.0, + 431.0 + ], + [ + 503.0, + 436.0 + ], + [ + 500.0, + 478.0 + ], + [ + 495.0, + 477.0 + ] + ], + "center_px": [ + 498.75, + 455.5 + ], + "area_px": 249.5 + }, + { + "image_points_px": [ + [ + 395.0, + 310.0 + ], + [ + 388.0, + 353.0 + ], + [ + 385.0, + 343.0 + ], + [ + 388.0, + 313.0 + ] + ], + "center_px": [ + 389.0, + 329.75 + ], + "area_px": 200.0 + }, + { + "image_points_px": [ + [ + 829.0, + 278.0 + ], + [ + 854.0, + 278.0 + ], + [ + 856.0, + 297.0 + ], + [ + 830.0, + 297.0 + ] + ], + "center_px": [ + 842.25, + 287.5 + ], + "area_px": 484.5 + }, + { + "image_points_px": [ + [ + 725.0, + 208.0 + ], + [ + 750.0, + 208.0 + ], + [ + 751.0, + 226.0 + ], + [ + 726.0, + 226.0 + ] + ], + "center_px": [ + 738.0, + 217.0 + ], + "area_px": 450.0 + }, + { + "image_points_px": [ + [ + 452.0, + 273.0 + ], + [ + 452.0, + 290.0 + ], + [ + 426.0, + 289.0 + ], + [ + 427.0, + 273.0 + ] + ], + "center_px": [ + 439.25, + 281.25 + ], + "area_px": 421.0 + }, + { + "image_points_px": [ + [ + 423.0, + 180.0 + ], + [ + 447.0, + 180.0 + ], + [ + 446.0, + 197.0 + ], + [ + 422.0, + 198.0 + ] + ], + "center_px": [ + 434.5, + 188.75 + ], + "area_px": 419.5 + }, + { + "image_points_px": [ + [ + 547.0, + 456.0 + ], + [ + 552.0, + 457.0 + ], + [ + 553.0, + 465.0 + ], + [ + 549.0, + 488.0 + ] + ], + "center_px": [ + 550.25, + 466.5 + ], + "area_px": 106.5 + }, + { + "image_points_px": [ + [ + 570.0, + 423.0 + ], + [ + 578.0, + 421.0 + ], + [ + 584.0, + 441.0 + ], + [ + 581.0, + 440.0 + ] + ], + "center_px": [ + 578.25, + 431.25 + ], + "area_px": 106.0 + }, + { + "image_points_px": [ + [ + 288.0, + 325.0 + ], + [ + 295.0, + 327.0 + ], + [ + 299.0, + 341.0 + ], + [ + 284.0, + 340.0 + ] + ], + "center_px": [ + 291.5, + 333.25 + ], + "area_px": 159.5 + }, + { + "image_points_px": [ + [ + 492.0, + 448.0 + ], + [ + 494.0, + 451.0 + ], + [ + 492.0, + 472.0 + ], + [ + 490.0, + 461.0 + ] + ], + "center_px": [ + 492.0, + 458.0 + ], + "area_px": 48.0 + }, + { + "image_points_px": [ + [ + 547.0, + 577.0 + ], + [ + 545.0, + 581.0 + ], + [ + 525.0, + 581.0 + ], + [ + 529.0, + 577.0 + ] + ], + "center_px": [ + 536.5, + 579.0 + ], + "area_px": 76.0 + }, + { + "image_points_px": [ + [ + 49.0, + 268.0 + ], + [ + 55.0, + 266.0 + ], + [ + 70.0, + 266.0 + ], + [ + 64.0, + 268.0 + ] + ], + "center_px": [ + 59.5, + 267.0 + ], + "area_px": 30.0 + }, + { + "image_points_px": [ + [ + 585.0, + 398.0 + ], + [ + 584.0, + 413.0 + ], + [ + 582.0, + 417.0 + ], + [ + 580.0, + 400.0 + ] + ], + "center_px": [ + 582.75, + 407.0 + ], + "area_px": 57.5 + }, + { + "image_points_px": [ + [ + 1034.0, + 647.0 + ], + [ + 1049.0, + 647.0 + ], + [ + 1054.0, + 649.0 + ], + [ + 1038.0, + 649.0 + ] + ], + "center_px": [ + 1043.75, + 648.0 + ], + "area_px": 31.0 + }, + { + "image_points_px": [ + [ + 908.0, + 245.0 + ], + [ + 923.0, + 244.0 + ], + [ + 924.0, + 248.0 + ], + [ + 909.0, + 250.0 + ] + ], + "center_px": [ + 916.0, + 246.75 + ], + "area_px": 69.0 + } + ] +} \ No newline at end of file diff --git a/data/evaluations/Scene8/render_b_camera_pose.json b/data/evaluations/Scene8/render_b_camera_pose.json new file mode 100644 index 0000000..c4cee59 --- /dev/null +++ b/data/evaluations/Scene8/render_b_camera_pose.json @@ -0,0 +1,747 @@ +{ + "schema_version": "1.0", + "created_utc": "2026-06-01T18:36:47Z", + "source": { + "detection_json": "C:\\Users\\kech\\SynologyDrive\\2026-AppServer-AppRobot\\appRobotRendering\\data\\evaluations\\Scene8\\render_b_aruco_detection.json", + "robot_json": "C:\\Users\\kech\\SynologyDrive\\2026-AppServer-AppRobot\\appRobotRendering\\data\\robot\\robot.json" + }, + "camera": { + "camera_id": "b", + "camera_matrix": [ + [ + 1777.77783203125, + 0.0, + 640.0 + ], + [ + 0.0, + 1777.77783203125, + 360.0 + ], + [ + 0.0, + 0.0, + 1.0 + ] + ], + "distortion_coefficients": [ + 0.0, + 0.0, + 0.0, + 0.0, + 0.0 + ] + }, + "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": 39, + "used_marker_ids": [ + 63, + 102, + 64, + 58, + 92, + 96, + 103, + 62, + 51, + 79, + 205, + 217, + 208, + 210, + 206, + 207, + 214, + 94, + 76, + 100, + 75, + 68, + 46, + 50, + 72, + 104, + 53, + 60, + 67, + 86, + 88, + 70, + 73, + 82, + 98, + 83, + 61, + 90, + 91 + ], + "history": { + "iters": [ + 0, + 1, + 2, + 3 + ], + "rms": [ + 0.011093638687636574, + 0.0006436030261217283, + 0.00010282824998360295, + 0.00010279252869638501 + ], + "lambda": [ + 0.001, + 0.0005, + 0.00025, + 0.000125 + ] + }, + "residual_rms_px": 0.2584369670423191, + "residual_median_px": 0.18416060091414674, + "residual_max_px": 0.522510620901101, + "sigma2_normalized": 1.1446829282985532e-08 + }, + "camera_pose": { + "world_to_camera": { + "rotation_matrix": [ + [ + 0.999921977519989, + -0.01248433068394661, + 0.00043103384086862206 + ], + [ + -0.009461755864322186, + -0.7794579267501831, + -0.6263831257820129 + ], + [ + 0.008155946619808674, + 0.6263301372528076, + -0.7795152068138123 + ] + ], + "translation_m": [ + -0.31134286522865295, + 0.05270953103899956, + 1.4960384368896484 + ], + "rvec_rad": [ + 2.4646503655184615, + -0.015198377206528989, + 0.0059467625867537155 + ] + }, + "camera_in_world": { + "position_m": [ + 0.29961568117141724, + -0.8998160362243652, + 1.1993352174758911 + ], + "position_mm": [ + 299.6156921386719, + -899.8160400390625, + 1199.335205078125 + ], + "orientation_deg": { + "roll": 141.2185821533203, + "pitch": -0.467306524515152, + "yaw": -0.5421447157859802 + } + }, + "uncertainty": { + "pose_covariance_6x6": [ + [ + 5.1717065956542015e-08, + 7.387089635935163e-10, + 2.74028586145257e-09, + 1.3329136025014982e-09, + 3.2676436991693444e-09, + 1.6024438837453037e-08 + ], + [ + 7.387089635934132e-10, + 1.2121044155042461e-08, + -5.970347265873502e-09, + -9.205320942007325e-10, + -3.17031871939386e-09, + 3.831380908203004e-09 + ], + [ + 2.7402858614524353e-09, + -5.97034726587355e-09, + 9.286921070785842e-08, + 5.834164434234871e-09, + -8.93421901324287e-09, + -3.530274157941571e-08 + ], + [ + 1.3329136025014939e-09, + -9.205320942007456e-10, + 5.8341644342348745e-09, + 1.26219901595311e-09, + -2.634599399517684e-10, + -3.9397573923123505e-10 + ], + [ + 3.267643699169405e-09, + -3.170318719393852e-09, + -8.934219013242878e-09, + -2.63459939951772e-10, + 3.05615540701563e-09, + 4.54489569938144e-09 + ], + [ + 1.602443883745306e-08, + 3.831380908202932e-09, + -3.530274157941582e-08, + -3.93975739231234e-10, + 4.544895699381478e-09, + 3.6165008405682416e-08 + ] + ], + "parameter_std": { + "rvec_std_deg": [ + 0.013029854662509185, + 0.006308014007668826, + 0.017460573720022382 + ], + "tvec_std_m": [ + 3.5527440323686564e-05, + 5.528250543359653e-05, + 0.00019017099780377242 + ] + }, + "camera_center_std_m": [ + 0.0003573986885585613, + 0.0002670743505114525, + 0.0003370761524841528 + ], + "camera_center_std_mm": [ + 0.3573986885585613, + 0.2670743505114525, + 0.3370761524841528 + ], + "orientation_std_deg": { + "roll": 0.010410180583974601, + "pitch": 0.012986778635693686, + "yaw": 0.005728532644028995 + } + } + }, + "observations": { + "markers": [ + { + "marker_id": 63, + "observed_center_px": [ + 1246.0, + 678.75 + ], + "projected_center_px": [ + 1245.9658203125, + 678.5629272460938 + ], + "reprojection_error_px": 0.19016957246538163, + "confidence": 0.1539593300495616 + }, + { + "marker_id": 102, + "observed_center_px": [ + 1078.25, + 665.5 + ], + "projected_center_px": [ + 1078.44384765625, + 665.2827758789062 + ], + "reprojection_error_px": 0.29114125887371295, + "confidence": 0.39637168760361213 + }, + { + "marker_id": 64, + "observed_center_px": [ + 220.5, + 635.25 + ], + "projected_center_px": [ + 220.38131713867188, + 635.35791015625 + ], + "reprojection_error_px": 0.16040643190012788, + "confidence": 0.4633649853376546 + }, + { + "marker_id": 58, + "observed_center_px": [ + 307.25, + 668.0 + ], + "projected_center_px": [ + 307.1998291015625, + 668.0831298828125 + ], + "reprojection_error_px": 0.09709632571032707, + "confidence": 0.3638956157928849 + }, + { + "marker_id": 92, + "observed_center_px": [ + 1064.5, + 622.75 + ], + "projected_center_px": [ + 1064.5921630859375, + 622.5718994140625 + ], + "reprojection_error_px": 0.2005339201252592, + "confidence": 0.46896024883690896 + }, + { + "marker_id": 96, + "observed_center_px": [ + 716.75, + 628.0 + ], + "projected_center_px": [ + 716.9041137695312, + 628.114013671875 + ], + "reprojection_error_px": 0.19170334199891093, + "confidence": 0.44372569385651617 + }, + { + "marker_id": 103, + "observed_center_px": [ + 382.0, + 633.0 + ], + "projected_center_px": [ + 381.9422607421875, + 633.0508422851562 + ], + "reprojection_error_px": 0.07693347680072558, + "confidence": 0.45199802144368495 + }, + { + "marker_id": 62, + "observed_center_px": [ + 760.25, + 615.0 + ], + "projected_center_px": [ + 760.3285522460938, + 615.1016235351562 + ], + "reprojection_error_px": 0.12844375525507903, + "confidence": 0.44348322079976393 + }, + { + "marker_id": 51, + "observed_center_px": [ + 461.75, + 615.0 + ], + "projected_center_px": [ + 461.8082580566406, + 614.9672241210938 + ], + "reprojection_error_px": 0.06684504021705301, + "confidence": 0.44348322079976393 + }, + { + "marker_id": 79, + "observed_center_px": [ + 643.75, + 598.75 + ], + "projected_center_px": [ + 643.6393432617188, + 598.9309692382812 + ], + "reprojection_error_px": 0.21211972782167363, + "confidence": 0.41815762699787656 + }, + { + "marker_id": 205, + "observed_center_px": [ + 1181.0, + 502.0 + ], + "projected_center_px": [ + 1180.7822265625, + 502.1390686035156 + ], + "reprojection_error_px": 0.25838991188580196, + "confidence": 0.3958181457519531 + }, + { + "marker_id": 217, + "observed_center_px": [ + 1058.0, + 503.25 + ], + "projected_center_px": [ + 1058.0450439453125, + 503.3835754394531 + ], + "reprojection_error_px": 0.14096579384521252, + "confidence": 0.4015868133874269 + }, + { + "marker_id": 208, + "observed_center_px": [ + 688.75, + 507.0 + ], + "projected_center_px": [ + 689.0005493164062, + 507.1256103515625 + ], + "reprojection_error_px": 0.2802729390635029, + "confidence": 0.3776 + }, + { + "marker_id": 210, + "observed_center_px": [ + 291.0, + 441.75 + ], + "projected_center_px": [ + 291.14788818359375, + 441.398193359375 + ], + "reprojection_error_px": 0.3816265546768288, + "confidence": 0.3320910299473707 + }, + { + "marker_id": 206, + "observed_center_px": [ + 1043.0, + 424.5 + ], + "projected_center_px": [ + 1042.8446044921875, + 424.4183044433594 + ], + "reprojection_error_px": 0.17556174931666155, + "confidence": 0.3579602826436361 + }, + { + "marker_id": 207, + "observed_center_px": [ + 1162.0, + 423.25 + ], + "projected_center_px": [ + 1161.4781494140625, + 423.2585144042969 + ], + "reprojection_error_px": 0.5219200409294921, + "confidence": 0.343462485354258 + }, + { + "marker_id": 214, + "observed_center_px": [ + 686.25, + 427.75 + ], + "projected_center_px": [ + 686.1656494140625, + 427.9052429199219 + ], + "reprojection_error_px": 0.17667876367540403, + "confidence": 0.3244367816091954 + }, + { + "marker_id": 94, + "observed_center_px": [ + 1252.0, + 279.5 + ], + "projected_center_px": [ + 1251.8607177734375, + 279.63677978515625 + ], + "reprojection_error_px": 0.1952133403832778, + "confidence": 0.06057156860351561 + }, + { + "marker_id": 76, + "observed_center_px": [ + 1046.0, + 287.5 + ], + "projected_center_px": [ + 1046.0728759765625, + 287.1498718261719 + ], + "reprojection_error_px": 0.35763199810441426, + "confidence": 0.2459421895345052 + }, + { + "marker_id": 100, + "observed_center_px": [ + 1173.25, + 281.5 + ], + "projected_center_px": [ + 1173.478759765625, + 281.41015625 + ], + "reprojection_error_px": 0.24577007503532125, + "confidence": 0.24407473894265982 + }, + { + "marker_id": 75, + "observed_center_px": [ + 271.75, + 271.5 + ], + "projected_center_px": [ + 271.7691955566406, + 271.47454833984375 + ], + "reprojection_error_px": 0.03187877663042744, + "confidence": 0.23896265492072474 + }, + { + "marker_id": 68, + "observed_center_px": [ + 924.0, + 285.25 + ], + "projected_center_px": [ + 923.9862670898438, + 285.10125732421875 + ], + "reprojection_error_px": 0.14937528717939152, + "confidence": 0.24909137483284013 + }, + { + "marker_id": 46, + "observed_center_px": [ + 881.75, + 273.5 + ], + "projected_center_px": [ + 882.051025390625, + 273.3699645996094 + ], + "reprojection_error_px": 0.3279107975588544, + "confidence": 0.23734254719660833 + }, + { + "marker_id": 50, + "observed_center_px": [ + 919.0, + 251.5 + ], + "projected_center_px": [ + 918.6591186523438, + 251.75372314453125 + ], + "reprojection_error_px": 0.4249417927796309, + "confidence": 0.24364819717407224 + }, + { + "marker_id": 72, + "observed_center_px": [ + 777.75, + 267.25 + ], + "projected_center_px": [ + 777.6388549804688, + 267.1112060546875 + ], + "reprojection_error_px": 0.1778116267908575, + "confidence": 0.21841319450965294 + }, + { + "marker_id": 104, + "observed_center_px": [ + 1184.0, + 228.0 + ], + "projected_center_px": [ + 1184.112060546875, + 227.8472900390625 + ], + "reprojection_error_px": 0.18941462017346192, + "confidence": 0.22417849731445313 + }, + { + "marker_id": 53, + "observed_center_px": [ + 825.5, + 252.25 + ], + "projected_center_px": [ + 825.0706787109375, + 252.29075622558594 + ], + "reprojection_error_px": 0.4312514801902696, + "confidence": 0.22367025973033955 + }, + { + "marker_id": 60, + "observed_center_px": [ + 765.0, + 197.25 + ], + "projected_center_px": [ + 764.9937744140625, + 197.23472595214844 + ], + "reprojection_error_px": 0.016494073421596582, + "confidence": 0.2000031054889577 + }, + { + "marker_id": 67, + "observed_center_px": [ + 859.25, + 209.25 + ], + "projected_center_px": [ + 859.3123779296875, + 209.16848754882812 + ], + "reprojection_error_px": 0.10264154036327593, + "confidence": 0.19627771759033205 + }, + { + "marker_id": 86, + "observed_center_px": [ + 690.25, + 192.0 + ], + "projected_center_px": [ + 689.9580078125, + 191.7041778564453 + ], + "reprojection_error_px": 0.41565632219217513, + "confidence": 0.18966921411877496 + }, + { + "marker_id": 88, + "observed_center_px": [ + 1105.0, + 169.75 + ], + "projected_center_px": [ + 1105.23486328125, + 170.2167510986328 + ], + "reprojection_error_px": 0.522510620901101, + "confidence": 0.20782158780899712 + }, + { + "marker_id": 70, + "observed_center_px": [ + 938.0, + 183.5 + ], + "projected_center_px": [ + 938.0252685546875, + 183.3175811767578 + ], + "reprojection_error_px": 0.18416060091414674, + "confidence": 0.193995418548584 + }, + { + "marker_id": 73, + "observed_center_px": [ + 543.5, + 162.5 + ], + "projected_center_px": [ + 543.4841918945312, + 162.51072692871094 + ], + "reprojection_error_px": 0.01910401000001463, + "confidence": 0.1929997138977051 + }, + { + "marker_id": 82, + "observed_center_px": [ + 540.0, + 189.0 + ], + "projected_center_px": [ + 539.999267578125, + 189.0796356201172 + ], + "reprojection_error_px": 0.07963898814809224, + "confidence": 0.19249963767972095 + }, + { + "marker_id": 98, + "observed_center_px": [ + 908.75, + 172.5 + ], + "projected_center_px": [ + 908.7716674804688, + 172.63194274902344 + ], + "reprojection_error_px": 0.13371001731256144, + "confidence": 0.1899538473288218 + }, + { + "marker_id": 83, + "observed_center_px": [ + 361.0, + 159.75 + ], + "projected_center_px": [ + 361.09381103515625, + 159.614990234375 + ], + "reprojection_error_px": 0.1644023939339224, + "confidence": 0.17676838843571283 + }, + { + "marker_id": 61, + "observed_center_px": [ + 292.25, + 162.5 + ], + "projected_center_px": [ + 292.19354248046875, + 162.67332458496094 + ], + "reprojection_error_px": 0.18228785824487245, + "confidence": 0.1668050360320266 + }, + { + "marker_id": 90, + "observed_center_px": [ + 978.25, + 170.75 + ], + "projected_center_px": [ + 978.6781005859375, + 171.01870727539062 + ], + "reprojection_error_px": 0.5054440735906239, + "confidence": 0.17612778902053833 + }, + { + "marker_id": 91, + "observed_center_px": [ + 1059.25, + 161.75 + ], + "projected_center_px": [ + 1059.4254150390625, + 161.79110717773438 + ], + "reprojection_error_px": 0.18016724449961458, + "confidence": 0.17612778902053833 + } + ] + }, + "qa": { + "sanity_notes": [] + } +} \ No newline at end of file diff --git a/data/evaluations/Scene8/render_b_camera_pose_v8.json b/data/evaluations/Scene8/render_b_camera_pose_v8.json new file mode 100644 index 0000000..57e0e5d --- /dev/null +++ b/data/evaluations/Scene8/render_b_camera_pose_v8.json @@ -0,0 +1,748 @@ +{ + "schema_version": "1.0", + "created_utc": "2026-06-01T18:37:02Z", + "source": { + "detection_json": "C:\\Users\\kech\\SynologyDrive\\2026-AppServer-AppRobot\\appRobotRendering\\data\\evaluations\\Scene8\\render_b_aruco_detection.json", + "robot_json": "C:\\Users\\kech\\SynologyDrive\\2026-AppServer-AppRobot\\appRobotRendering\\data\\robot\\robot.json" + }, + "camera": { + "camera_id": "b", + "camera_matrix": [ + [ + 1777.77783203125, + 0.0, + 640.0 + ], + [ + 0.0, + 1777.77783203125, + 360.0 + ], + [ + 0.0, + 0.0, + 1.0 + ] + ], + "distortion_coefficients": [ + 0.0, + 0.0, + 0.0, + 0.0, + 0.0 + ] + }, + "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": 39, + "used_marker_ids": [ + 63, + 102, + 64, + 58, + 92, + 96, + 103, + 62, + 51, + 79, + 205, + 217, + 208, + 210, + 206, + 207, + 214, + 94, + 76, + 100, + 75, + 68, + 46, + 50, + 72, + 104, + 53, + 60, + 67, + 86, + 88, + 70, + 73, + 82, + 98, + 83, + 61, + 90, + 91 + ], + "history": { + "iters": [ + 0, + 1, + 2, + 3 + ], + "rms": [ + 0.011093638687636574, + 0.0006436030261217283, + 0.00010282824998360295, + 0.00010279252869638501 + ], + "lambda": [ + 0.001, + 0.0005, + 0.00025, + 0.000125 + ] + }, + "residual_rms_px": 0.2584369670423191, + "residual_median_px": 0.18416060091414674, + "residual_max_px": 0.522510620901101, + "sigma2_normalized": 1.1446829282985532e-08 + }, + "camera_pose": { + "world_to_camera": { + "rotation_matrix": [ + [ + 0.999921977519989, + -0.01248433068394661, + 0.00043103384086862206 + ], + [ + -0.009461755864322186, + -0.7794579267501831, + -0.6263831257820129 + ], + [ + 0.008155946619808674, + 0.6263301372528076, + -0.7795152068138123 + ] + ], + "translation_m": [ + -0.3113476733205799, + 0.059694933290393014, + 1.504731417967143 + ], + "rvec_rad": [ + 2.4646503655184615, + -0.015198377206528989, + 0.0059467625867537155 + ] + }, + "camera_in_world": { + "position_m": [ + 0.29961568856813403, + -0.8998160050145382, + 1.2104872071237363 + ], + "position_mm": [ + 299.61568856813403, + -899.8160050145382, + 1210.4872071237362 + ], + "orientation_deg": { + "roll": 141.2185821533203, + "pitch": -0.467306524515152, + "yaw": -0.5421447157859802 + } + }, + "uncertainty": { + "pose_covariance_6x6": [ + [ + 5.1717065956542015e-08, + 7.387089635935163e-10, + 2.74028586145257e-09, + 1.3329136025014982e-09, + 3.2676436991693444e-09, + 1.6024438837453037e-08 + ], + [ + 7.387089635934132e-10, + 1.2121044155042461e-08, + -5.970347265873502e-09, + -9.205320942007325e-10, + -3.17031871939386e-09, + 3.831380908203004e-09 + ], + [ + 2.7402858614524353e-09, + -5.97034726587355e-09, + 9.286921070785842e-08, + 5.834164434234871e-09, + -8.93421901324287e-09, + -3.530274157941571e-08 + ], + [ + 1.3329136025014939e-09, + -9.205320942007456e-10, + 5.8341644342348745e-09, + 1.26219901595311e-09, + -2.634599399517684e-10, + -3.9397573923123505e-10 + ], + [ + 3.267643699169405e-09, + -3.170318719393852e-09, + -8.934219013242878e-09, + -2.63459939951772e-10, + 3.05615540701563e-09, + 4.54489569938144e-09 + ], + [ + 1.602443883745306e-08, + 3.831380908202932e-09, + -3.530274157941582e-08, + -3.93975739231234e-10, + 4.544895699381478e-09, + 3.6165008405682416e-08 + ] + ], + "parameter_std": { + "rvec_std_deg": [ + 0.013029854662509185, + 0.006308014007668826, + 0.017460573720022382 + ], + "tvec_std_m": [ + 3.5527440323686564e-05, + 5.528250543359653e-05, + 0.00019017099780377242 + ] + }, + "camera_center_std_m": [ + 0.0003573986885585613, + 0.0002670743505114525, + 0.0003370761524841528 + ], + "camera_center_std_mm": [ + 0.3573986885585613, + 0.2670743505114525, + 0.3370761524841528 + ], + "orientation_std_deg": { + "roll": 0.010410180583974601, + "pitch": 0.012986778635693686, + "yaw": 0.005728532644028995 + } + } + }, + "observations": { + "markers": [ + { + "marker_id": 63, + "observed_center_px": [ + 1246.0, + 678.75 + ], + "projected_center_px": [ + 1245.9658203125, + 678.5629272460938 + ], + "reprojection_error_px": 0.19016957246538163, + "confidence": 0.1539593300495616 + }, + { + "marker_id": 102, + "observed_center_px": [ + 1078.25, + 665.5 + ], + "projected_center_px": [ + 1078.44384765625, + 665.2827758789062 + ], + "reprojection_error_px": 0.29114125887371295, + "confidence": 0.39637168760361213 + }, + { + "marker_id": 64, + "observed_center_px": [ + 220.5, + 635.25 + ], + "projected_center_px": [ + 220.38131713867188, + 635.35791015625 + ], + "reprojection_error_px": 0.16040643190012788, + "confidence": 0.4633649853376546 + }, + { + "marker_id": 58, + "observed_center_px": [ + 307.25, + 668.0 + ], + "projected_center_px": [ + 307.1998291015625, + 668.0831298828125 + ], + "reprojection_error_px": 0.09709632571032707, + "confidence": 0.3638956157928849 + }, + { + "marker_id": 92, + "observed_center_px": [ + 1064.5, + 622.75 + ], + "projected_center_px": [ + 1064.5921630859375, + 622.5718994140625 + ], + "reprojection_error_px": 0.2005339201252592, + "confidence": 0.46896024883690896 + }, + { + "marker_id": 96, + "observed_center_px": [ + 716.75, + 628.0 + ], + "projected_center_px": [ + 716.9041137695312, + 628.114013671875 + ], + "reprojection_error_px": 0.19170334199891093, + "confidence": 0.44372569385651617 + }, + { + "marker_id": 103, + "observed_center_px": [ + 382.0, + 633.0 + ], + "projected_center_px": [ + 381.9422607421875, + 633.0508422851562 + ], + "reprojection_error_px": 0.07693347680072558, + "confidence": 0.45199802144368495 + }, + { + "marker_id": 62, + "observed_center_px": [ + 760.25, + 615.0 + ], + "projected_center_px": [ + 760.3285522460938, + 615.1016235351562 + ], + "reprojection_error_px": 0.12844375525507903, + "confidence": 0.44348322079976393 + }, + { + "marker_id": 51, + "observed_center_px": [ + 461.75, + 615.0 + ], + "projected_center_px": [ + 461.8082580566406, + 614.9672241210938 + ], + "reprojection_error_px": 0.06684504021705301, + "confidence": 0.44348322079976393 + }, + { + "marker_id": 79, + "observed_center_px": [ + 643.75, + 598.75 + ], + "projected_center_px": [ + 643.6393432617188, + 598.9309692382812 + ], + "reprojection_error_px": 0.21211972782167363, + "confidence": 0.41815762699787656 + }, + { + "marker_id": 205, + "observed_center_px": [ + 1181.0, + 502.0 + ], + "projected_center_px": [ + 1180.7822265625, + 502.1390686035156 + ], + "reprojection_error_px": 0.25838991188580196, + "confidence": 0.3958181457519531 + }, + { + "marker_id": 217, + "observed_center_px": [ + 1058.0, + 503.25 + ], + "projected_center_px": [ + 1058.0450439453125, + 503.3835754394531 + ], + "reprojection_error_px": 0.14096579384521252, + "confidence": 0.4015868133874269 + }, + { + "marker_id": 208, + "observed_center_px": [ + 688.75, + 507.0 + ], + "projected_center_px": [ + 689.0005493164062, + 507.1256103515625 + ], + "reprojection_error_px": 0.2802729390635029, + "confidence": 0.3776 + }, + { + "marker_id": 210, + "observed_center_px": [ + 291.0, + 441.75 + ], + "projected_center_px": [ + 291.14788818359375, + 441.398193359375 + ], + "reprojection_error_px": 0.3816265546768288, + "confidence": 0.3320910299473707 + }, + { + "marker_id": 206, + "observed_center_px": [ + 1043.0, + 424.5 + ], + "projected_center_px": [ + 1042.8446044921875, + 424.4183044433594 + ], + "reprojection_error_px": 0.17556174931666155, + "confidence": 0.3579602826436361 + }, + { + "marker_id": 207, + "observed_center_px": [ + 1162.0, + 423.25 + ], + "projected_center_px": [ + 1161.4781494140625, + 423.2585144042969 + ], + "reprojection_error_px": 0.5219200409294921, + "confidence": 0.343462485354258 + }, + { + "marker_id": 214, + "observed_center_px": [ + 686.25, + 427.75 + ], + "projected_center_px": [ + 686.1656494140625, + 427.9052429199219 + ], + "reprojection_error_px": 0.17667876367540403, + "confidence": 0.3244367816091954 + }, + { + "marker_id": 94, + "observed_center_px": [ + 1252.0, + 279.5 + ], + "projected_center_px": [ + 1251.8607177734375, + 279.63677978515625 + ], + "reprojection_error_px": 0.1952133403832778, + "confidence": 0.06057156860351561 + }, + { + "marker_id": 76, + "observed_center_px": [ + 1046.0, + 287.5 + ], + "projected_center_px": [ + 1046.0728759765625, + 287.1498718261719 + ], + "reprojection_error_px": 0.35763199810441426, + "confidence": 0.2459421895345052 + }, + { + "marker_id": 100, + "observed_center_px": [ + 1173.25, + 281.5 + ], + "projected_center_px": [ + 1173.478759765625, + 281.41015625 + ], + "reprojection_error_px": 0.24577007503532125, + "confidence": 0.24407473894265982 + }, + { + "marker_id": 75, + "observed_center_px": [ + 271.75, + 271.5 + ], + "projected_center_px": [ + 271.7691955566406, + 271.47454833984375 + ], + "reprojection_error_px": 0.03187877663042744, + "confidence": 0.23896265492072474 + }, + { + "marker_id": 68, + "observed_center_px": [ + 924.0, + 285.25 + ], + "projected_center_px": [ + 923.9862670898438, + 285.10125732421875 + ], + "reprojection_error_px": 0.14937528717939152, + "confidence": 0.24909137483284013 + }, + { + "marker_id": 46, + "observed_center_px": [ + 881.75, + 273.5 + ], + "projected_center_px": [ + 882.051025390625, + 273.3699645996094 + ], + "reprojection_error_px": 0.3279107975588544, + "confidence": 0.23734254719660833 + }, + { + "marker_id": 50, + "observed_center_px": [ + 919.0, + 251.5 + ], + "projected_center_px": [ + 918.6591186523438, + 251.75372314453125 + ], + "reprojection_error_px": 0.4249417927796309, + "confidence": 0.24364819717407224 + }, + { + "marker_id": 72, + "observed_center_px": [ + 777.75, + 267.25 + ], + "projected_center_px": [ + 777.6388549804688, + 267.1112060546875 + ], + "reprojection_error_px": 0.1778116267908575, + "confidence": 0.21841319450965294 + }, + { + "marker_id": 104, + "observed_center_px": [ + 1184.0, + 228.0 + ], + "projected_center_px": [ + 1184.112060546875, + 227.8472900390625 + ], + "reprojection_error_px": 0.18941462017346192, + "confidence": 0.22417849731445313 + }, + { + "marker_id": 53, + "observed_center_px": [ + 825.5, + 252.25 + ], + "projected_center_px": [ + 825.0706787109375, + 252.29075622558594 + ], + "reprojection_error_px": 0.4312514801902696, + "confidence": 0.22367025973033955 + }, + { + "marker_id": 60, + "observed_center_px": [ + 765.0, + 197.25 + ], + "projected_center_px": [ + 764.9937744140625, + 197.23472595214844 + ], + "reprojection_error_px": 0.016494073421596582, + "confidence": 0.2000031054889577 + }, + { + "marker_id": 67, + "observed_center_px": [ + 859.25, + 209.25 + ], + "projected_center_px": [ + 859.3123779296875, + 209.16848754882812 + ], + "reprojection_error_px": 0.10264154036327593, + "confidence": 0.19627771759033205 + }, + { + "marker_id": 86, + "observed_center_px": [ + 690.25, + 192.0 + ], + "projected_center_px": [ + 689.9580078125, + 191.7041778564453 + ], + "reprojection_error_px": 0.41565632219217513, + "confidence": 0.18966921411877496 + }, + { + "marker_id": 88, + "observed_center_px": [ + 1105.0, + 169.75 + ], + "projected_center_px": [ + 1105.23486328125, + 170.2167510986328 + ], + "reprojection_error_px": 0.522510620901101, + "confidence": 0.20782158780899712 + }, + { + "marker_id": 70, + "observed_center_px": [ + 938.0, + 183.5 + ], + "projected_center_px": [ + 938.0252685546875, + 183.3175811767578 + ], + "reprojection_error_px": 0.18416060091414674, + "confidence": 0.193995418548584 + }, + { + "marker_id": 73, + "observed_center_px": [ + 543.5, + 162.5 + ], + "projected_center_px": [ + 543.4841918945312, + 162.51072692871094 + ], + "reprojection_error_px": 0.01910401000001463, + "confidence": 0.1929997138977051 + }, + { + "marker_id": 82, + "observed_center_px": [ + 540.0, + 189.0 + ], + "projected_center_px": [ + 539.999267578125, + 189.0796356201172 + ], + "reprojection_error_px": 0.07963898814809224, + "confidence": 0.19249963767972095 + }, + { + "marker_id": 98, + "observed_center_px": [ + 908.75, + 172.5 + ], + "projected_center_px": [ + 908.7716674804688, + 172.63194274902344 + ], + "reprojection_error_px": 0.13371001731256144, + "confidence": 0.1899538473288218 + }, + { + "marker_id": 83, + "observed_center_px": [ + 361.0, + 159.75 + ], + "projected_center_px": [ + 361.09381103515625, + 159.614990234375 + ], + "reprojection_error_px": 0.1644023939339224, + "confidence": 0.17676838843571283 + }, + { + "marker_id": 61, + "observed_center_px": [ + 292.25, + 162.5 + ], + "projected_center_px": [ + 292.19354248046875, + 162.67332458496094 + ], + "reprojection_error_px": 0.18228785824487245, + "confidence": 0.1668050360320266 + }, + { + "marker_id": 90, + "observed_center_px": [ + 978.25, + 170.75 + ], + "projected_center_px": [ + 978.6781005859375, + 171.01870727539062 + ], + "reprojection_error_px": 0.5054440735906239, + "confidence": 0.17612778902053833 + }, + { + "marker_id": 91, + "observed_center_px": [ + 1059.25, + 161.75 + ], + "projected_center_px": [ + 1059.4254150390625, + 161.79110717773438 + ], + "reprojection_error_px": 0.18016724449961458, + "confidence": 0.17612778902053833 + } + ] + }, + "qa": { + "sanity_notes": [] + }, + "v8_z_correction_mm": 11.151935468550299 +} \ No newline at end of file diff --git a/data/evaluations/Scene8/render_c_aruco_detection.json b/data/evaluations/Scene8/render_c_aruco_detection.json new file mode 100644 index 0000000..9228851 --- /dev/null +++ b/data/evaluations/Scene8/render_c_aruco_detection.json @@ -0,0 +1,1232 @@ +{ + "schema_version": "1.0", + "created_utc": "2026-06-01T18:36:43Z", + "vision_config": { + "MarkerType": "DICT_4X4_250", + "MarkerSize": 0.025 + }, + "camera": { + "camera_id": "c", + "intrinsics_file": "C:\\Users\\kech\\SynologyDrive\\2026-AppServer-AppRobot\\appRobotRendering\\data\\simulation\\Scene8\\render_a.npz", + "camera_matrix": [ + [ + 1777.77783203125, + 0.0, + 640.0 + ], + [ + 0.0, + 1777.77783203125, + 360.0 + ], + [ + 0.0, + 0.0, + 1.0 + ] + ], + "distortion_coefficients": [ + 0.0, + 0.0, + 0.0, + 0.0, + 0.0 + ] + }, + "image": { + "image_file": "C:\\Users\\kech\\SynologyDrive\\2026-AppServer-AppRobot\\appRobotRendering\\data\\simulation\\Scene8\\render_c.png", + "image_sha256": "a8889243e89e23f042519bf0352fe072d9df902d060e7c64d3e03fd227cad124", + "width_px": 1280, + "height_px": 720 + }, + "aruco": { + "dictionary": "DICT_4X4_250", + "num_detected_markers": 14, + "num_rejected_candidates": 17 + }, + "detections": [ + { + "observation_id": "01348581-844e-4f6e-8c29-907928370167", + "type": "aruco", + "marker_id": 44, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 723.0, + 100.0 + ], + [ + 712.0, + 41.0 + ], + [ + 768.0, + 31.0 + ], + [ + 778.0, + 91.0 + ] + ], + "center_px": [ + 745.25, + 65.75 + ], + "quality": { + "area_px": 3402.0, + "perimeter_px": 233.4616355895996, + "sharpness": { + "laplacian_var": 729.9068446846409 + }, + "contrast": { + "p05": 8.0, + "p95": 166.0, + "dynamic_range": 158.0, + "mean_gray": 54.452019105514545, + "std_gray": 65.48795584927184 + }, + "geometry": { + "distance_to_center_norm": 0.42558351159095764, + "distance_to_border_px": 31.0 + }, + "edge_ratio": 1.0914406874675815, + "edge_lengths_px": [ + 60.01666259765625, + 56.88584899902344, + 60.8276252746582, + 55.73149871826172 + ] + }, + "confidence": 0.5680565211826186 + }, + { + "observation_id": "56943d0e-532b-49b4-97cf-6d38d144588c", + "type": "aruco", + "marker_id": 115, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 706.0, + 245.0 + ], + [ + 656.0, + 239.0 + ], + [ + 657.0, + 182.0 + ], + [ + 707.0, + 187.0 + ] + ], + "center_px": [ + 681.5, + 213.25 + ], + "quality": { + "area_px": 2880.5, + "perimeter_px": 215.62548446655273, + "sharpness": { + "laplacian_var": 1156.5547866735521 + }, + "contrast": { + "p05": 33.0, + "p95": 189.0, + "dynamic_range": 156.0, + "mean_gray": 64.75550891920251, + "std_gray": 57.90341882319785 + }, + "geometry": { + "distance_to_center_norm": 0.20768709480762482, + "distance_to_border_px": 182.0 + }, + "edge_ratio": 1.154414706982455, + "edge_lengths_px": [ + 50.35871505737305, + 57.00876998901367, + 50.2493782043457, + 58.00862121582031 + ] + }, + "confidence": 0.8662398304106136 + }, + { + "observation_id": "21bd4fb1-fa24-44b8-a29a-90d77c3fcb04", + "type": "aruco", + "marker_id": 245, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 737.0, + 594.0 + ], + [ + 736.0, + 645.0 + ], + [ + 682.0, + 643.0 + ], + [ + 682.0, + 592.0 + ] + ], + "center_px": [ + 709.25, + 618.5 + ], + "quality": { + "area_px": 2780.5, + "perimeter_px": 211.08317947387695, + "sharpness": { + "laplacian_var": 1355.794647830936 + }, + "contrast": { + "p05": 21.0, + "p95": 178.0, + "dynamic_range": 157.0, + "mean_gray": 79.68930481283422, + "std_gray": 71.64525832665541 + }, + "geometry": { + "distance_to_center_norm": 0.36444804072380066, + "distance_to_border_px": 75.0 + }, + "edge_ratio": 1.0791441225538068, + "edge_lengths_px": [ + 51.009803771972656, + 54.037025451660156, + 51.0, + 55.03635025024414 + ] + }, + "confidence": 0.9266602848500798 + }, + { + "observation_id": "f91eca61-cb95-480f-b25b-8b9b20bdade0", + "type": "aruco", + "marker_id": 248, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 653.0, + 590.0 + ], + [ + 653.0, + 641.0 + ], + [ + 599.0, + 638.0 + ], + [ + 599.0, + 588.0 + ] + ], + "center_px": [ + 626.0, + 614.25 + ], + "quality": { + "area_px": 2727.0, + "perimeter_px": 209.12029647827148, + "sharpness": { + "laplacian_var": 1806.0916435831948 + }, + "contrast": { + "p05": 22.0, + "p95": 179.0, + "dynamic_range": 157.0, + "mean_gray": 88.88444687842278, + "std_gray": 72.74289153247668 + }, + "geometry": { + "distance_to_center_norm": 0.3467715382575989, + "distance_to_border_px": 79.0 + }, + "edge_ratio": 1.0816654205322265, + "edge_lengths_px": [ + 51.0, + 54.08327102661133, + 50.0, + 54.037025451660156 + ] + }, + "confidence": 0.9245002946548448 + }, + { + "observation_id": "0d57e0f2-a600-4d8b-8ade-6a362ce0c50b", + "type": "aruco", + "marker_id": 243, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 483.0, + 590.0 + ], + [ + 537.0, + 592.0 + ], + [ + 538.0, + 640.0 + ], + [ + 485.0, + 638.0 + ] + ], + "center_px": [ + 510.75, + 615.0 + ], + "quality": { + "area_px": 2565.0, + "perimeter_px": 203.12681198120117, + "sharpness": { + "laplacian_var": 1308.1827021560414 + }, + "contrast": { + "p05": 22.0, + "p95": 177.0, + "dynamic_range": 155.0, + "mean_gray": 73.28438228438229, + "std_gray": 69.15337680104079 + }, + "geometry": { + "distance_to_center_norm": 0.3893295228481293, + "distance_to_border_px": 80.0 + }, + "edge_ratio": 1.1255271681810113, + "edge_lengths_px": [ + 54.037025451660156, + 48.010414123535156, + 53.037723541259766, + 48.041648864746094 + ] + }, + "confidence": 0.8884725560344505 + }, + { + "observation_id": "57ccb8fe-23d8-4318-8775-11c66632dd2c", + "type": "aruco", + "marker_id": 114, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 805.0, + 233.0 + ], + [ + 780.0, + 243.0 + ], + [ + 781.0, + 184.0 + ], + [ + 807.0, + 177.0 + ] + ], + "center_px": [ + 793.25, + 209.25 + ], + "quality": { + "area_px": 1453.5, + "perimeter_px": 168.89582061767578, + "sharpness": { + "laplacian_var": 373.600439 + }, + "contrast": { + "p05": 11.0, + "p95": 95.04999999999995, + "dynamic_range": 84.04999999999995, + "mean_gray": 33.373, + "std_gray": 33.35175963873571 + }, + "geometry": { + "distance_to_center_norm": 0.2927509546279907, + "distance_to_border_px": 177.0 + }, + "edge_ratio": 2.191519716175366, + "edge_lengths_px": [ + 26.925823211669922, + 59.00847244262695, + 26.925823211669922, + 56.035701751708984 + ] + }, + "confidence": 0.4421589241693412 + }, + { + "observation_id": "0cf7922d-f8aa-49aa-bcc4-1b988b2a4d3d", + "type": "aruco", + "marker_id": 120, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 801.0, + 388.0 + ], + [ + 776.0, + 402.0 + ], + [ + 777.0, + 345.0 + ], + [ + 802.0, + 334.0 + ] + ], + "center_px": [ + 789.0, + 367.25 + ], + "quality": { + "area_px": 1375.0, + "perimeter_px": 166.9841251373291, + "sharpness": { + "laplacian_var": 439.50855351193974 + }, + "contrast": { + "p05": 14.200000000000003, + "p95": 97.0, + "dynamic_range": 82.8, + "mean_gray": 33.3978835978836, + "std_gray": 30.496463421766265 + }, + "geometry": { + "distance_to_center_norm": 0.20315375924110413, + "distance_to_border_px": 318.0 + }, + "edge_ratio": 2.0872394303917954, + "edge_lengths_px": [ + 28.65309715270996, + 57.00876998901367, + 27.312999725341797, + 54.00925827026367 + ] + }, + "confidence": 0.4391765761605027 + }, + { + "observation_id": "c6ab6b7e-a700-49bd-8119-4f4868505d15", + "type": "aruco", + "marker_id": 229, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 501.0, + 500.0 + ], + [ + 552.0, + 502.0 + ], + [ + 544.0, + 523.0 + ], + [ + 491.0, + 521.0 + ] + ], + "center_px": [ + 522.0, + 511.5 + ], + "quality": { + "area_px": 1110.0, + "perimeter_px": 149.80853462219238, + "sharpness": { + "laplacian_var": 2591.8971566350774 + }, + "contrast": { + "p05": 17.0, + "p95": 179.0, + "dynamic_range": 162.0, + "mean_gray": 65.55699481865285, + "std_gray": 67.2936925135542 + }, + "geometry": { + "distance_to_center_norm": 0.26151609420776367, + "distance_to_border_px": 197.0 + }, + "edge_ratio": 2.360147809688194, + "edge_lengths_px": [ + 51.03919982910156, + 22.472204208374023, + 53.037723541259766, + 23.25940704345703 + ] + }, + "confidence": 0.31353968465973475 + }, + { + "observation_id": "b7aa3733-dab2-46ac-94e0-a86c455b2477", + "type": "aruco", + "marker_id": 232, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 681.0, + 650.0 + ], + [ + 736.0, + 653.0 + ], + [ + 738.0, + 672.0 + ], + [ + 685.0, + 669.0 + ] + ], + "center_px": [ + 710.0, + 661.0 + ], + "quality": { + "area_px": 1017.0, + "perimeter_px": 146.68805694580078, + "sharpness": { + "laplacian_var": 1866.819760909208 + }, + "contrast": { + "p05": 25.0, + "p95": 134.0, + "dynamic_range": 109.0, + "mean_gray": 75.98998569384835, + "std_gray": 46.24496152271377 + }, + "geometry": { + "distance_to_center_norm": 0.42085161805152893, + "distance_to_border_px": 48.0 + }, + "edge_ratio": 2.883110960426528, + "edge_lengths_px": [ + 55.081756591796875, + 19.10497283935547, + 53.0848388671875, + 19.416488647460938 + ] + }, + "confidence": 0.22575613943894435 + }, + { + "observation_id": "186303c1-e109-4249-bdab-a072d5165938", + "type": "aruco", + "marker_id": 208, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 897.0, + 638.0 + ], + [ + 946.0, + 641.0 + ], + [ + 949.0, + 662.0 + ], + [ + 898.0, + 660.0 + ] + ], + "center_px": [ + 922.5, + 650.25 + ], + "quality": { + "area_px": 1070.0, + "perimeter_px": 143.36686897277832, + "sharpness": { + "laplacian_var": 1945.561653540971 + }, + "contrast": { + "p05": 11.0, + "p95": 148.0, + "dynamic_range": 137.0, + "mean_gray": 56.28401585204755, + "std_gray": 57.254304627721886 + }, + "geometry": { + "distance_to_center_norm": 0.5515881180763245, + "distance_to_border_px": 58.0 + }, + "edge_ratio": 2.4060109543143446, + "edge_lengths_px": [ + 49.09175109863281, + 21.21320343017578, + 51.03919982910156, + 22.022714614868164 + ] + }, + "confidence": 0.2964796698261984 + }, + { + "observation_id": "54bff19a-c7ba-45a6-9061-82c2ae57faba", + "type": "aruco", + "marker_id": 198, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 533.0, + 431.0 + ], + [ + 579.0, + 432.0 + ], + [ + 573.0, + 449.0 + ], + [ + 525.0, + 447.0 + ] + ], + "center_px": [ + 552.5, + 439.75 + ], + "quality": { + "area_px": 786.0, + "perimeter_px": 129.96881675720215, + "sharpness": { + "laplacian_var": 4121.009546205313 + }, + "contrast": { + "p05": 16.0, + "p95": 176.0, + "dynamic_range": 160.0, + "mean_gray": 85.25925925925925, + "std_gray": 67.741401751572 + }, + "geometry": { + "distance_to_center_norm": 0.16122855246067047, + "distance_to_border_px": 271.0 + }, + "edge_ratio": 2.685609775888021, + "edge_lengths_px": [ + 46.010868072509766, + 18.027755737304688, + 48.041648864746094, + 17.8885440826416 + ] + }, + "confidence": 0.19511397549434922 + }, + { + "observation_id": "7bf2578f-91ac-419d-9f9a-630811095473", + "type": "aruco", + "marker_id": 214, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 893.0, + 574.0 + ], + [ + 937.0, + 575.0 + ], + [ + 940.0, + 594.0 + ], + [ + 895.0, + 592.0 + ] + ], + "center_px": [ + 916.25, + 583.75 + ], + "quality": { + "area_px": 819.5, + "perimeter_px": 126.40194129943848, + "sharpness": { + "laplacian_var": 1407.9392169119062 + }, + "contrast": { + "p05": 13.0, + "p95": 141.0, + "dynamic_range": 128.0, + "mean_gray": 73.60240963855422, + "std_gray": 54.60058627645282 + }, + "geometry": { + "distance_to_center_norm": 0.4841289222240448, + "distance_to_border_px": 126.0 + }, + "edge_ratio": 2.4871620155740866, + "edge_lengths_px": [ + 44.0113639831543, + 19.235383987426758, + 45.0444221496582, + 18.11077117919922 + ] + }, + "confidence": 0.21966133686197709 + }, + { + "observation_id": "4fe75475-1716-4a47-85be-fd9d39f9a686", + "type": "aruco", + "marker_id": 210, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 299.0, + 554.0 + ], + [ + 341.0, + 556.0 + ], + [ + 330.0, + 573.0 + ], + [ + 287.0, + 571.0 + ] + ], + "center_px": [ + 314.25, + 563.5 + ], + "quality": { + "area_px": 745.5, + "perimeter_px": 126.15118789672852, + "sharpness": { + "laplacian_var": 2619.1431811325074 + }, + "contrast": { + "p05": 23.0, + "p95": 179.0, + "dynamic_range": 156.0, + "mean_gray": 84.32402234636872, + "std_gray": 62.95385114915324 + }, + "geometry": { + "distance_to_center_norm": 0.5230682492256165, + "distance_to_border_px": 147.0 + }, + "edge_ratio": 2.1259143843226416, + "edge_lengths_px": [ + 42.04759216308594, + 20.248456954956055, + 43.046485900878906, + 20.808652877807617 + ] + }, + "confidence": 0.233781757000696 + }, + { + "observation_id": "5ab063ba-f2ba-41d3-b606-0f448b87b99d", + "type": "aruco", + "marker_id": 53, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 1098.0, + 497.0 + ], + [ + 1092.0, + 484.0 + ], + [ + 1128.0, + 485.0 + ], + [ + 1134.0, + 498.0 + ] + ], + "center_px": [ + 1113.0, + 491.0 + ], + "quality": { + "area_px": 462.0, + "perimeter_px": 100.66341400146484, + "sharpness": { + "laplacian_var": 1488.2588345357046 + }, + "contrast": { + "p05": 19.0, + "p95": 155.0, + "dynamic_range": 136.0, + "mean_gray": 103.74844720496894, + "std_gray": 46.97814425838358 + }, + "geometry": { + "distance_to_center_norm": 0.6683969497680664, + "distance_to_border_px": 146.0 + }, + "edge_ratio": 2.515318792826958, + "edge_lengths_px": [ + 14.317821502685547, + 36.013885498046875, + 14.317821502685547, + 36.013885498046875 + ] + }, + "confidence": 0.12244968744253681 + } + ], + "rejected_candidates": [ + { + "image_points_px": [ + [ + 632.0, + 427.0 + ], + [ + 626.0, + 498.0 + ], + [ + 614.0, + 502.0 + ], + [ + 613.0, + 484.0 + ] + ], + "center_px": [ + 621.25, + 477.75 + ], + "area_px": 613.5 + }, + { + "image_points_px": [ + [ + 1228.0, + 489.0 + ], + [ + 1265.0, + 491.0 + ], + [ + 1273.0, + 504.0 + ], + [ + 1235.0, + 502.0 + ] + ], + "center_px": [ + 1250.25, + 496.5 + ], + "area_px": 472.5 + }, + { + "image_points_px": [ + [ + 1025.0, + 491.0 + ], + [ + 1062.0, + 493.0 + ], + [ + 1066.0, + 505.0 + ], + [ + 1028.0, + 504.0 + ] + ], + "center_px": [ + 1045.25, + 498.25 + ], + "area_px": 463.5 + }, + { + "image_points_px": [ + [ + 1137.0, + 457.0 + ], + [ + 1172.0, + 459.0 + ], + [ + 1177.0, + 470.0 + ], + [ + 1142.0, + 469.0 + ] + ], + "center_px": [ + 1157.0, + 463.75 + ], + "area_px": 395.0 + }, + { + "image_points_px": [ + [ + 967.0, + 455.0 + ], + [ + 1001.0, + 456.0 + ], + [ + 1004.0, + 468.0 + ], + [ + 970.0, + 467.0 + ] + ], + "center_px": [ + 985.5, + 461.5 + ], + "area_px": 405.0 + }, + { + "image_points_px": [ + [ + 1119.0, + 516.0 + ], + [ + 1141.0, + 511.0 + ], + [ + 1164.0, + 518.0 + ], + [ + 1129.0, + 520.0 + ] + ], + "center_px": [ + 1138.25, + 516.25 + ], + "area_px": 214.5 + }, + { + "image_points_px": [ + [ + 1202.0, + 436.0 + ], + [ + 1234.0, + 437.0 + ], + [ + 1241.0, + 448.0 + ], + [ + 1207.0, + 447.0 + ] + ], + "center_px": [ + 1221.0, + 442.0 + ], + "area_px": 357.0 + }, + { + "image_points_px": [ + [ + 1004.0, + 444.0 + ], + [ + 1037.0, + 445.0 + ], + [ + 1041.0, + 456.0 + ], + [ + 1006.0, + 455.0 + ] + ], + "center_px": [ + 1022.0, + 450.0 + ], + "area_px": 371.0 + }, + { + "image_points_px": [ + [ + 901.0, + 436.0 + ], + [ + 933.0, + 437.0 + ], + [ + 935.0, + 448.0 + ], + [ + 901.0, + 447.0 + ] + ], + "center_px": [ + 917.5, + 442.0 + ], + "area_px": 362.0 + }, + { + "image_points_px": [ + [ + 678.0, + 191.0 + ], + [ + 699.0, + 191.0 + ], + [ + 701.0, + 209.0 + ], + [ + 679.0, + 207.0 + ] + ], + "center_px": [ + 689.25, + 199.5 + ], + "area_px": 364.0 + }, + { + "image_points_px": [ + [ + 663.0, + 211.0 + ], + [ + 682.0, + 212.0 + ], + [ + 682.0, + 223.0 + ], + [ + 663.0, + 222.0 + ] + ], + "center_px": [ + 672.5, + 217.0 + ], + "area_px": 209.0 + }, + { + "image_points_px": [ + [ + 542.0, + 601.0 + ], + [ + 565.0, + 601.0 + ], + [ + 569.0, + 603.0 + ], + [ + 544.0, + 603.0 + ] + ], + "center_px": [ + 555.0, + 602.0 + ], + "area_px": 48.0 + }, + { + "image_points_px": [ + [ + 1168.0, + 481.0 + ], + [ + 1144.0, + 482.0 + ], + [ + 1142.0, + 480.0 + ], + [ + 1161.0, + 479.0 + ] + ], + "center_px": [ + 1153.75, + 480.5 + ], + "area_px": 47.5 + }, + { + "image_points_px": [ + [ + 543.0, + 610.0 + ], + [ + 563.0, + 610.0 + ], + [ + 568.0, + 612.0 + ], + [ + 544.0, + 613.0 + ] + ], + "center_px": [ + 554.5, + 611.25 + ], + "area_px": 56.5 + }, + { + "image_points_px": [ + [ + 663.0, + 191.0 + ], + [ + 674.0, + 192.0 + ], + [ + 673.0, + 204.0 + ], + [ + 663.0, + 202.0 + ] + ], + "center_px": [ + 668.25, + 197.25 + ], + "area_px": 121.5 + }, + { + "image_points_px": [ + [ + 606.0, + 622.0 + ], + [ + 616.0, + 622.0 + ], + [ + 618.0, + 631.0 + ], + [ + 607.0, + 632.0 + ] + ], + "center_px": [ + 611.75, + 626.75 + ], + "area_px": 100.5 + }, + { + "image_points_px": [ + [ + 310.0, + 569.0 + ], + [ + 313.0, + 565.0 + ], + [ + 328.0, + 567.0 + ], + [ + 324.0, + 571.0 + ] + ], + "center_px": [ + 318.75, + 568.0 + ], + "area_px": 65.0 + } + ] +} \ No newline at end of file diff --git a/data/evaluations/Scene8/render_c_camera_pose.json b/data/evaluations/Scene8/render_c_camera_pose.json new file mode 100644 index 0000000..0935308 --- /dev/null +++ b/data/evaluations/Scene8/render_c_camera_pose.json @@ -0,0 +1,257 @@ +{ + "schema_version": "1.0", + "created_utc": "2026-06-01T18:36:47Z", + "source": { + "detection_json": "C:\\Users\\kech\\SynologyDrive\\2026-AppServer-AppRobot\\appRobotRendering\\data\\evaluations\\Scene8\\render_c_aruco_detection.json", + "robot_json": "C:\\Users\\kech\\SynologyDrive\\2026-AppServer-AppRobot\\appRobotRendering\\data\\robot\\robot.json" + }, + "camera": { + "camera_id": "c", + "camera_matrix": [ + [ + 1777.77783203125, + 0.0, + 640.0 + ], + [ + 0.0, + 1777.77783203125, + 360.0 + ], + [ + 0.0, + 0.0, + 1.0 + ] + ], + "distortion_coefficients": [ + 0.0, + 0.0, + 0.0, + 0.0, + 0.0 + ] + }, + "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": 4, + "used_marker_ids": [ + 208, + 214, + 210, + 53 + ], + "history": { + "iters": [ + 0, + 1, + 2, + 3 + ], + "rms": [ + 0.00815907053784058, + 0.00038889026461633554, + 8.059741566258575e-05, + 8.057603531058918e-05 + ], + "lambda": [ + 0.001, + 0.0005, + 0.00025, + 0.000125 + ] + }, + "residual_rms_px": 0.20259041142176823, + "residual_median_px": 0.15068860335028333, + "residual_max_px": 0.3306448827815234, + "sigma2_normalized": 2.5969989343700774e-08 + }, + "camera_pose": { + "world_to_camera": { + "rotation_matrix": [ + [ + 0.993758499622345, + 0.1115521565079689, + -0.00043949359678663313 + ], + [ + 0.03268022835254669, + -0.2948930859565735, + -0.9549712538719177 + ], + [ + -0.1066587045788765, + 0.9489964246749878, + -0.29669803380966187 + ] + ], + "translation_m": [ + -0.1977902352809906, + 0.10628540813922882, + 1.004310965538025 + ], + "rvec_rad": [ + 1.8698444553315385, + 0.1043155347711448, + -0.07745837314462278 + ] + }, + "camera_in_world": { + "position_m": [ + 0.30020081996917725, + -0.8996807336807251, + 0.39938968420028687 + ], + "position_mm": [ + 300.2008056640625, + -899.6807250976562, + 399.3896789550781 + ], + "orientation_deg": { + "roll": 107.36153411865234, + "pitch": 6.122739791870117, + "yaw": 1.8835203647613525 + } + }, + "uncertainty": { + "pose_covariance_6x6": [ + [ + 8.246326043381866e-07, + 1.2959856028252544e-07, + 1.9490143121569102e-07, + 9.573930417634736e-09, + -5.2672319999591544e-08, + 5.321782151119725e-08 + ], + [ + 1.295985602825249e-07, + 3.532319095277726e-07, + -1.0692949930590009e-07, + 5.005679212475838e-09, + -5.3080608967819447e-08, + 9.967726495155003e-08 + ], + [ + 1.9490143121568835e-07, + -1.0692949930589784e-07, + 7.262839896596602e-07, + 1.9345880069809947e-09, + -9.100117867657551e-08, + -1.834612034473196e-07 + ], + [ + 9.57393041763478e-09, + 5.005679212475731e-09, + 1.9345880069806957e-09, + 8.309753146754929e-09, + 1.344349962827341e-09, + 2.2053170650725068e-08 + ], + [ + -5.2672319999591e-08, + -5.308060896781994e-08, + -9.100117867657526e-08, + 1.344349962827285e-09, + 3.4310938619868394e-08, + 3.7279011506444744e-08 + ], + [ + 5.3217821511198174e-08, + 9.967726495154872e-08, + -1.8346120344732167e-07, + 2.2053170650725124e-08, + 3.727901150644531e-08, + 2.94676495254624e-07 + ] + ], + "parameter_std": { + "rvec_std_deg": [ + 0.05202988708375333, + 0.03405278190727662, + 0.048828779353641404 + ], + "tvec_std_m": [ + 9.11578474227805e-05, + 0.00018523212091823706, + 0.0005428411326112126 + ] + }, + "camera_center_std_m": [ + 0.0007788493900434405, + 0.0005268799492092695, + 0.0008621405191751387 + ], + "camera_center_std_mm": [ + 0.7788493900434406, + 0.5268799492092695, + 0.8621405191751387 + ], + "orientation_std_deg": { + "roll": 0.05852006383811758, + "pitch": 0.041075651933117956, + "yaw": 0.03201289781064694 + } + } + }, + "observations": { + "markers": [ + { + "marker_id": 208, + "observed_center_px": [ + 922.5, + 650.25 + ], + "projected_center_px": [ + 922.323486328125, + 650.3744506835938 + ], + "reprojection_error_px": 0.21597464898859506, + "confidence": 0.2964796698261984 + }, + { + "marker_id": 214, + "observed_center_px": [ + 916.25, + 583.75 + ], + "projected_center_px": [ + 916.5070190429688, + 583.5419921875 + ], + "reprojection_error_px": 0.3306448827815234, + "confidence": 0.21966133686197709 + }, + { + "marker_id": 210, + "observed_center_px": [ + 314.25, + 563.5 + ], + "projected_center_px": [ + 314.2375183105469, + 563.5274047851562 + ], + "reprojection_error_px": 0.030113366152997114, + "confidence": 0.233781757000696 + }, + { + "marker_id": 53, + "observed_center_px": [ + 1113.0, + 491.0 + ], + "projected_center_px": [ + 1112.935546875, + 491.0560302734375 + ], + "reprojection_error_px": 0.08540255771197162, + "confidence": 0.12244968744253681 + } + ] + }, + "qa": { + "sanity_notes": [] + } +} \ No newline at end of file diff --git a/data/evaluations/Scene8/render_c_camera_pose_v8.json b/data/evaluations/Scene8/render_c_camera_pose_v8.json new file mode 100644 index 0000000..ef51c2a --- /dev/null +++ b/data/evaluations/Scene8/render_c_camera_pose_v8.json @@ -0,0 +1,258 @@ +{ + "schema_version": "1.0", + "created_utc": "2026-06-01T18:37:02Z", + "source": { + "detection_json": "C:\\Users\\kech\\SynologyDrive\\2026-AppServer-AppRobot\\appRobotRendering\\data\\evaluations\\Scene8\\render_c_aruco_detection.json", + "robot_json": "C:\\Users\\kech\\SynologyDrive\\2026-AppServer-AppRobot\\appRobotRendering\\data\\robot\\robot.json" + }, + "camera": { + "camera_id": "c", + "camera_matrix": [ + [ + 1777.77783203125, + 0.0, + 640.0 + ], + [ + 0.0, + 1777.77783203125, + 360.0 + ], + [ + 0.0, + 0.0, + 1.0 + ] + ], + "distortion_coefficients": [ + 0.0, + 0.0, + 0.0, + 0.0, + 0.0 + ] + }, + "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": 4, + "used_marker_ids": [ + 208, + 214, + 210, + 53 + ], + "history": { + "iters": [ + 0, + 1, + 2, + 3 + ], + "rms": [ + 0.00815907053784058, + 0.00038889026461633554, + 8.059741566258575e-05, + 8.057603531058918e-05 + ], + "lambda": [ + 0.001, + 0.0005, + 0.00025, + 0.000125 + ] + }, + "residual_rms_px": 0.20259041142176823, + "residual_median_px": 0.15068860335028333, + "residual_max_px": 0.3306448827815234, + "sigma2_normalized": 2.5969989343700774e-08 + }, + "camera_pose": { + "world_to_camera": { + "rotation_matrix": [ + [ + 0.993758499622345, + 0.1115521565079689, + -0.00043949359678663313 + ], + [ + 0.03268022835254669, + -0.2948930859565735, + -0.9549712538719177 + ], + [ + -0.1066587045788765, + 0.9489964246749878, + -0.29669803380966187 + ] + ], + "translation_m": [ + -0.19778534026135564, + 0.11693516707732445, + 1.007619737138201 + ], + "rvec_rad": [ + 1.8698444553315385, + 0.1043155347711448, + -0.07745837314462278 + ] + }, + "camera_in_world": { + "position_m": [ + 0.3002008026229006, + -0.8996807562773264, + 0.41054160621426034 + ], + "position_mm": [ + 300.2008026229006, + -899.6807562773264, + 410.54160621426036 + ], + "orientation_deg": { + "roll": 107.36153411865234, + "pitch": 6.122739791870117, + "yaw": 1.8835203647613525 + } + }, + "uncertainty": { + "pose_covariance_6x6": [ + [ + 8.246326043381866e-07, + 1.2959856028252544e-07, + 1.9490143121569102e-07, + 9.573930417634736e-09, + -5.2672319999591544e-08, + 5.321782151119725e-08 + ], + [ + 1.295985602825249e-07, + 3.532319095277726e-07, + -1.0692949930590009e-07, + 5.005679212475838e-09, + -5.3080608967819447e-08, + 9.967726495155003e-08 + ], + [ + 1.9490143121568835e-07, + -1.0692949930589784e-07, + 7.262839896596602e-07, + 1.9345880069809947e-09, + -9.100117867657551e-08, + -1.834612034473196e-07 + ], + [ + 9.57393041763478e-09, + 5.005679212475731e-09, + 1.9345880069806957e-09, + 8.309753146754929e-09, + 1.344349962827341e-09, + 2.2053170650725068e-08 + ], + [ + -5.2672319999591e-08, + -5.308060896781994e-08, + -9.100117867657526e-08, + 1.344349962827285e-09, + 3.4310938619868394e-08, + 3.7279011506444744e-08 + ], + [ + 5.3217821511198174e-08, + 9.967726495154872e-08, + -1.8346120344732167e-07, + 2.2053170650725124e-08, + 3.727901150644531e-08, + 2.94676495254624e-07 + ] + ], + "parameter_std": { + "rvec_std_deg": [ + 0.05202988708375333, + 0.03405278190727662, + 0.048828779353641404 + ], + "tvec_std_m": [ + 9.11578474227805e-05, + 0.00018523212091823706, + 0.0005428411326112126 + ] + }, + "camera_center_std_m": [ + 0.0007788493900434405, + 0.0005268799492092695, + 0.0008621405191751387 + ], + "camera_center_std_mm": [ + 0.7788493900434406, + 0.5268799492092695, + 0.8621405191751387 + ], + "orientation_std_deg": { + "roll": 0.05852006383811758, + "pitch": 0.041075651933117956, + "yaw": 0.03201289781064694 + } + } + }, + "observations": { + "markers": [ + { + "marker_id": 208, + "observed_center_px": [ + 922.5, + 650.25 + ], + "projected_center_px": [ + 922.323486328125, + 650.3744506835938 + ], + "reprojection_error_px": 0.21597464898859506, + "confidence": 0.2964796698261984 + }, + { + "marker_id": 214, + "observed_center_px": [ + 916.25, + 583.75 + ], + "projected_center_px": [ + 916.5070190429688, + 583.5419921875 + ], + "reprojection_error_px": 0.3306448827815234, + "confidence": 0.21966133686197709 + }, + { + "marker_id": 210, + "observed_center_px": [ + 314.25, + 563.5 + ], + "projected_center_px": [ + 314.2375183105469, + 563.5274047851562 + ], + "reprojection_error_px": 0.030113366152997114, + "confidence": 0.233781757000696 + }, + { + "marker_id": 53, + "observed_center_px": [ + 1113.0, + 491.0 + ], + "projected_center_px": [ + 1112.935546875, + 491.0560302734375 + ], + "reprojection_error_px": 0.08540255771197162, + "confidence": 0.12244968744253681 + } + ] + }, + "qa": { + "sanity_notes": [] + }, + "v8_z_correction_mm": 11.151935468550299 +} \ No newline at end of file diff --git a/data/evaluations/Scene8/render_d_aruco_detection.json b/data/evaluations/Scene8/render_d_aruco_detection.json new file mode 100644 index 0000000..f5aa36a --- /dev/null +++ b/data/evaluations/Scene8/render_d_aruco_detection.json @@ -0,0 +1,1531 @@ +{ + "schema_version": "1.0", + "created_utc": "2026-06-01T18:36:43Z", + "vision_config": { + "MarkerType": "DICT_4X4_250", + "MarkerSize": 0.025 + }, + "camera": { + "camera_id": "d", + "intrinsics_file": "C:\\Users\\kech\\SynologyDrive\\2026-AppServer-AppRobot\\appRobotRendering\\data\\simulation\\Scene8\\render_a.npz", + "camera_matrix": [ + [ + 1777.77783203125, + 0.0, + 640.0 + ], + [ + 0.0, + 1777.77783203125, + 360.0 + ], + [ + 0.0, + 0.0, + 1.0 + ] + ], + "distortion_coefficients": [ + 0.0, + 0.0, + 0.0, + 0.0, + 0.0 + ] + }, + "image": { + "image_file": "C:\\Users\\kech\\SynologyDrive\\2026-AppServer-AppRobot\\appRobotRendering\\data\\simulation\\Scene8\\render_d.png", + "image_sha256": "40614afc050025adf9fcf073301aa7482991042b18a0acec12a97b2e578382e4", + "width_px": 1280, + "height_px": 720 + }, + "aruco": { + "dictionary": "DICT_4X4_250", + "num_detected_markers": 20, + "num_rejected_candidates": 16 + }, + "detections": [ + { + "observation_id": "30bc132e-b8b3-42e7-bfc3-9a14e5075efe", + "type": "aruco", + "marker_id": 44, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 614.0, + 114.0 + ], + [ + 610.0, + 57.0 + ], + [ + 666.0, + 52.0 + ], + [ + 670.0, + 109.0 + ] + ], + "center_px": [ + 640.0, + 83.0 + ], + "quality": { + "area_px": 3212.0, + "perimeter_px": 226.72589874267578, + "sharpness": { + "laplacian_var": 672.3693413304218 + }, + "contrast": { + "p05": 22.0, + "p95": 168.0, + "dynamic_range": 146.0, + "mean_gray": 68.24347413383958, + "std_gray": 59.014948665600684 + }, + "geometry": { + "distance_to_center_norm": 0.3772287964820862, + "distance_to_border_px": 52.0 + }, + "edge_ratio": 1.0163173742280571, + "edge_lengths_px": [ + 57.14017868041992, + 56.22277069091797, + 57.14017868041992, + 56.22277069091797 + ] + }, + "confidence": 0.9839446076178212 + }, + { + "observation_id": "f612cd06-6107-450c-8187-edcc8078b992", + "type": "aruco", + "marker_id": 114, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 734.0, + 252.0 + ], + [ + 687.0, + 258.0 + ], + [ + 689.0, + 199.0 + ], + [ + 736.0, + 198.0 + ] + ], + "center_px": [ + 711.5, + 226.75 + ], + "quality": { + "area_px": 2648.5, + "perimeter_px": 207.46298217773438, + "sharpness": { + "laplacian_var": 277.79364543138695 + }, + "contrast": { + "p05": 5.0, + "p95": 95.0, + "dynamic_range": 90.0, + "mean_gray": 28.687360178970916, + "std_gray": 36.16416578900708 + }, + "geometry": { + "distance_to_center_norm": 0.2059384137392044, + "distance_to_border_px": 198.0 + }, + "edge_ratio": 1.255756049633726, + "edge_lengths_px": [ + 47.381431579589844, + 59.03388977050781, + 47.01063537597656, + 54.037025451660156 + ] + }, + "confidence": 0.7963330141166162 + }, + { + "observation_id": "413ff2a4-ecf3-42ae-bb9b-a83132f3cbc5", + "type": "aruco", + "marker_id": 120, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 727.0, + 402.0 + ], + [ + 681.0, + 410.0 + ], + [ + 683.0, + 355.0 + ], + [ + 729.0, + 351.0 + ] + ], + "center_px": [ + 705.0, + 379.5 + ], + "quality": { + "area_px": 2426.0, + "perimeter_px": 198.93960571289062, + "sharpness": { + "laplacian_var": 318.88235326724623 + }, + "contrast": { + "p05": 7.0, + "p95": 98.0, + "dynamic_range": 91.0, + "mean_gray": 27.909422492401216, + "std_gray": 34.54851224655961 + }, + "geometry": { + "distance_to_center_norm": 0.09241695702075958, + "distance_to_border_px": 310.0 + }, + "edge_ratio": 1.19194451677973, + "edge_lengths_px": [ + 46.69047164916992, + 55.03635025024414, + 46.173583984375, + 51.03919982910156 + ] + }, + "confidence": 0.8389652252452946 + }, + { + "observation_id": "8ba0f302-4317-4c7b-8b3f-9c36982eddb3", + "type": "aruco", + "marker_id": 245, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 637.0, + 589.0 + ], + [ + 635.0, + 638.0 + ], + [ + 594.0, + 625.0 + ], + [ + 595.0, + 577.0 + ] + ], + "center_px": [ + 615.25, + 607.25 + ], + "quality": { + "area_px": 2031.5, + "perimeter_px": 183.74349975585938, + "sharpness": { + "laplacian_var": 1813.1599134495677 + }, + "contrast": { + "p05": 28.0, + "p95": 178.0, + "dynamic_range": 150.0, + "mean_gray": 86.24685883222469, + "std_gray": 68.75734482918982 + }, + "geometry": { + "distance_to_center_norm": 0.33839690685272217, + "distance_to_border_px": 82.0 + }, + "edge_ratio": 1.1401753754243813, + "edge_lengths_px": [ + 49.04079818725586, + 43.011627197265625, + 48.010414123535156, + 43.680660247802734 + ] + }, + "confidence": 0.8770580575183822 + }, + { + "observation_id": "aacbde33-1900-40a7-bf41-a9891d984814", + "type": "aruco", + "marker_id": 248, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 573.0, + 571.0 + ], + [ + 571.0, + 618.0 + ], + [ + 531.0, + 606.0 + ], + [ + 532.0, + 559.0 + ] + ], + "center_px": [ + 551.75, + 588.5 + ], + "quality": { + "area_px": 1921.5, + "perimeter_px": 178.53441619873047, + "sharpness": { + "laplacian_var": 2283.605085409441 + }, + "contrast": { + "p05": 28.0, + "p95": 179.0, + "dynamic_range": 151.0, + "mean_gray": 91.78871090770404, + "std_gray": 68.93421217824806 + }, + "geometry": { + "distance_to_center_norm": 0.33358141779899597, + "distance_to_border_px": 102.0 + }, + "edge_ratio": 1.1264643700293813, + "edge_lengths_px": [ + 47.04253387451172, + 41.761226654052734, + 47.01063537597656, + 42.72002029418945 + ] + }, + "confidence": 0.8877333598877319 + }, + { + "observation_id": "d7a5f4f7-85c4-46ae-8aa1-513da06e96c1", + "type": "aruco", + "marker_id": 243, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 449.0, + 542.0 + ], + [ + 486.0, + 553.0 + ], + [ + 488.0, + 598.0 + ], + [ + 451.0, + 587.0 + ] + ], + "center_px": [ + 468.5, + 570.0 + ], + "quality": { + "area_px": 1643.0, + "perimeter_px": 167.28987884521484, + "sharpness": { + "laplacian_var": 1782.9942907890404 + }, + "contrast": { + "p05": 28.0, + "p95": 177.0, + "dynamic_range": 149.0, + "mean_gray": 77.27851458885942, + "std_gray": 65.31823253305183 + }, + "geometry": { + "distance_to_center_norm": 0.3692367672920227, + "distance_to_border_px": 122.0 + }, + "edge_ratio": 1.1669383037316134, + "edge_lengths_px": [ + 38.60051727294922, + 45.0444221496582, + 38.60051727294922, + 45.0444221496582 + ] + }, + "confidence": 0.8569433335097655 + }, + { + "observation_id": "4bac4cd0-8bf8-4b36-bc75-26b2f2fd00f2", + "type": "aruco", + "marker_id": 40, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 724.0, + 57.0 + ], + [ + 673.0, + 41.0 + ], + [ + 662.0, + 14.0 + ], + [ + 714.0, + 31.0 + ] + ], + "center_px": [ + 693.25, + 35.75 + ], + "quality": { + "area_px": 1191.5, + "perimeter_px": 165.17076683044434, + "sharpness": { + "laplacian_var": 733.7701895510601 + }, + "contrast": { + "p05": 25.0, + "p95": 126.0, + "dynamic_range": 101.0, + "mean_gray": 59.35162094763092, + "std_gray": 37.98770707602297 + }, + "geometry": { + "distance_to_center_norm": 0.4474906027317047, + "distance_to_border_px": 14.0 + }, + "edge_ratio": 1.963914074752889, + "edge_lengths_px": [ + 53.45091247558594, + 29.154760360717773, + 54.708316802978516, + 27.85677719116211 + ] + }, + "confidence": 0.11325003277514506 + }, + { + "observation_id": "e26f3a86-0b7e-4191-90bf-5379e4ba9a29", + "type": "aruco", + "marker_id": 244, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 732.0, + 619.0 + ], + [ + 704.0, + 636.0 + ], + [ + 706.0, + 586.0 + ], + [ + 734.0, + 572.0 + ] + ], + "center_px": [ + 719.0, + 603.25 + ], + "quality": { + "area_px": 1327.0, + "perimeter_px": 161.14415168762207, + "sharpness": { + "laplacian_var": 537.2327979712595 + }, + "contrast": { + "p05": 15.0, + "p95": 89.0, + "dynamic_range": 74.0, + "mean_gray": 47.19340659340659, + "std_gray": 32.79419608995363 + }, + "geometry": { + "distance_to_center_norm": 0.3482990860939026, + "distance_to_border_px": 84.0 + }, + "edge_ratio": 1.5984686596342332, + "edge_lengths_px": [ + 32.75667953491211, + 50.03998565673828, + 31.30495262145996, + 47.04253387451172 + ] + }, + "confidence": 0.5119378861352945 + }, + { + "observation_id": "a9909f7a-407c-464f-afbf-eb4c6d6dff91", + "type": "aruco", + "marker_id": 115, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 616.0, + 250.0 + ], + [ + 590.0, + 241.0 + ], + [ + 591.0, + 189.0 + ], + [ + 617.0, + 196.0 + ] + ], + "center_px": [ + 603.5, + 219.0 + ], + "quality": { + "area_px": 1386.0, + "perimeter_px": 160.4583282470703, + "sharpness": { + "laplacian_var": 1684.1052880711109 + }, + "contrast": { + "p05": 30.0, + "p95": 188.0, + "dynamic_range": 158.0, + "mean_gray": 63.67542016806723, + "std_gray": 57.99986149679142 + }, + "geometry": { + "distance_to_center_norm": 0.19834838807582855, + "distance_to_border_px": 189.0 + }, + "edge_ratio": 2.0058535572221805, + "edge_lengths_px": [ + 27.513633728027344, + 52.009613037109375, + 26.925823211669922, + 54.00925827026367 + ] + }, + "confidence": 0.46065177423999365 + }, + { + "observation_id": "51ea8b58-6383-4ec7-8e6c-f69396bd02e4", + "type": "aruco", + "marker_id": 208, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 876.0, + 681.0 + ], + [ + 921.0, + 694.0 + ], + [ + 900.0, + 712.0 + ], + [ + 853.0, + 699.0 + ] + ], + "center_px": [ + 887.5, + 696.5 + ], + "quality": { + "area_px": 1114.0, + "perimeter_px": 152.46969032287598, + "sharpness": { + "laplacian_var": 2260.8677058023773 + }, + "contrast": { + "p05": 11.0, + "p95": 149.0, + "dynamic_range": 138.0, + "mean_gray": 58.7205298013245, + "std_gray": 58.07394272442995 + }, + "geometry": { + "distance_to_center_norm": 0.5688640475273132, + "distance_to_border_px": 8.0 + }, + "edge_ratio": 1.7630928433655677, + "edge_lengths_px": [ + 46.840152740478516, + 27.658634185791016, + 48.764739990234375, + 29.20616340637207 + ] + }, + "confidence": 0.06739671544456982 + }, + { + "observation_id": "56b00359-dbda-412e-ab87-2d21fbafe667", + "type": "aruco", + "marker_id": 232, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 593.0, + 632.0 + ], + [ + 637.0, + 645.0 + ], + [ + 657.0, + 667.0 + ], + [ + 615.0, + 654.0 + ] + ], + "center_px": [ + 625.5, + 649.5 + ], + "quality": { + "area_px": 673.0, + "perimeter_px": 150.691011428833, + "sharpness": { + "laplacian_var": 2893.398200183655 + }, + "contrast": { + "p05": 33.0, + "p95": 133.0, + "dynamic_range": 100.0, + "mean_gray": 77.35959595959596, + "std_gray": 40.065098338669486 + }, + "geometry": { + "distance_to_center_norm": 0.39474594593048096, + "distance_to_border_px": 53.0 + }, + "edge_ratio": 1.5431207817860724, + "edge_lengths_px": [ + 45.880279541015625, + 29.73213768005371, + 43.96589660644531, + 31.11269760131836 + ] + }, + "confidence": 0.29075278614766703 + }, + { + "observation_id": "c633d2f1-9897-4cb3-9967-3aa7b36fdb87", + "type": "aruco", + "marker_id": 103, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 347.0, + 694.0 + ], + [ + 378.0, + 677.0 + ], + [ + 412.0, + 688.0 + ], + [ + 381.0, + 706.0 + ] + ], + "center_px": [ + 379.5, + 691.25 + ], + "quality": { + "area_px": 951.5, + "perimeter_px": 142.9928855895996, + "sharpness": { + "laplacian_var": 3336.9716656203504 + }, + "contrast": { + "p05": 22.0, + "p95": 180.0, + "dynamic_range": 158.0, + "mean_gray": 112.91935483870968, + "std_gray": 69.37363841908291 + }, + "geometry": { + "distance_to_center_norm": 0.5738922953605652, + "distance_to_border_px": 14.0 + }, + "edge_ratio": 1.0198038667744187, + "edge_lengths_px": [ + 35.35533905029297, + 35.735137939453125, + 35.84689712524414, + 36.055511474609375 + ] + }, + "confidence": 0.17416420855033052 + }, + { + "observation_id": "2e84ec10-7db2-408a-9228-1c8eff30d038", + "type": "aruco", + "marker_id": 58, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 229.0, + 688.0 + ], + [ + 261.0, + 671.0 + ], + [ + 294.0, + 682.0 + ], + [ + 262.0, + 699.0 + ] + ], + "center_px": [ + 261.5, + 685.0 + ], + "quality": { + "area_px": 913.0, + "perimeter_px": 142.04078674316406, + "sharpness": { + "laplacian_var": 3799.086382523873 + }, + "contrast": { + "p05": 18.0, + "p95": 180.0, + "dynamic_range": 162.0, + "mean_gray": 77.17050691244239, + "std_gray": 69.61657192901008 + }, + "geometry": { + "distance_to_center_norm": 0.6794013381004333, + "distance_to_border_px": 21.0 + }, + "edge_ratio": 1.0416928171614068, + "edge_lengths_px": [ + 36.2353401184082, + 34.78505325317383, + 36.2353401184082, + 34.78505325317383 + ] + }, + "confidence": 0.24540823915500745 + }, + { + "observation_id": "26c337e1-fcce-47cd-be73-eaef7818d1db", + "type": "aruco", + "marker_id": 214, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 947.0, + 625.0 + ], + [ + 990.0, + 636.0 + ], + [ + 971.0, + 652.0 + ], + [ + 927.0, + 640.0 + ] + ], + "center_px": [ + 958.75, + 638.25 + ], + "quality": { + "area_px": 898.5, + "perimeter_px": 139.83118438720703, + "sharpness": { + "laplacian_var": 2241.940796279768 + }, + "contrast": { + "p05": 14.0, + "p95": 141.0, + "dynamic_range": 127.0, + "mean_gray": 76.14490445859873, + "std_gray": 54.15135390815647 + }, + "geometry": { + "distance_to_center_norm": 0.5762108564376831, + "distance_to_border_px": 68.0 + }, + "edge_ratio": 1.8360693552137273, + "edge_lengths_px": [ + 44.384681701660156, + 24.83948516845703, + 45.607017517089844, + 25.0 + ] + }, + "confidence": 0.32624039952470835 + }, + { + "observation_id": "6f518adb-007e-4c90-87ce-2f8e7c666f1e", + "type": "aruco", + "marker_id": 64, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 180.0, + 634.0 + ], + [ + 212.0, + 620.0 + ], + [ + 242.0, + 630.0 + ], + [ + 211.0, + 644.0 + ] + ], + "center_px": [ + 211.25, + 632.0 + ], + "quality": { + "area_px": 742.0, + "perimeter_px": 133.13896942138672, + "sharpness": { + "laplacian_var": 3229.7977698155155 + }, + "contrast": { + "p05": 18.0, + "p95": 180.0, + "dynamic_range": 162.0, + "mean_gray": 81.99806201550388, + "std_gray": 69.32332121632136 + }, + "geometry": { + "distance_to_center_norm": 0.6914733052253723, + "distance_to_border_px": 76.0 + }, + "edge_ratio": 1.1045360875233317, + "edge_lengths_px": [ + 34.928497314453125, + 31.62277603149414, + 34.01470184326172, + 32.572994232177734 + ] + }, + "confidence": 0.4478501628460533 + }, + { + "observation_id": "6515831d-07e4-45e6-9093-f8b4dce89ed6", + "type": "aruco", + "marker_id": 219, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 753.0, + 163.0 + ], + [ + 743.0, + 169.0 + ], + [ + 745.0, + 114.0 + ], + [ + 756.0, + 109.0 + ] + ], + "center_px": [ + 749.25, + 138.75 + ], + "quality": { + "area_px": 558.5, + "perimeter_px": 132.86457061767578, + "sharpness": { + "laplacian_var": 778.7129467128028 + }, + "contrast": { + "p05": 17.0, + "p95": 75.0, + "dynamic_range": 58.0, + "mean_gray": 37.868235294117646, + "std_gray": 21.748867241711185 + }, + "geometry": { + "distance_to_center_norm": 0.3360375463962555, + "distance_to_border_px": 109.0 + }, + "edge_ratio": 4.719328264910056, + "edge_lengths_px": [ + 11.661903381347656, + 55.03635025024414, + 12.083045959472656, + 54.08327102661133 + ] + }, + "confidence": 0.057199171473996085 + }, + { + "observation_id": "d14bbd9a-2cfa-4819-a77c-4466f080dc09", + "type": "aruco", + "marker_id": 211, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 783.0, + 582.0 + ], + [ + 822.0, + 591.0 + ], + [ + 801.0, + 606.0 + ], + [ + 762.0, + 595.0 + ] + ], + "center_px": [ + 792.0, + 593.5 + ], + "quality": { + "area_px": 756.0, + "perimeter_px": 131.0517463684082, + "sharpness": { + "laplacian_var": 1562.9580130270876 + }, + "contrast": { + "p05": 10.0, + "p95": 140.0, + "dynamic_range": 130.0, + "mean_gray": 61.47438330170778, + "std_gray": 54.49825309552671 + }, + "geometry": { + "distance_to_center_norm": 0.3794279992580414, + "distance_to_border_px": 114.0 + }, + "edge_ratio": 1.6406716277865756, + "edge_lengths_px": [ + 40.024993896484375, + 25.806976318359375, + 40.52159881591797, + 24.698177337646484 + ] + }, + "confidence": 0.3071912693949274 + }, + { + "observation_id": "f2eb8de1-980c-4468-b7d1-6b86809d5e61", + "type": "aruco", + "marker_id": 72, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 1223.0, + 599.0 + ], + [ + 1235.0, + 585.0 + ], + [ + 1275.0, + 594.0 + ], + [ + 1264.0, + 608.0 + ] + ], + "center_px": [ + 1249.25, + 596.5 + ], + "quality": { + "area_px": 670.5, + "perimeter_px": 119.21976661682129, + "sharpness": { + "laplacian_var": 2168.1462163377746 + }, + "contrast": { + "p05": 13.0, + "p95": 156.0, + "dynamic_range": 143.0, + "mean_gray": 59.45238095238095, + "std_gray": 57.283574483323555 + }, + "geometry": { + "distance_to_center_norm": 0.8900182247161865, + "distance_to_border_px": 5.0 + }, + "edge_ratio": 2.3576175385513936, + "edge_lengths_px": [ + 18.439088821411133, + 41.0, + 17.804492950439453, + 41.9761848449707 + ] + }, + "confidence": 0.018959818235601233 + }, + { + "observation_id": "7c28bd65-2ccf-44bd-ac35-ed5f15bb951a", + "type": "aruco", + "marker_id": 84, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 1201.0, + 551.0 + ], + [ + 1213.0, + 540.0 + ], + [ + 1251.0, + 548.0 + ], + [ + 1241.0, + 559.0 + ] + ], + "center_px": [ + 1226.5, + 549.5 + ], + "quality": { + "area_px": 517.0, + "perimeter_px": 110.77002239227295, + "sharpness": { + "laplacian_var": 2592.418124728733 + }, + "contrast": { + "p05": 14.0, + "p95": 156.0, + "dynamic_range": 142.0, + "mean_gray": 82.95572916666667, + "std_gray": 55.589460730069895 + }, + "geometry": { + "distance_to_center_norm": 0.8393738269805908, + "distance_to_border_px": 29.0 + }, + "edge_ratio": 2.7439773526172324, + "edge_lengths_px": [ + 16.278820037841797, + 38.832977294921875, + 14.866068840026855, + 40.79215621948242 + ] + }, + "confidence": 0.07285288505606423 + }, + { + "observation_id": "9aee7626-ad09-40b9-b758-6860486dafbe", + "type": "aruco", + "marker_id": 86, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 1151.0, + 520.0 + ], + [ + 1163.0, + 509.0 + ], + [ + 1198.0, + 517.0 + ], + [ + 1188.0, + 527.0 + ] + ], + "center_px": [ + 1175.0, + 518.25 + ], + "quality": { + "area_px": 460.5, + "perimeter_px": 103.97994232177734, + "sharpness": { + "laplacian_var": 3019.5732378808893 + }, + "contrast": { + "p05": 13.0, + "p95": 154.0, + "dynamic_range": 141.0, + "mean_gray": 80.78097982708934, + "std_gray": 54.937726193122394 + }, + "geometry": { + "distance_to_center_norm": 0.7597878575325012, + "distance_to_border_px": 82.0 + }, + "edge_ratio": 2.6627054473419296, + "edge_lengths_px": [ + 16.278820037841797, + 35.902645111083984, + 14.142135620117188, + 37.656341552734375 + ] + }, + "confidence": 0.1152962676763461 + } + ], + "rejected_candidates": [ + { + "image_points_px": [ + [ + 720.0, + 59.0 + ], + [ + 713.0, + 120.0 + ], + [ + 683.0, + 124.0 + ], + [ + 679.0, + 78.0 + ] + ], + "center_px": [ + 698.75, + 95.25 + ], + "area_px": 1882.0 + }, + { + "image_points_px": [ + [ + 629.0, + 261.0 + ], + [ + 660.0, + 268.0 + ], + [ + 655.0, + 307.0 + ], + [ + 625.0, + 303.0 + ] + ], + "center_px": [ + 642.25, + 284.75 + ], + "area_px": 1260.0 + }, + { + "image_points_px": [ + [ + 953.0, + 474.0 + ], + [ + 967.0, + 465.0 + ], + [ + 997.0, + 471.0 + ], + [ + 985.0, + 481.0 + ] + ], + "center_px": [ + 975.5, + 472.75 + ], + "area_px": 379.0 + }, + { + "image_points_px": [ + [ + 978.0, + 461.0 + ], + [ + 991.0, + 452.0 + ], + [ + 1021.0, + 459.0 + ], + [ + 1010.0, + 467.0 + ] + ], + "center_px": [ + 1000.0, + 459.75 + ], + "area_px": 341.5 + }, + { + "image_points_px": [ + [ + 827.0, + 446.0 + ], + [ + 842.0, + 438.0 + ], + [ + 869.0, + 444.0 + ], + [ + 856.0, + 453.0 + ] + ], + "center_px": [ + 848.5, + 445.25 + ], + "area_px": 329.0 + }, + { + "image_points_px": [ + [ + 770.0, + 414.0 + ], + [ + 783.0, + 407.0 + ], + [ + 810.0, + 412.0 + ], + [ + 798.0, + 421.0 + ] + ], + "center_px": [ + 790.25, + 413.5 + ], + "area_px": 295.0 + }, + { + "image_points_px": [ + [ + 741.0, + 349.0 + ], + [ + 743.0, + 374.0 + ], + [ + 739.0, + 386.0 + ], + [ + 736.0, + 375.0 + ] + ], + "center_px": [ + 739.75, + 371.0 + ], + "area_px": 128.5 + }, + { + "image_points_px": [ + [ + 615.0, + 509.0 + ], + [ + 623.0, + 515.0 + ], + [ + 620.0, + 542.0 + ], + [ + 612.0, + 538.0 + ] + ], + "center_px": [ + 617.5, + 526.0 + ], + "area_px": 239.0 + }, + { + "image_points_px": [ + [ + 749.0, + 120.0 + ], + [ + 752.0, + 139.0 + ], + [ + 750.0, + 157.0 + ], + [ + 746.0, + 131.0 + ] + ], + "center_px": [ + 749.25, + 136.75 + ], + "area_px": 107.0 + }, + { + "image_points_px": [ + [ + 714.0, + 370.0 + ], + [ + 713.0, + 380.0 + ], + [ + 689.0, + 381.0 + ], + [ + 690.0, + 371.0 + ] + ], + "center_px": [ + 701.5, + 375.5 + ], + "area_px": 239.0 + }, + { + "image_points_px": [ + [ + 688.0, + 367.0 + ], + [ + 690.0, + 359.0 + ], + [ + 709.0, + 359.0 + ], + [ + 707.0, + 365.0 + ] + ], + "center_px": [ + 698.5, + 362.5 + ], + "area_px": 131.0 + }, + { + "image_points_px": [ + [ + 664.0, + 526.0 + ], + [ + 672.0, + 527.0 + ], + [ + 672.0, + 541.0 + ], + [ + 664.0, + 542.0 + ] + ], + "center_px": [ + 668.0, + 534.0 + ], + "area_px": 120.0 + }, + { + "image_points_px": [ + [ + 639.0, + 625.0 + ], + [ + 643.0, + 636.0 + ], + [ + 642.0, + 646.0 + ], + [ + 639.0, + 639.0 + ] + ], + "center_px": [ + 640.75, + 636.5 + ], + "area_px": 46.5 + }, + { + "image_points_px": [ + [ + 594.0, + 215.0 + ], + [ + 604.0, + 219.0 + ], + [ + 603.0, + 229.0 + ], + [ + 593.0, + 225.0 + ] + ], + "center_px": [ + 598.5, + 222.0 + ], + "area_px": 104.0 + }, + { + "image_points_px": [ + [ + 363.0, + 528.0 + ], + [ + 382.0, + 530.0 + ], + [ + 375.0, + 533.0 + ], + [ + 370.0, + 533.0 + ] + ], + "center_px": [ + 372.5, + 531.0 + ], + "area_px": 48.0 + }, + { + "image_points_px": [ + [ + 1192.0, + 684.0 + ], + [ + 1194.0, + 683.0 + ], + [ + 1211.0, + 687.0 + ], + [ + 1202.0, + 687.0 + ] + ], + "center_px": [ + 1199.75, + 685.25 + ], + "area_px": 26.0 + } + ] +} \ No newline at end of file diff --git a/data/evaluations/Scene8/render_d_camera_pose.json b/data/evaluations/Scene8/render_d_camera_pose.json new file mode 100644 index 0000000..f65273e --- /dev/null +++ b/data/evaluations/Scene8/render_d_camera_pose.json @@ -0,0 +1,327 @@ +{ + "schema_version": "1.0", + "created_utc": "2026-06-01T18:36:48Z", + "source": { + "detection_json": "C:\\Users\\kech\\SynologyDrive\\2026-AppServer-AppRobot\\appRobotRendering\\data\\evaluations\\Scene8\\render_d_aruco_detection.json", + "robot_json": "C:\\Users\\kech\\SynologyDrive\\2026-AppServer-AppRobot\\appRobotRendering\\data\\robot\\robot.json" + }, + "camera": { + "camera_id": "d", + "camera_matrix": [ + [ + 1777.77783203125, + 0.0, + 640.0 + ], + [ + 0.0, + 1777.77783203125, + 360.0 + ], + [ + 0.0, + 0.0, + 1.0 + ] + ], + "distortion_coefficients": [ + 0.0, + 0.0, + 0.0, + 0.0, + 0.0 + ] + }, + "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": 9, + "used_marker_ids": [ + 208, + 103, + 58, + 214, + 64, + 211, + 72, + 84, + 86 + ], + "history": { + "iters": [ + 0, + 1, + 2, + 3 + ], + "rms": [ + 0.006333816581738461, + 0.0002773011027338013, + 0.00010662089465453542, + 0.00010661827813541825 + ], + "lambda": [ + 0.001, + 0.0005, + 0.00025, + 0.000125 + ] + }, + "residual_rms_px": 0.26803473514416426, + "residual_median_px": 0.23863200652285652, + "residual_max_px": 0.4319714965335605, + "sigma2_normalized": 1.705118584239489e-08 + }, + "camera_pose": { + "world_to_camera": { + "rotation_matrix": [ + [ + 0.8189369440078735, + 0.5738833546638489, + -0.0004457749892026186 + ], + [ + 0.16132032871246338, + -0.23095093667507172, + -0.9594985246658325 + ], + [ + -0.5507431626319885, + 0.7856968641281128, + -0.2817133069038391 + ] + ], + "translation_m": [ + -0.11497107893228531, + 0.08632615953683853, + 1.1260302066802979 + ], + "rvec_rad": [ + 1.7909599776987175, + 0.5647279566505399, + -0.42338173600008655 + ] + }, + "camera_in_world": { + "position_m": [ + 0.700381338596344, + -0.7988013029098511, + 0.399996280670166 + ], + "position_mm": [ + 700.38134765625, + -798.8013305664062, + 399.99627685546875 + ], + "orientation_deg": { + "roll": 109.72539520263672, + "pitch": 33.41801071166992, + "yaw": 11.14387035369873 + } + }, + "uncertainty": { + "pose_covariance_6x6": [ + [ + 2.852092030612513e-07, + 1.2324146194593454e-07, + 1.264823680030996e-07, + 4.270453715882081e-10, + -5.4504294706706134e-08, + -1.2152984007154248e-08 + ], + [ + 1.2324146194593555e-07, + 1.4531202385393299e-07, + -6.015151106190092e-09, + 1.2042222954696699e-08, + -2.833712756388377e-08, + 2.8730439663963055e-08 + ], + [ + 1.2648236800309913e-07, + -6.015151106190755e-09, + 2.52995940259767e-07, + -1.5169021186969528e-08, + -4.255829665011247e-08, + -7.174617911570197e-08 + ], + [ + 4.2704537158833995e-10, + 1.2042222954696763e-08, + -1.5169021186969502e-08, + 3.898596269933436e-09, + 7.43659570879186e-10, + 9.126450926756841e-09 + ], + [ + -5.4504294706706287e-08, + -2.8337127563883675e-08, + -4.25582966501126e-08, + 7.436595708792132e-10, + 1.636505724746816e-08, + 1.2574879808690192e-08 + ], + [ + -1.2152984007153812e-08, + 2.873043966396327e-08, + -7.174617911570175e-08, + 9.126450926756889e-09, + 1.25748798086901e-08, + 6.448855219127798e-08 + ] + ], + "parameter_std": { + "rvec_std_deg": [ + 0.030598800350524608, + 0.02184104472411403, + 0.02881903328031589 + ], + "tvec_std_m": [ + 6.243874013730126e-05, + 0.00012792598347274162, + 0.0002539459631324703 + ] + }, + "camera_center_std_m": [ + 0.0004250847347260799, + 0.0002691146356882737, + 0.0005312504732236512 + ], + "camera_center_std_mm": [ + 0.4250847347260799, + 0.2691146356882737, + 0.5312504732236512 + ], + "orientation_std_deg": { + "roll": 0.04070540096755981, + "pitch": 0.024066544562857728, + "yaw": 0.03135403694731619 + } + } + }, + "observations": { + "markers": [ + { + "marker_id": 208, + "observed_center_px": [ + 887.5, + 696.5 + ], + "projected_center_px": [ + 887.3656616210938, + 696.5743408203125 + ], + "reprojection_error_px": 0.15353617688315221, + "confidence": 0.06739671544456982 + }, + { + "marker_id": 103, + "observed_center_px": [ + 379.5, + 691.25 + ], + "projected_center_px": [ + 379.2528991699219, + 691.2681274414062 + ], + "reprojection_error_px": 0.24776485698588377, + "confidence": 0.17416420855033052 + }, + { + "marker_id": 58, + "observed_center_px": [ + 261.5, + 685.0 + ], + "projected_center_px": [ + 261.3277587890625, + 685.1651611328125 + ], + "reprojection_error_px": 0.23863200652285652, + "confidence": 0.24540823915500745 + }, + { + "marker_id": 214, + "observed_center_px": [ + 958.75, + 638.25 + ], + "projected_center_px": [ + 958.7680053710938, + 638.2145385742188 + ], + "reprojection_error_px": 0.03977066892400416, + "confidence": 0.32624039952470835 + }, + { + "marker_id": 64, + "observed_center_px": [ + 211.25, + 632.0 + ], + "projected_center_px": [ + 211.57020568847656, + 631.8875732421875 + ], + "reprojection_error_px": 0.3393692072138837, + "confidence": 0.4478501628460533 + }, + { + "marker_id": 211, + "observed_center_px": [ + 792.0, + 593.5 + ], + "projected_center_px": [ + 792.3621826171875, + 593.3333740234375 + ], + "reprojection_error_px": 0.3986733804233661, + "confidence": 0.3071912693949274 + }, + { + "marker_id": 72, + "observed_center_px": [ + 1249.25, + 596.5 + ], + "projected_center_px": [ + 1249.38916015625, + 596.4339599609375 + ], + "reprojection_error_px": 0.1540351773034359, + "confidence": 0.018959818235601233 + }, + { + "marker_id": 84, + "observed_center_px": [ + 1226.5, + 549.5 + ], + "projected_center_px": [ + 1226.63623046875, + 549.5099487304688 + ], + "reprojection_error_px": 0.13659325698505237, + "confidence": 0.07285288505606423 + }, + { + "marker_id": 86, + "observed_center_px": [ + 1175.0, + 518.25 + ], + "projected_center_px": [ + 1174.581787109375, + 518.358154296875 + ], + "reprojection_error_px": 0.4319714965335605, + "confidence": 0.1152962676763461 + } + ] + }, + "qa": { + "sanity_notes": [] + } +} \ No newline at end of file diff --git a/data/evaluations/Scene8/render_d_camera_pose_v8.json b/data/evaluations/Scene8/render_d_camera_pose_v8.json new file mode 100644 index 0000000..58ef264 --- /dev/null +++ b/data/evaluations/Scene8/render_d_camera_pose_v8.json @@ -0,0 +1,328 @@ +{ + "schema_version": "1.0", + "created_utc": "2026-06-01T18:37:02Z", + "source": { + "detection_json": "C:\\Users\\kech\\SynologyDrive\\2026-AppServer-AppRobot\\appRobotRendering\\data\\evaluations\\Scene8\\render_d_aruco_detection.json", + "robot_json": "C:\\Users\\kech\\SynologyDrive\\2026-AppServer-AppRobot\\appRobotRendering\\data\\robot\\robot.json" + }, + "camera": { + "camera_id": "d", + "camera_matrix": [ + [ + 1777.77783203125, + 0.0, + 640.0 + ], + [ + 0.0, + 1777.77783203125, + 360.0 + ], + [ + 0.0, + 0.0, + 1.0 + ] + ], + "distortion_coefficients": [ + 0.0, + 0.0, + 0.0, + 0.0, + 0.0 + ] + }, + "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": 9, + "used_marker_ids": [ + 208, + 103, + 58, + 214, + 64, + 211, + 72, + 84, + 86 + ], + "history": { + "iters": [ + 0, + 1, + 2, + 3 + ], + "rms": [ + 0.006333816581738461, + 0.0002773011027338013, + 0.00010662089465453542, + 0.00010661827813541825 + ], + "lambda": [ + 0.001, + 0.0005, + 0.00025, + 0.000125 + ] + }, + "residual_rms_px": 0.26803473514416426, + "residual_median_px": 0.23863200652285652, + "residual_max_px": 0.4319714965335605, + "sigma2_normalized": 1.705118584239489e-08 + }, + "camera_pose": { + "world_to_camera": { + "rotation_matrix": [ + [ + 0.8189369440078735, + 0.5738833546638489, + -0.0004457749892026186 + ], + [ + 0.16132032871246338, + -0.23095093667507172, + -0.9594985246658325 + ], + [ + -0.5507431626319885, + 0.7856968641281128, + -0.2817133069038391 + ] + ], + "translation_m": [ + -0.11496609860589374, + 0.09702643404210902, + 1.1291718331174512 + ], + "rvec_rad": [ + 1.7909599776987175, + 0.5647279566505399, + -0.42338173600008655 + ] + }, + "camera_in_world": { + "position_m": [ + 0.7003813368433853, + -0.7988013064306642, + 0.41114820015026465 + ], + "position_mm": [ + 700.3813368433853, + -798.8013064306641, + 411.14820015026464 + ], + "orientation_deg": { + "roll": 109.72539520263672, + "pitch": 33.41801071166992, + "yaw": 11.14387035369873 + } + }, + "uncertainty": { + "pose_covariance_6x6": [ + [ + 2.852092030612513e-07, + 1.2324146194593454e-07, + 1.264823680030996e-07, + 4.270453715882081e-10, + -5.4504294706706134e-08, + -1.2152984007154248e-08 + ], + [ + 1.2324146194593555e-07, + 1.4531202385393299e-07, + -6.015151106190092e-09, + 1.2042222954696699e-08, + -2.833712756388377e-08, + 2.8730439663963055e-08 + ], + [ + 1.2648236800309913e-07, + -6.015151106190755e-09, + 2.52995940259767e-07, + -1.5169021186969528e-08, + -4.255829665011247e-08, + -7.174617911570197e-08 + ], + [ + 4.2704537158833995e-10, + 1.2042222954696763e-08, + -1.5169021186969502e-08, + 3.898596269933436e-09, + 7.43659570879186e-10, + 9.126450926756841e-09 + ], + [ + -5.4504294706706287e-08, + -2.8337127563883675e-08, + -4.25582966501126e-08, + 7.436595708792132e-10, + 1.636505724746816e-08, + 1.2574879808690192e-08 + ], + [ + -1.2152984007153812e-08, + 2.873043966396327e-08, + -7.174617911570175e-08, + 9.126450926756889e-09, + 1.25748798086901e-08, + 6.448855219127798e-08 + ] + ], + "parameter_std": { + "rvec_std_deg": [ + 0.030598800350524608, + 0.02184104472411403, + 0.02881903328031589 + ], + "tvec_std_m": [ + 6.243874013730126e-05, + 0.00012792598347274162, + 0.0002539459631324703 + ] + }, + "camera_center_std_m": [ + 0.0004250847347260799, + 0.0002691146356882737, + 0.0005312504732236512 + ], + "camera_center_std_mm": [ + 0.4250847347260799, + 0.2691146356882737, + 0.5312504732236512 + ], + "orientation_std_deg": { + "roll": 0.04070540096755981, + "pitch": 0.024066544562857728, + "yaw": 0.03135403694731619 + } + } + }, + "observations": { + "markers": [ + { + "marker_id": 208, + "observed_center_px": [ + 887.5, + 696.5 + ], + "projected_center_px": [ + 887.3656616210938, + 696.5743408203125 + ], + "reprojection_error_px": 0.15353617688315221, + "confidence": 0.06739671544456982 + }, + { + "marker_id": 103, + "observed_center_px": [ + 379.5, + 691.25 + ], + "projected_center_px": [ + 379.2528991699219, + 691.2681274414062 + ], + "reprojection_error_px": 0.24776485698588377, + "confidence": 0.17416420855033052 + }, + { + "marker_id": 58, + "observed_center_px": [ + 261.5, + 685.0 + ], + "projected_center_px": [ + 261.3277587890625, + 685.1651611328125 + ], + "reprojection_error_px": 0.23863200652285652, + "confidence": 0.24540823915500745 + }, + { + "marker_id": 214, + "observed_center_px": [ + 958.75, + 638.25 + ], + "projected_center_px": [ + 958.7680053710938, + 638.2145385742188 + ], + "reprojection_error_px": 0.03977066892400416, + "confidence": 0.32624039952470835 + }, + { + "marker_id": 64, + "observed_center_px": [ + 211.25, + 632.0 + ], + "projected_center_px": [ + 211.57020568847656, + 631.8875732421875 + ], + "reprojection_error_px": 0.3393692072138837, + "confidence": 0.4478501628460533 + }, + { + "marker_id": 211, + "observed_center_px": [ + 792.0, + 593.5 + ], + "projected_center_px": [ + 792.3621826171875, + 593.3333740234375 + ], + "reprojection_error_px": 0.3986733804233661, + "confidence": 0.3071912693949274 + }, + { + "marker_id": 72, + "observed_center_px": [ + 1249.25, + 596.5 + ], + "projected_center_px": [ + 1249.38916015625, + 596.4339599609375 + ], + "reprojection_error_px": 0.1540351773034359, + "confidence": 0.018959818235601233 + }, + { + "marker_id": 84, + "observed_center_px": [ + 1226.5, + 549.5 + ], + "projected_center_px": [ + 1226.63623046875, + 549.5099487304688 + ], + "reprojection_error_px": 0.13659325698505237, + "confidence": 0.07285288505606423 + }, + { + "marker_id": 86, + "observed_center_px": [ + 1175.0, + 518.25 + ], + "projected_center_px": [ + 1174.581787109375, + 518.358154296875 + ], + "reprojection_error_px": 0.4319714965335605, + "confidence": 0.1152962676763461 + } + ] + }, + "qa": { + "sanity_notes": [] + }, + "v8_z_correction_mm": 11.151935468550299 +} \ No newline at end of file diff --git a/data/evaluations/Scene8/render_e_aruco_detection.json b/data/evaluations/Scene8/render_e_aruco_detection.json new file mode 100644 index 0000000..28750af --- /dev/null +++ b/data/evaluations/Scene8/render_e_aruco_detection.json @@ -0,0 +1,2254 @@ +{ + "schema_version": "1.0", + "created_utc": "2026-06-01T18:36:44Z", + "vision_config": { + "MarkerType": "DICT_4X4_250", + "MarkerSize": 0.025 + }, + "camera": { + "camera_id": "e", + "intrinsics_file": "C:\\Users\\kech\\SynologyDrive\\2026-AppServer-AppRobot\\appRobotRendering\\data\\simulation\\Scene8\\render_a.npz", + "camera_matrix": [ + [ + 1777.77783203125, + 0.0, + 640.0 + ], + [ + 0.0, + 1777.77783203125, + 360.0 + ], + [ + 0.0, + 0.0, + 1.0 + ] + ], + "distortion_coefficients": [ + 0.0, + 0.0, + 0.0, + 0.0, + 0.0 + ] + }, + "image": { + "image_file": "C:\\Users\\kech\\SynologyDrive\\2026-AppServer-AppRobot\\appRobotRendering\\data\\simulation\\Scene8\\render_e.png", + "image_sha256": "93eed378d49dea63dd061223c9be54d8f846670f4e1cec78655cae33fdc3dfb0", + "width_px": 1280, + "height_px": 720 + }, + "aruco": { + "dictionary": "DICT_4X4_250", + "num_detected_markers": 32, + "num_rejected_candidates": 19 + }, + "detections": [ + { + "observation_id": "07a34448-aa58-40a3-ab2e-e53609a6b111", + "type": "aruco", + "marker_id": 114, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 669.0, + 145.0 + ], + [ + 634.0, + 146.0 + ], + [ + 635.0, + 107.0 + ], + [ + 671.0, + 109.0 + ] + ], + "center_px": [ + 652.25, + 126.75 + ], + "quality": { + "area_px": 1332.0, + "perimeter_px": 146.13812255859375, + "sharpness": { + "laplacian_var": 469.3829971583863 + }, + "contrast": { + "p05": 5.0, + "p95": 95.0, + "dynamic_range": 90.0, + "mean_gray": 28.379162191192265, + "std_gray": 36.010070732259464 + }, + "geometry": { + "distance_to_center_norm": 0.3180862069129944, + "distance_to_border_px": 107.0 + }, + "edge_ratio": 1.114197261859523, + "edge_lengths_px": [ + 35.0142822265625, + 39.0128173828125, + 36.055511474609375, + 36.055511474609375 + ] + }, + "confidence": 0.796986342003736 + }, + { + "observation_id": "a771bdb1-31ed-4e0e-a32c-36711fbb3261", + "type": "aruco", + "marker_id": 120, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 664.0, + 248.0 + ], + [ + 629.0, + 248.0 + ], + [ + 631.0, + 212.0 + ], + [ + 666.0, + 213.0 + ] + ], + "center_px": [ + 647.5, + 230.25 + ], + "quality": { + "area_px": 1243.5, + "perimeter_px": 141.12688827514648, + "sharpness": { + "laplacian_var": 515.1758792877674 + }, + "contrast": { + "p05": 6.0, + "p95": 97.0, + "dynamic_range": 91.0, + "mean_gray": 27.06993006993007, + "std_gray": 34.76862926040931 + }, + "geometry": { + "distance_to_center_norm": 0.17699328064918518, + "distance_to_border_px": 212.0 + }, + "edge_ratio": 1.030157470703125, + "edge_lengths_px": [ + 35.0, + 36.055511474609375, + 35.0142822265625, + 35.05709457397461 + ] + }, + "confidence": 0.8047313382430487 + }, + { + "observation_id": "21b971f1-37f4-453c-b53d-912794e5bfcb", + "type": "aruco", + "marker_id": 44, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 586.0, + 48.0 + ], + [ + 586.0, + 12.0 + ], + [ + 618.0, + 8.0 + ], + [ + 618.0, + 45.0 + ] + ], + "center_px": [ + 602.0, + 28.25 + ], + "quality": { + "area_px": 1168.0, + "perimeter_px": 137.38934707641602, + "sharpness": { + "laplacian_var": 1330.3737327416175 + }, + "contrast": { + "p05": 43.0, + "p95": 170.0, + "dynamic_range": 127.0, + "mean_gray": 85.94358974358974, + "std_gray": 50.665159195886375 + }, + "geometry": { + "distance_to_center_norm": 0.45474353432655334, + "distance_to_border_px": 8.0 + }, + "edge_ratio": 1.1512021222516557, + "edge_lengths_px": [ + 36.0, + 32.24903106689453, + 37.0, + 32.140316009521484 + ] + }, + "confidence": 0.10822310370917793 + }, + { + "observation_id": "07d22f24-3463-40a3-8ec6-5ee2eee906fc", + "type": "aruco", + "marker_id": 92, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 991.0, + 686.0 + ], + [ + 1021.0, + 676.0 + ], + [ + 1054.0, + 690.0 + ], + [ + 1026.0, + 702.0 + ] + ], + "center_px": [ + 1023.0, + 688.5 + ], + "quality": { + "area_px": 809.0, + "perimeter_px": 136.41653060913086, + "sharpness": { + "laplacian_var": 1174.1654170514005 + }, + "contrast": { + "p05": 20.0, + "p95": 165.0, + "dynamic_range": 145.0, + "mean_gray": 71.80175438596491, + "std_gray": 57.641094597481526 + }, + "geometry": { + "distance_to_center_norm": 0.6871559619903564, + "distance_to_border_px": 18.0 + }, + "edge_ratio": 1.263291448970706, + "edge_lengths_px": [ + 31.62277603149414, + 35.84689712524414, + 30.463092803955078, + 38.4837646484375 + ] + }, + "confidence": 0.15369374989294518 + }, + { + "observation_id": "d30d69fa-b173-4756-aed0-8dbbfd564601", + "type": "aruco", + "marker_id": 217, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 1138.0, + 589.0 + ], + [ + 1171.0, + 602.0 + ], + [ + 1146.0, + 612.0 + ], + [ + 1110.0, + 599.0 + ] + ], + "center_px": [ + 1141.25, + 600.5 + ], + "quality": { + "area_px": 689.5, + "perimeter_px": 130.40157508850098, + "sharpness": { + "laplacian_var": 1822.5796735195684 + }, + "contrast": { + "p05": 17.0, + "p95": 162.0, + "dynamic_range": 145.0, + "mean_gray": 74.05578512396694, + "std_gray": 56.905269509398686 + }, + "geometry": { + "distance_to_center_norm": 0.7571271657943726, + "distance_to_border_px": 108.0 + }, + "edge_ratio": 1.4215096728839491, + "edge_lengths_px": [ + 35.46829605102539, + 26.925823211669922, + 38.27531814575195, + 29.73213768005371 + ] + }, + "confidence": 0.3233651345714012 + }, + { + "observation_id": "f6bf98d3-a583-45c0-a542-113ef9075917", + "type": "aruco", + "marker_id": 85, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 645.0, + 664.0 + ], + [ + 678.0, + 653.0 + ], + [ + 705.0, + 667.0 + ], + [ + 673.0, + 678.0 + ] + ], + "center_px": [ + 675.25, + 665.5 + ], + "quality": { + "area_px": 757.5, + "perimeter_px": 130.34166717529297, + "sharpness": { + "laplacian_var": 1389.600737796958 + }, + "contrast": { + "p05": 23.6, + "p95": 171.0, + "dynamic_range": 147.4, + "mean_gray": 123.84990619136961, + "std_gray": 54.26628100591184 + }, + "geometry": { + "distance_to_center_norm": 0.418801486492157, + "distance_to_border_px": 42.0 + }, + "edge_ratio": 1.1437255061695086, + "edge_lengths_px": [ + 34.78505325317383, + 30.4138126373291, + 33.83784866333008, + 31.30495262145996 + ] + }, + "confidence": 0.37089318871684795 + }, + { + "observation_id": "539bde1d-301a-4da4-9236-d4bf2edc6133", + "type": "aruco", + "marker_id": 105, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 730.0, + 653.0 + ], + [ + 763.0, + 643.0 + ], + [ + 790.0, + 656.0 + ], + [ + 759.0, + 667.0 + ] + ], + "center_px": [ + 760.5, + 654.75 + ], + "quality": { + "area_px": 726.0, + "perimeter_px": 129.54478073120117, + "sharpness": { + "laplacian_var": 1552.6334707669414 + }, + "contrast": { + "p05": 18.0, + "p95": 163.64999999999998, + "dynamic_range": 145.64999999999998, + "mean_gray": 46.061023622047244, + "std_gray": 48.985999692578815 + }, + "geometry": { + "distance_to_center_norm": 0.43365001678466797, + "distance_to_border_px": 53.0 + }, + "edge_ratio": 1.1506752463886485, + "edge_lengths_px": [ + 34.48188018798828, + 29.96664810180664, + 32.893768310546875, + 32.202484130859375 + ] + }, + "confidence": 0.420622587927407 + }, + { + "observation_id": "0d88ffb4-04d5-483c-a834-a49039247fde", + "type": "aruco", + "marker_id": 206, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 1217.0, + 556.0 + ], + [ + 1251.0, + 568.0 + ], + [ + 1231.0, + 579.0 + ], + [ + 1193.0, + 565.0 + ] + ], + "center_px": [ + 1223.0, + 567.0 + ], + "quality": { + "area_px": 646.0, + "perimeter_px": 125.00986099243164, + "sharpness": { + "laplacian_var": 2270.350266666667 + }, + "contrast": { + "p05": 22.0, + "p95": 160.0, + "dynamic_range": 138.0, + "mean_gray": 78.43333333333334, + "std_gray": 51.03816654665844 + }, + "geometry": { + "distance_to_center_norm": 0.8425115346908569, + "distance_to_border_px": 29.0 + }, + "edge_ratio": 1.7742020286291678, + "edge_lengths_px": [ + 36.055511474609375, + 22.825424194335938, + 40.49691390991211, + 25.63201141357422 + ] + }, + "confidence": 0.14078817554935588 + }, + { + "observation_id": "0daf5eab-3807-4590-8150-9d5607ad3edd", + "type": "aruco", + "marker_id": 244, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 673.0, + 403.0 + ], + [ + 646.0, + 408.0 + ], + [ + 648.0, + 374.0 + ], + [ + 675.0, + 370.0 + ] + ], + "center_px": [ + 660.5, + 388.75 + ], + "quality": { + "area_px": 895.5, + "perimeter_px": 121.87307167053223, + "sharpness": { + "laplacian_var": 614.8180654841751 + }, + "contrast": { + "p05": 9.0, + "p95": 90.0, + "dynamic_range": 81.0, + "mean_gray": 43.92758089368259, + "std_gray": 35.71798449646885 + }, + "geometry": { + "distance_to_center_norm": 0.048086777329444885, + "distance_to_border_px": 312.0 + }, + "edge_ratio": 1.247816936038345, + "edge_lengths_px": [ + 27.459060668945312, + 34.058773040771484, + 27.294687271118164, + 33.060550689697266 + ] + }, + "confidence": 0.4784355643508066 + }, + { + "observation_id": "f69a434a-74c7-4cb4-8ce3-12ab014e5197", + "type": "aruco", + "marker_id": 97, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 385.0, + 577.0 + ], + [ + 417.0, + 568.0 + ], + [ + 438.0, + 579.0 + ], + [ + 404.0, + 588.0 + ] + ], + "center_px": [ + 411.0, + 578.0 + ], + "quality": { + "area_px": 543.0, + "perimeter_px": 114.0735855102539, + "sharpness": { + "laplacian_var": 3889.170728895399 + }, + "contrast": { + "p05": 23.0, + "p95": 177.0, + "dynamic_range": 154.0, + "mean_gray": 102.53645833333333, + "std_gray": 65.8328749242347 + }, + "geometry": { + "distance_to_center_norm": 0.43057525157928467, + "distance_to_border_px": 132.0 + }, + "edge_ratio": 1.6019955727302424, + "edge_lengths_px": [ + 33.241539001464844, + 23.706539154052734, + 35.1710090637207, + 21.954498291015625 + ] + }, + "confidence": 0.22596816505744277 + }, + { + "observation_id": "034ab893-3044-4822-814a-4c16e1fdf9e5", + "type": "aruco", + "marker_id": 47, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 518.0, + 568.0 + ], + [ + 548.0, + 560.0 + ], + [ + 570.0, + 570.0 + ], + [ + 539.0, + 579.0 + ] + ], + "center_px": [ + 543.75, + 569.25 + ], + "quality": { + "area_px": 503.0, + "perimeter_px": 111.20100593566895, + "sharpness": { + "laplacian_var": 3416.503388941199 + }, + "contrast": { + "p05": 28.0, + "p95": 175.0, + "dynamic_range": 147.0, + "mean_gray": 84.90616621983914, + "std_gray": 59.67022231521041 + }, + "geometry": { + "distance_to_center_norm": 0.31366512179374695, + "distance_to_border_px": 141.0 + }, + "edge_ratio": 1.361650693608701, + "edge_lengths_px": [ + 31.048349380493164, + 24.166091918945312, + 32.280025482177734, + 23.706539154052734 + ] + }, + "confidence": 0.24626971873720385 + }, + { + "observation_id": "665f8ed1-469e-40e5-b0dd-c47e1a65ad05", + "type": "aruco", + "marker_id": 96, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 665.0, + 543.0 + ], + [ + 692.0, + 535.0 + ], + [ + 715.0, + 545.0 + ], + [ + 688.0, + 554.0 + ] + ], + "center_px": [ + 690.0, + 544.25 + ], + "quality": { + "area_px": 479.0, + "perimeter_px": 107.19572448730469, + "sharpness": { + "laplacian_var": 3568.7575918354605 + }, + "contrast": { + "p05": 21.0, + "p95": 172.0, + "dynamic_range": 151.0, + "mean_gray": 86.95810055865921, + "std_gray": 64.42275638721306 + }, + "geometry": { + "distance_to_center_norm": 0.25999337434768677, + "distance_to_border_px": 166.0 + }, + "edge_ratio": 1.1347944144516315, + "edge_lengths_px": [ + 28.160255432128906, + 25.079872131347656, + 28.460498809814453, + 25.495098114013672 + ] + }, + "confidence": 0.28140192555287236 + }, + { + "observation_id": "76071e2d-22aa-4900-95d2-b8bf775fa06f", + "type": "aruco", + "marker_id": 245, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 601.0, + 372.0 + ], + [ + 599.0, + 404.0 + ], + [ + 579.0, + 397.0 + ], + [ + 580.0, + 364.0 + ] + ], + "center_px": [ + 589.75, + 384.25 + ], + "quality": { + "area_px": 677.5, + "perimeter_px": 108.73941230773926, + "sharpness": { + "laplacian_var": 2713.9134670360113 + }, + "contrast": { + "p05": 34.0, + "p95": 178.0, + "dynamic_range": 144.0, + "mean_gray": 92.56842105263158, + "std_gray": 63.79131315742788 + }, + "geometry": { + "distance_to_center_norm": 0.07598420977592468, + "distance_to_border_px": 316.0 + }, + "edge_ratio": 1.5580811099437382, + "edge_lengths_px": [ + 32.06243896484375, + 21.189620971679688, + 33.0151481628418, + 22.472204208374023 + ] + }, + "confidence": 0.28988649164931873 + }, + { + "observation_id": "7bda6068-75bd-4202-ad5d-4a5570156d06", + "type": "aruco", + "marker_id": 62, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 713.0, + 555.0 + ], + [ + 741.0, + 547.0 + ], + [ + 764.0, + 557.0 + ], + [ + 736.0, + 565.0 + ] + ], + "center_px": [ + 738.5, + 556.0 + ], + "quality": { + "area_px": 464.0, + "perimeter_px": 108.4006233215332, + "sharpness": { + "laplacian_var": 2525.9330891040295 + }, + "contrast": { + "p05": 23.0, + "p95": 166.89999999999998, + "dynamic_range": 143.89999999999998, + "mean_gray": 52.994169096209916, + "std_gray": 47.4435060190186 + }, + "geometry": { + "distance_to_center_norm": 0.2987307906150818, + "distance_to_border_px": 155.0 + }, + "edge_ratio": 1.161107974431055, + "edge_lengths_px": [ + 29.120439529418945, + 25.079872131347656, + 29.120439529418945, + 25.079872131347656 + ] + }, + "confidence": 0.2664122029520185 + }, + { + "observation_id": "60478cfe-dfed-4f74-91d3-839d3060755c", + "type": "aruco", + "marker_id": 219, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 695.0, + 87.0 + ], + [ + 677.0, + 90.0 + ], + [ + 679.0, + 53.0 + ], + [ + 697.0, + 52.0 + ] + ], + "center_px": [ + 687.0, + 70.5 + ], + "quality": { + "area_px": 644.0, + "perimeter_px": 108.38715362548828, + "sharpness": { + "laplacian_var": 614.9337098692034 + }, + "contrast": { + "p05": 8.0, + "p95": 77.84999999999997, + "dynamic_range": 69.84999999999997, + "mean_gray": 33.372844827586206, + "std_gray": 28.163182810983688 + }, + "geometry": { + "distance_to_center_norm": 0.3994136452674866, + "distance_to_border_px": 52.0 + }, + "edge_ratio": 2.055387073866642, + "edge_lengths_px": [ + 18.248287200927734, + 37.05401611328125, + 18.027755737304688, + 35.05709457397461 + ] + }, + "confidence": 0.18238008374815162 + }, + { + "observation_id": "3592ee97-40fd-43d7-8663-ca8059a431c0", + "type": "aruco", + "marker_id": 66, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 306.0, + 536.0 + ], + [ + 339.0, + 529.0 + ], + [ + 356.0, + 538.0 + ], + [ + 324.0, + 546.0 + ] + ], + "center_px": [ + 331.25, + 537.25 + ], + "quality": { + "area_px": 440.0, + "perimeter_px": 106.54574584960938, + "sharpness": { + "laplacian_var": 3556.017999105521 + }, + "contrast": { + "p05": 24.0, + "p95": 178.5, + "dynamic_range": 154.5, + "mean_gray": 74.09365558912387, + "std_gray": 62.59258029339184 + }, + "geometry": { + "distance_to_center_norm": 0.48482945561408997, + "distance_to_border_px": 174.0 + }, + "edge_ratio": 1.7537605054536587, + "edge_lengths_px": [ + 33.734256744384766, + 19.235383987426758, + 32.98484420776367, + 20.59126091003418 + ] + }, + "confidence": 0.16725963004706537 + }, + { + "observation_id": "95814aa6-5710-40c3-80ae-07db2b751107", + "type": "aruco", + "marker_id": 248, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 568.0, + 360.0 + ], + [ + 567.0, + 393.0 + ], + [ + 547.0, + 385.0 + ], + [ + 548.0, + 353.0 + ] + ], + "center_px": [ + 557.5, + 372.75 + ], + "quality": { + "area_px": 657.5, + "perimeter_px": 107.76104927062988, + "sharpness": { + "laplacian_var": 3474.863086846939 + }, + "contrast": { + "p05": 35.0, + "p95": 179.0, + "dynamic_range": 144.0, + "mean_gray": 99.33769063180829, + "std_gray": 62.82504423318867 + }, + "geometry": { + "distance_to_center_norm": 0.11368533968925476, + "distance_to_border_px": 327.0 + }, + "edge_ratio": 1.5580811099437382, + "edge_lengths_px": [ + 33.0151481628418, + 21.540658950805664, + 32.015621185302734, + 21.189620971679688 + ] + }, + "confidence": 0.28132895684048276 + }, + { + "observation_id": "9881d7ba-bb4c-4a1c-8c1f-3e545082af9b", + "type": "aruco", + "marker_id": 79, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 643.0, + 510.0 + ], + [ + 668.0, + 503.0 + ], + [ + 693.0, + 514.0 + ], + [ + 663.0, + 520.0 + ] + ], + "center_px": [ + 666.75, + 511.75 + ], + "quality": { + "area_px": 435.0, + "perimeter_px": 106.22930526733398, + "sharpness": { + "laplacian_var": 5755.361941550289 + }, + "contrast": { + "p05": 24.0, + "p95": 173.0, + "dynamic_range": 149.0, + "mean_gray": 96.15170278637771, + "std_gray": 59.538669344009676 + }, + "geometry": { + "distance_to_center_norm": 0.20984497666358948, + "distance_to_border_px": 200.0 + }, + "edge_ratio": 1.368210480272166, + "edge_lengths_px": [ + 25.961509704589844, + 27.312999725341797, + 30.5941162109375, + 22.360679626464844 + ] + }, + "confidence": 0.21195569262290176 + }, + { + "observation_id": "4c590a7c-a664-478d-8e2f-22a9084d6162", + "type": "aruco", + "marker_id": 55, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 495.0, + 533.0 + ], + [ + 524.0, + 525.0 + ], + [ + 544.0, + 535.0 + ], + [ + 515.0, + 543.0 + ] + ], + "center_px": [ + 519.5, + 534.0 + ], + "quality": { + "area_px": 450.0, + "perimeter_px": 104.8877944946289, + "sharpness": { + "laplacian_var": 4148.963948750263 + }, + "contrast": { + "p05": 27.0, + "p95": 177.0, + "dynamic_range": 150.0, + "mean_gray": 88.84057971014492, + "std_gray": 61.37332262554081 + }, + "geometry": { + "distance_to_center_norm": 0.2882344722747803, + "distance_to_border_px": 177.0 + }, + "edge_ratio": 1.3453624005794889, + "edge_lengths_px": [ + 30.08321762084961, + 22.360679626464844, + 30.08321762084961, + 22.360679626464844 + ] + }, + "confidence": 0.22298824455832925 + }, + { + "observation_id": "25c0a64e-a7c3-4108-afbe-91a313d1889b", + "type": "aruco", + "marker_id": 243, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 504.0, + 342.0 + ], + [ + 524.0, + 349.0 + ], + [ + 525.0, + 380.0 + ], + [ + 507.0, + 374.0 + ] + ], + "center_px": [ + 515.0, + 361.25 + ], + "quality": { + "area_px": 585.5, + "perimeter_px": 103.31972694396973, + "sharpness": { + "laplacian_var": 3023.515327203894 + }, + "contrast": { + "p05": 34.0, + "p95": 178.0, + "dynamic_range": 144.0, + "mean_gray": 81.84186046511628, + "std_gray": 60.155481617485975 + }, + "geometry": { + "distance_to_center_norm": 0.17023810744285583, + "distance_to_border_px": 340.0 + }, + "edge_ratio": 1.6939434530615978, + "edge_lengths_px": [ + 21.189620971679688, + 31.016124725341797, + 18.973665237426758, + 32.140316009521484 + ] + }, + "confidence": 0.23042878593606714 + }, + { + "observation_id": "fcdd75d9-da62-4e62-afe7-81a6c0a84e00", + "type": "aruco", + "marker_id": 214, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 859.0, + 438.0 + ], + [ + 882.0, + 445.0 + ], + [ + 856.0, + 451.0 + ], + [ + 835.0, + 444.0 + ] + ], + "center_px": [ + 858.0, + 444.5 + ], + "quality": { + "area_px": 307.0, + "perimeter_px": 97.59953689575195, + "sharpness": { + "laplacian_var": 4953.1880017543535 + }, + "contrast": { + "p05": 20.0, + "p95": 142.0, + "dynamic_range": 122.0, + "mean_gray": 78.48034934497817, + "std_gray": 48.64680485484511 + }, + "geometry": { + "distance_to_center_norm": 0.3184027075767517, + "distance_to_border_px": 269.0 + }, + "edge_ratio": 1.205429874000591, + "edge_lengths_px": [ + 24.041629791259766, + 26.68332862854004, + 22.135944366455078, + 24.73863410949707 + ] + }, + "confidence": 0.1697872859143744 + }, + { + "observation_id": "c155e7c6-5a0d-41f1-89b6-9151eaf08fbb", + "type": "aruco", + "marker_id": 51, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 507.0, + 462.0 + ], + [ + 535.0, + 457.0 + ], + [ + 551.0, + 464.0 + ], + [ + 524.0, + 470.0 + ] + ], + "center_px": [ + 529.25, + 463.25 + ], + "quality": { + "area_px": 297.0, + "perimeter_px": 92.35410118103027, + "sharpness": { + "laplacian_var": 6128.6329908058415 + }, + "contrast": { + "p05": 30.0, + "p95": 178.0, + "dynamic_range": 148.0, + "mean_gray": 92.2139534883721, + "std_gray": 59.31469711355066 + }, + "geometry": { + "distance_to_center_norm": 0.20620082318782806, + "distance_to_border_px": 250.0 + }, + "edge_ratio": 1.6286371694405686, + "edge_lengths_px": [ + 28.44292449951172, + 17.464248657226562, + 27.658634185791016, + 18.788293838500977 + ] + }, + "confidence": 0.12157403976480062 + }, + { + "observation_id": "43f18a7e-49a0-4ba5-b832-c91a4658f139", + "type": "aruco", + "marker_id": 72, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 1108.0, + 454.0 + ], + [ + 1131.0, + 449.0 + ], + [ + 1156.0, + 456.0 + ], + [ + 1136.0, + 462.0 + ] + ], + "center_px": [ + 1132.75, + 455.25 + ], + "quality": { + "area_px": 307.0, + "perimeter_px": 99.4997673034668, + "sharpness": { + "laplacian_var": 6015.53668126975 + }, + "contrast": { + "p05": 15.0, + "p95": 155.0, + "dynamic_range": 140.0, + "mean_gray": 60.38559322033898, + "std_gray": 51.485636923260955 + }, + "geometry": { + "distance_to_center_norm": 0.6834672689437866, + "distance_to_border_px": 124.0 + }, + "edge_ratio": 1.394616100271707, + "edge_lengths_px": [ + 23.53720474243164, + 25.961509704589844, + 20.880613327026367, + 29.120439529418945 + ] + }, + "confidence": 0.14675484287524884 + }, + { + "observation_id": "61c56c1f-2c39-4c98-8622-f23cb22e32a9", + "type": "aruco", + "marker_id": 95, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 402.0, + 498.0 + ], + [ + 431.0, + 491.0 + ], + [ + 449.0, + 500.0 + ], + [ + 419.0, + 506.0 + ] + ], + "center_px": [ + 425.25, + 498.75 + ], + "quality": { + "area_px": 364.5, + "perimeter_px": 99.33988952636719, + "sharpness": { + "laplacian_var": 5621.020098940312 + }, + "contrast": { + "p05": 23.0, + "p95": 179.0, + "dynamic_range": 156.0, + "mean_gray": 88.8529411764706, + "std_gray": 65.58806713246709 + }, + "geometry": { + "distance_to_center_norm": 0.34818607568740845, + "distance_to_border_px": 214.0 + }, + "edge_ratio": 1.6283605352309334, + "edge_lengths_px": [ + 29.832868576049805, + 20.124610900878906, + 30.5941162109375, + 18.788293838500977 + ] + }, + "confidence": 0.14922985097126407 + }, + { + "observation_id": "c715c2d8-0f40-4bbc-b880-f250f1161e14", + "type": "aruco", + "marker_id": 103, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 444.0, + 446.0 + ], + [ + 471.0, + 441.0 + ], + [ + 486.0, + 448.0 + ], + [ + 459.0, + 453.0 + ] + ], + "center_px": [ + 465.0, + 447.0 + ], + "quality": { + "area_px": 264.0, + "perimeter_px": 88.02401351928711, + "sharpness": { + "laplacian_var": 7616.010237639051 + }, + "contrast": { + "p05": 29.3, + "p95": 179.0, + "dynamic_range": 149.7, + "mean_gray": 129.62566844919786, + "std_gray": 55.38363031533882 + }, + "geometry": { + "distance_to_center_norm": 0.266147643327713, + "distance_to_border_px": 267.0 + }, + "edge_ratio": 1.6588624477171257, + "edge_lengths_px": [ + 27.459060668945312, + 16.552946090698242, + 27.459060668945312, + 16.552946090698242 + ] + }, + "confidence": 0.10609680160172753 + }, + { + "observation_id": "6abbeb62-f795-4cf5-b228-829b0811259f", + "type": "aruco", + "marker_id": 60, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 1174.0, + 430.0 + ], + [ + 1193.0, + 425.0 + ], + [ + 1217.0, + 432.0 + ], + [ + 1199.0, + 437.0 + ] + ], + "center_px": [ + 1195.75, + 431.0 + ], + "quality": { + "area_px": 252.0, + "perimeter_px": 89.2899341583252, + "sharpness": { + "laplacian_var": 5458.464570455971 + }, + "contrast": { + "p05": 16.0, + "p95": 155.0, + "dynamic_range": 139.0, + "mean_gray": 102.47540983606558, + "std_gray": 54.46519113706534 + }, + "geometry": { + "distance_to_center_norm": 0.7629922032356262, + "distance_to_border_px": 63.0 + }, + "edge_ratio": 1.3896877719636351, + "edge_lengths_px": [ + 19.646883010864258, + 25.0, + 18.681541442871094, + 25.961509704589844 + ] + }, + "confidence": 0.1208904643109979 + }, + { + "observation_id": "d3b09995-2427-4c55-93fe-eee8519d6982", + "type": "aruco", + "marker_id": 69, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 274.0, + 439.0 + ], + [ + 302.0, + 434.0 + ], + [ + 319.0, + 442.0 + ], + [ + 287.0, + 446.0 + ] + ], + "center_px": [ + 295.5, + 440.25 + ], + "quality": { + "area_px": 292.5, + "perimeter_px": 94.24507236480713, + "sharpness": { + "laplacian_var": 7671.742542524209 + }, + "contrast": { + "p05": 24.0, + "p95": 180.0, + "dynamic_range": 156.0, + "mean_gray": 84.50239234449761, + "std_gray": 62.98014606290175 + }, + "geometry": { + "distance_to_center_norm": 0.4817137122154236, + "distance_to_border_px": 274.0 + }, + "edge_ratio": 2.1841800036803938, + "edge_lengths_px": [ + 28.44292449951172, + 18.788293838500977, + 32.24903106689453, + 14.764822959899902 + ] + }, + "confidence": 0.08927835602899967 + }, + { + "observation_id": "1d458d9f-13dd-4614-a389-051719733f8e", + "type": "aruco", + "marker_id": 215, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 686.0, + 426.0 + ], + [ + 707.0, + 434.0 + ], + [ + 680.0, + 439.0 + ], + [ + 662.0, + 432.0 + ] + ], + "center_px": [ + 683.75, + 432.75 + ], + "quality": { + "area_px": 298.5, + "perimeter_px": 93.98310661315918, + "sharpness": { + "laplacian_var": 841.6697733575195 + }, + "contrast": { + "p05": 12.0, + "p95": 69.0, + "dynamic_range": 57.0, + "mean_gray": 33.8675799086758, + "std_gray": 20.978479929931893 + }, + "geometry": { + "distance_to_center_norm": 0.11560884118080139, + "distance_to_border_px": 281.0 + }, + "edge_ratio": 1.42177628906613, + "edge_lengths_px": [ + 22.472204208374023, + 27.459060668945312, + 19.313207626342773, + 24.73863410949707 + ] + }, + "confidence": 0.09972560457674447 + }, + { + "observation_id": "7151bcf1-4741-45f4-b14a-80d85be3935b", + "type": "aruco", + "marker_id": 211, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 767.0, + 407.0 + ], + [ + 785.0, + 414.0 + ], + [ + 761.0, + 419.0 + ], + [ + 742.0, + 412.0 + ] + ], + "center_px": [ + 763.75, + 413.0 + ], + "quality": { + "area_px": 264.0, + "perimeter_px": 89.57206344604492, + "sharpness": { + "laplacian_var": 4134.954579095966 + }, + "contrast": { + "p05": 14.0, + "p95": 136.0, + "dynamic_range": 122.0, + "mean_gray": 64.81151832460733, + "std_gray": 47.12549885356449 + }, + "geometry": { + "distance_to_center_norm": 0.18333308398723602, + "distance_to_border_px": 301.0 + }, + "edge_ratio": 1.320086161101429, + "edge_lengths_px": [ + 19.313207626342773, + 24.515300750732422, + 20.248456954956055, + 25.495098114013672 + ] + }, + "confidence": 0.13332463075982282 + }, + { + "observation_id": "a64e08e8-58d0-42ca-b3df-4c496a2a21b9", + "type": "aruco", + "marker_id": 84, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 1126.0, + 428.0 + ], + [ + 1145.0, + 423.0 + ], + [ + 1169.0, + 430.0 + ], + [ + 1150.0, + 435.0 + ] + ], + "center_px": [ + 1147.5, + 429.0 + ], + "quality": { + "area_px": 253.0, + "perimeter_px": 89.29376602172852, + "sharpness": { + "laplacian_var": 6507.626777662157 + }, + "contrast": { + "p05": 16.0, + "p95": 155.0, + "dynamic_range": 139.0, + "mean_gray": 85.89247311827957, + "std_gray": 52.75821545678702 + }, + "geometry": { + "distance_to_center_norm": 0.6974908709526062, + "distance_to_border_px": 111.0 + }, + "edge_ratio": 1.272466476548753, + "edge_lengths_px": [ + 19.646883010864258, + 25.0, + 19.646883010864258, + 25.0 + ] + }, + "confidence": 0.13255097071329755 + }, + { + "observation_id": "223d5066-9586-44bf-b6c8-b63413be641c", + "type": "aruco", + "marker_id": 86, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 1106.0, + 408.0 + ], + [ + 1128.0, + 404.0 + ], + [ + 1147.0, + 409.0 + ], + [ + 1128.0, + 414.0 + ] + ], + "center_px": [ + 1127.25, + 408.75 + ], + "quality": { + "area_px": 205.0, + "perimeter_px": 84.45795440673828, + "sharpness": { + "laplacian_var": 6562.795155709344 + }, + "contrast": { + "p05": 16.0, + "p95": 154.0, + "dynamic_range": 138.0, + "mean_gray": 83.61764705882354, + "std_gray": 52.60273684776708 + }, + "geometry": { + "distance_to_center_norm": 0.6668679118156433, + "distance_to_border_px": 133.0 + }, + "edge_ratio": 1.1606680177173716, + "edge_lengths_px": [ + 22.360679626464844, + 19.646883010864258, + 19.646883010864258, + 22.803508758544922 + ] + }, + "confidence": 0.11774828338549573 + }, + { + "observation_id": "13c49bc5-8f3b-432b-92d6-2fc38a5ed82a", + "type": "aruco", + "marker_id": 64, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 359.0, + 408.0 + ], + [ + 385.0, + 404.0 + ], + [ + 399.0, + 410.0 + ], + [ + 373.0, + 415.0 + ] + ], + "center_px": [ + 379.0, + 409.25 + ], + "quality": { + "area_px": 232.0, + "perimeter_px": 83.66631984710693, + "sharpness": { + "laplacian_var": 7777.418181818181 + }, + "contrast": { + "p05": 23.0, + "p95": 179.0, + "dynamic_range": 156.0, + "mean_gray": 90.14545454545454, + "std_gray": 61.52823983766041 + }, + "geometry": { + "distance_to_center_norm": 0.3617120683193207, + "distance_to_border_px": 305.0 + }, + "edge_ratio": 1.7382610728629626, + "edge_lengths_px": [ + 26.305892944335938, + 15.231546401977539, + 26.476404190063477, + 15.65247631072998 + ] + }, + "confidence": 0.08897781183808398 + } + ], + "rejected_candidates": [ + { + "image_points_px": [ + [ + 596.0, + 145.0 + ], + [ + 626.0, + 151.0 + ], + [ + 624.0, + 186.0 + ], + [ + 595.0, + 180.0 + ] + ], + "center_px": [ + 610.25, + 165.5 + ], + "area_px": 1041.5 + }, + { + "image_points_px": [ + [ + 511.0, + 586.0 + ], + [ + 477.0, + 595.0 + ], + [ + 457.0, + 584.0 + ], + [ + 489.0, + 575.0 + ] + ], + "center_px": [ + 483.5, + 585.0 + ], + "area_px": 552.0 + }, + { + "image_points_px": [ + [ + 752.0, + 466.0 + ], + [ + 780.0, + 460.0 + ], + [ + 805.0, + 469.0 + ], + [ + 777.0, + 475.0 + ] + ], + "center_px": [ + 778.5, + 467.5 + ], + "area_px": 402.0 + }, + { + "image_points_px": [ + [ + 1177.0, + 465.0 + ], + [ + 1198.0, + 459.0 + ], + [ + 1226.0, + 468.0 + ], + [ + 1205.0, + 475.0 + ] + ], + "center_px": [ + 1201.5, + 466.75 + ], + "area_px": 381.5 + }, + { + "image_points_px": [ + [ + 580.0, + 403.0 + ], + [ + 600.0, + 410.0 + ], + [ + 619.0, + 430.0 + ], + [ + 597.0, + 421.0 + ] + ], + "center_px": [ + 599.0, + 416.0 + ], + "area_px": 255.0 + }, + { + "image_points_px": [ + [ + 575.0, + 306.0 + ], + [ + 548.0, + 312.0 + ], + [ + 530.0, + 306.0 + ], + [ + 556.0, + 301.0 + ] + ], + "center_px": [ + 552.25, + 306.25 + ], + "area_px": 247.5 + }, + { + "image_points_px": [ + [ + 729.0, + 282.0 + ], + [ + 692.0, + 295.0 + ], + [ + 687.0, + 291.0 + ], + [ + 702.0, + 284.0 + ] + ], + "center_px": [ + 702.5, + 288.0 + ], + "area_px": 186.0 + }, + { + "image_points_px": [ + [ + 414.0, + 438.0 + ], + [ + 388.0, + 444.0 + ], + [ + 373.0, + 436.0 + ], + [ + 399.0, + 431.0 + ] + ], + "center_px": [ + 393.5, + 437.25 + ], + "area_px": 277.5 + }, + { + "image_points_px": [ + [ + 976.0, + 370.0 + ], + [ + 997.0, + 366.0 + ], + [ + 1016.0, + 373.0 + ], + [ + 998.0, + 377.0 + ] + ], + "center_px": [ + 996.75, + 371.5 + ], + "area_px": 218.5 + }, + { + "image_points_px": [ + [ + 1005.0, + 363.0 + ], + [ + 1026.0, + 360.0 + ], + [ + 1044.0, + 366.0 + ], + [ + 1027.0, + 371.0 + ] + ], + "center_px": [ + 1025.5, + 365.0 + ], + "area_px": 213.0 + }, + { + "image_points_px": [ + [ + 806.0, + 357.0 + ], + [ + 824.0, + 353.0 + ], + [ + 844.0, + 360.0 + ], + [ + 823.0, + 363.0 + ] + ], + "center_px": [ + 824.25, + 358.25 + ], + "area_px": 191.5 + }, + { + "image_points_px": [ + [ + 893.0, + 346.0 + ], + [ + 913.0, + 343.0 + ], + [ + 930.0, + 349.0 + ], + [ + 913.0, + 353.0 + ] + ], + "center_px": [ + 912.25, + 347.75 + ], + "area_px": 185.0 + }, + { + "image_points_px": [ + [ + 866.0, + 324.0 + ], + [ + 885.0, + 321.0 + ], + [ + 902.0, + 327.0 + ], + [ + 885.0, + 331.0 + ] + ], + "center_px": [ + 884.5, + 325.75 + ], + "area_px": 180.0 + }, + { + "image_points_px": [ + [ + 817.0, + 312.0 + ], + [ + 834.0, + 309.0 + ], + [ + 851.0, + 315.0 + ], + [ + 833.0, + 318.0 + ] + ], + "center_px": [ + 833.75, + 313.5 + ], + "area_px": 154.5 + }, + { + "image_points_px": [ + [ + 589.0, + 316.0 + ], + [ + 593.0, + 318.0 + ], + [ + 592.0, + 339.0 + ], + [ + 588.0, + 337.0 + ] + ], + "center_px": [ + 590.5, + 327.5 + ], + "area_px": 86.0 + }, + { + "image_points_px": [ + [ + 439.0, + 497.0 + ], + [ + 428.0, + 504.0 + ], + [ + 416.0, + 502.0 + ], + [ + 431.0, + 494.0 + ] + ], + "center_px": [ + 428.5, + 499.25 + ], + "area_px": 107.5 + }, + { + "image_points_px": [ + [ + 602.0, + 319.0 + ], + [ + 606.0, + 321.0 + ], + [ + 606.0, + 341.0 + ], + [ + 601.0, + 340.0 + ] + ], + "center_px": [ + 603.75, + 330.25 + ], + "area_px": 93.0 + }, + { + "image_points_px": [ + [ + 1243.0, + 567.0 + ], + [ + 1226.0, + 575.0 + ], + [ + 1220.0, + 572.0 + ], + [ + 1234.0, + 565.0 + ] + ], + "center_px": [ + 1230.75, + 569.75 + ], + "area_px": 95.0 + }, + { + "image_points_px": [ + [ + 687.0, + 133.0 + ], + [ + 688.0, + 150.0 + ], + [ + 685.0, + 155.0 + ], + [ + 684.0, + 136.0 + ] + ], + "center_px": [ + 686.0, + 143.5 + ], + "area_px": 58.0 + } + ] +} \ No newline at end of file diff --git a/data/evaluations/Scene8/render_e_camera_pose.json b/data/evaluations/Scene8/render_e_camera_pose.json new file mode 100644 index 0000000..51752fa --- /dev/null +++ b/data/evaluations/Scene8/render_e_camera_pose.json @@ -0,0 +1,537 @@ +{ + "schema_version": "1.0", + "created_utc": "2026-06-01T18:36:48Z", + "source": { + "detection_json": "C:\\Users\\kech\\SynologyDrive\\2026-AppServer-AppRobot\\appRobotRendering\\data\\evaluations\\Scene8\\render_e_aruco_detection.json", + "robot_json": "C:\\Users\\kech\\SynologyDrive\\2026-AppServer-AppRobot\\appRobotRendering\\data\\robot\\robot.json" + }, + "camera": { + "camera_id": "e", + "camera_matrix": [ + [ + 1777.77783203125, + 0.0, + 640.0 + ], + [ + 0.0, + 1777.77783203125, + 360.0 + ], + [ + 0.0, + 0.0, + 1.0 + ] + ], + "distortion_coefficients": [ + 0.0, + 0.0, + 0.0, + 0.0, + 0.0 + ] + }, + "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": 24, + "used_marker_ids": [ + 92, + 217, + 85, + 105, + 206, + 97, + 47, + 96, + 62, + 66, + 79, + 55, + 214, + 51, + 72, + 95, + 103, + 60, + 69, + 215, + 211, + 84, + 86, + 64 + ], + "history": { + "iters": [ + 0, + 1, + 2, + 3 + ], + "rms": [ + 0.00630902936296045, + 0.0003503162776966026, + 0.00021566918101323604, + 0.00021566812595044202 + ], + "lambda": [ + 0.001, + 0.0005, + 0.00025, + 0.000125 + ] + }, + "residual_rms_px": 0.5422246805563434, + "residual_median_px": 0.3729435356233405, + "residual_max_px": 1.156746455284857, + "sigma2_normalized": 5.315741777237922e-08 + }, + "camera_pose": { + "world_to_camera": { + "rotation_matrix": [ + [ + 0.628989577293396, + 0.7774136662483215, + 0.0003507443470880389 + ], + [ + 0.20666556060314178, + -0.1667739301919937, + -0.9640932679176331 + ], + [ + -0.7494407892227173, + 0.6064770817756653, + -0.2655636966228485 + ] + ], + "translation_m": [ + -0.0547354631125927, + -0.012683164328336716, + 1.5506757497787476 + ], + "rvec_rad": [ + 1.7014036416595382, + 0.8122514235119389, + -0.618293153268835 + ] + }, + "camera_in_world": { + "position_m": [ + 1.1991888284683228, + -0.9000124335289001, + 0.39959463477134705 + ], + "position_mm": [ + 1199.1888427734375, + -900.012451171875, + 399.5946350097656 + ], + "orientation_deg": { + "roll": 113.6476058959961, + "pitch": 48.54195785522461, + "yaw": 18.188844680786133 + } + }, + "uncertainty": { + "pose_covariance_6x6": [ + [ + 1.5485173782981606e-07, + 1.851377328432404e-08, + 2.8229623479655052e-08, + -7.317051195299001e-09, + -4.280031938579823e-08, + 1.8275230708455525e-08 + ], + [ + 1.8513773284323837e-08, + 1.0380973901699848e-07, + -5.469400592592144e-09, + 2.6108967750081833e-08, + -2.4877532375984845e-08, + 1.3731464588840119e-08 + ], + [ + 2.8229623479655505e-08, + -5.469400592592516e-09, + 1.8802524747108885e-07, + -3.206860716836395e-08, + -2.6161782348223145e-08, + -6.56867737643066e-09 + ], + [ + -7.31705119529937e-09, + 2.6108967750082253e-08, + -3.206860716836374e-08, + 1.5545230996657885e-08, + 5.669806552012708e-10, + 1.0393580529714659e-08 + ], + [ + -4.280031938579823e-08, + -2.4877532375984858e-08, + -2.61617823482231e-08, + 5.669806552012895e-10, + 2.2136595117839976e-08, + 4.531501344506167e-09 + ], + [ + 1.82752307084554e-08, + 1.3731464588840142e-08, + -6.568677376430668e-09, + 1.0393580529714648e-08, + 4.531501344506207e-09, + 1.1521125853314904e-07 + ] + ], + "parameter_std": { + "rvec_std_deg": [ + 0.022546579968103234, + 0.018460424438188426, + 0.024844526084444037 + ], + "tvec_std_m": [ + 0.0001246805157057745, + 0.00014878371926336557, + 0.0003394278399500386 + ] + }, + "camera_center_std_m": [ + 0.0003545857525229363, + 0.0004070677011541022, + 0.0004736036839720404 + ], + "camera_center_std_mm": [ + 0.3545857525229363, + 0.40706770115410223, + 0.47360368397204045 + ], + "orientation_std_deg": { + "roll": 0.03250044077834975, + "pitch": 0.021578780424367262, + "yaw": 0.027073158674549694 + } + } + }, + "observations": { + "markers": [ + { + "marker_id": 92, + "observed_center_px": [ + 1023.0, + 688.5 + ], + "projected_center_px": [ + 1022.9679565429688, + 688.4140625 + ], + "reprojection_error_px": 0.09171715785371658, + "confidence": 0.15369374989294518 + }, + { + "marker_id": 217, + "observed_center_px": [ + 1141.25, + 600.5 + ], + "projected_center_px": [ + 1140.6944580078125, + 600.3023071289062 + ], + "reprojection_error_px": 0.5896688700999455, + "confidence": 0.3233651345714012 + }, + { + "marker_id": 85, + "observed_center_px": [ + 675.25, + 665.5 + ], + "projected_center_px": [ + 675.0033569335938, + 665.3787231445312 + ], + "reprojection_error_px": 0.2748470081311891, + "confidence": 0.37089318871684795 + }, + { + "marker_id": 105, + "observed_center_px": [ + 760.5, + 654.75 + ], + "projected_center_px": [ + 761.2002563476562, + 655.0924682617188 + ], + "reprojection_error_px": 0.7795148893494807, + "confidence": 0.420622587927407 + }, + { + "marker_id": 206, + "observed_center_px": [ + 1223.0, + 567.0 + ], + "projected_center_px": [ + 1222.284423828125, + 566.8446044921875 + ], + "reprojection_error_px": 0.7322547518477325, + "confidence": 0.14078817554935588 + }, + { + "marker_id": 97, + "observed_center_px": [ + 411.0, + 578.0 + ], + "projected_center_px": [ + 411.44232177734375, + 578.3140869140625 + ], + "reprojection_error_px": 0.5424934509262193, + "confidence": 0.22596816505744277 + }, + { + "marker_id": 47, + "observed_center_px": [ + 543.75, + 569.25 + ], + "projected_center_px": [ + 543.7235107421875, + 569.2677612304688 + ], + "reprojection_error_px": 0.03189266510063318, + "confidence": 0.24626971873720385 + }, + { + "marker_id": 96, + "observed_center_px": [ + 690.0, + 544.25 + ], + "projected_center_px": [ + 690.022705078125, + 544.456298828125 + ], + "reprojection_error_px": 0.20754451825671197, + "confidence": 0.28140192555287236 + }, + { + "marker_id": 62, + "observed_center_px": [ + 738.5, + 556.0 + ], + "projected_center_px": [ + 738.579833984375, + 555.78564453125 + ], + "reprojection_error_px": 0.2287394413830286, + "confidence": 0.2664122029520185 + }, + { + "marker_id": 66, + "observed_center_px": [ + 331.25, + 537.25 + ], + "projected_center_px": [ + 330.9709777832031, + 537.0518798828125 + ], + "reprojection_error_px": 0.34220604655767123, + "confidence": 0.16725963004706537 + }, + { + "marker_id": 79, + "observed_center_px": [ + 666.75, + 511.75 + ], + "projected_center_px": [ + 666.0632934570312, + 511.67083740234375 + ], + "reprojection_error_px": 0.691254362028752, + "confidence": 0.21195569262290176 + }, + { + "marker_id": 55, + "observed_center_px": [ + 519.5, + 534.0 + ], + "projected_center_px": [ + 519.4553833007812, + 533.9685668945312 + ], + "reprojection_error_px": 0.05457737597746861, + "confidence": 0.22298824455832925 + }, + { + "marker_id": 214, + "observed_center_px": [ + 858.0, + 444.5 + ], + "projected_center_px": [ + 858.559814453125, + 444.61431884765625 + ], + "reprojection_error_px": 0.571367675719493, + "confidence": 0.1697872859143744 + }, + { + "marker_id": 51, + "observed_center_px": [ + 529.25, + 463.25 + ], + "projected_center_px": [ + 528.9022827148438, + 463.1120910644531 + ], + "reprojection_error_px": 0.37406708609566947, + "confidence": 0.12157403976480062 + }, + { + "marker_id": 72, + "observed_center_px": [ + 1132.75, + 455.25 + ], + "projected_center_px": [ + 1133.8419189453125, + 455.6318054199219 + ], + "reprojection_error_px": 1.156746455284857, + "confidence": 0.14675484287524884 + }, + { + "marker_id": 95, + "observed_center_px": [ + 425.25, + 498.75 + ], + "projected_center_px": [ + 425.9288635253906, + 498.8289794921875 + ], + "reprojection_error_px": 0.6834423503793009, + "confidence": 0.14922985097126407 + }, + { + "marker_id": 103, + "observed_center_px": [ + 465.0, + 447.0 + ], + "projected_center_px": [ + 465.22216796875, + 446.9941101074219 + ], + "reprojection_error_px": 0.22224602847538769, + "confidence": 0.10609680160172753 + }, + { + "marker_id": 60, + "observed_center_px": [ + 1195.75, + 431.0 + ], + "projected_center_px": [ + 1195.7926025390625, + 430.972900390625 + ], + "reprojection_error_px": 0.05049123847609035, + "confidence": 0.1208904643109979 + }, + { + "marker_id": 69, + "observed_center_px": [ + 295.5, + 440.25 + ], + "projected_center_px": [ + 294.4291687011719, + 439.9130554199219 + ], + "reprojection_error_px": 1.1225913417597488, + "confidence": 0.08927835602899967 + }, + { + "marker_id": 215, + "observed_center_px": [ + 683.75, + 432.75 + ], + "projected_center_px": [ + 684.21142578125, + 432.9552917480469 + ], + "reprojection_error_px": 0.5050331211102045, + "confidence": 0.09972560457674447 + }, + { + "marker_id": 211, + "observed_center_px": [ + 763.75, + 413.0 + ], + "projected_center_px": [ + 764.0985107421875, + 412.87042236328125 + ], + "reprojection_error_px": 0.37181998515101156, + "confidence": 0.13332463075982282 + }, + { + "marker_id": 84, + "observed_center_px": [ + 1147.5, + 429.0 + ], + "projected_center_px": [ + 1147.703125, + 429.0707092285156 + ], + "reprojection_error_px": 0.21508035852275045, + "confidence": 0.13255097071329755 + }, + { + "marker_id": 86, + "observed_center_px": [ + 1127.25, + 408.75 + ], + "projected_center_px": [ + 1126.677978515625, + 408.52398681640625 + ], + "reprojection_error_px": 0.6150532804113482, + "confidence": 0.11774828338549573 + }, + { + "marker_id": 64, + "observed_center_px": [ + 379.0, + 409.25 + ], + "projected_center_px": [ + 378.81402587890625, + 409.4864501953125 + ], + "reprojection_error_px": 0.3008239827206471, + "confidence": 0.08897781183808398 + } + ] + }, + "qa": { + "sanity_notes": [] + } +} \ No newline at end of file diff --git a/data/evaluations/Scene8/render_e_camera_pose_v8.json b/data/evaluations/Scene8/render_e_camera_pose_v8.json new file mode 100644 index 0000000..f62d7f8 --- /dev/null +++ b/data/evaluations/Scene8/render_e_camera_pose_v8.json @@ -0,0 +1,538 @@ +{ + "schema_version": "1.0", + "created_utc": "2026-06-01T18:37:02Z", + "source": { + "detection_json": "C:\\Users\\kech\\SynologyDrive\\2026-AppServer-AppRobot\\appRobotRendering\\data\\evaluations\\Scene8\\render_e_aruco_detection.json", + "robot_json": "C:\\Users\\kech\\SynologyDrive\\2026-AppServer-AppRobot\\appRobotRendering\\data\\robot\\robot.json" + }, + "camera": { + "camera_id": "e", + "camera_matrix": [ + [ + 1777.77783203125, + 0.0, + 640.0 + ], + [ + 0.0, + 1777.77783203125, + 360.0 + ], + [ + 0.0, + 0.0, + 1.0 + ] + ], + "distortion_coefficients": [ + 0.0, + 0.0, + 0.0, + 0.0, + 0.0 + ] + }, + "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": 24, + "used_marker_ids": [ + 92, + 217, + 85, + 105, + 206, + 97, + 47, + 96, + 62, + 66, + 79, + 55, + 214, + 51, + 72, + 95, + 103, + 60, + 69, + 215, + 211, + 84, + 86, + 64 + ], + "history": { + "iters": [ + 0, + 1, + 2, + 3 + ], + "rms": [ + 0.00630902936296045, + 0.0003503162776966026, + 0.00021566918101323604, + 0.00021566812595044202 + ], + "lambda": [ + 0.001, + 0.0005, + 0.00025, + 0.000125 + ] + }, + "residual_rms_px": 0.5422246805563434, + "residual_median_px": 0.3729435356233405, + "residual_max_px": 1.156746455284857, + "sigma2_normalized": 5.315741777237922e-08 + }, + "camera_pose": { + "world_to_camera": { + "rotation_matrix": [ + [ + 0.628989577293396, + 0.7774136662483215, + 0.0003507443470880389 + ], + [ + 0.20666556060314178, + -0.1667739301919937, + -0.9640932679176331 + ], + [ + -0.7494407892227173, + 0.6064770817756653, + -0.2655636966228485 + ] + ], + "translation_m": [ + -0.054739404446346465, + -0.00193165140267135, + 1.553637337519755 + ], + "rvec_rad": [ + 1.7014036416595382, + 0.8122514235119389, + -0.618293153268835 + ] + }, + "camera_in_world": { + "position_m": [ + 1.1991888668149988, + -0.9000124276162538, + 0.41074656465263126 + ], + "position_mm": [ + 1199.1888668149988, + -900.0124276162537, + 410.74656465263126 + ], + "orientation_deg": { + "roll": 113.6476058959961, + "pitch": 48.54195785522461, + "yaw": 18.188844680786133 + } + }, + "uncertainty": { + "pose_covariance_6x6": [ + [ + 1.5485173782981606e-07, + 1.851377328432404e-08, + 2.8229623479655052e-08, + -7.317051195299001e-09, + -4.280031938579823e-08, + 1.8275230708455525e-08 + ], + [ + 1.8513773284323837e-08, + 1.0380973901699848e-07, + -5.469400592592144e-09, + 2.6108967750081833e-08, + -2.4877532375984845e-08, + 1.3731464588840119e-08 + ], + [ + 2.8229623479655505e-08, + -5.469400592592516e-09, + 1.8802524747108885e-07, + -3.206860716836395e-08, + -2.6161782348223145e-08, + -6.56867737643066e-09 + ], + [ + -7.31705119529937e-09, + 2.6108967750082253e-08, + -3.206860716836374e-08, + 1.5545230996657885e-08, + 5.669806552012708e-10, + 1.0393580529714659e-08 + ], + [ + -4.280031938579823e-08, + -2.4877532375984858e-08, + -2.61617823482231e-08, + 5.669806552012895e-10, + 2.2136595117839976e-08, + 4.531501344506167e-09 + ], + [ + 1.82752307084554e-08, + 1.3731464588840142e-08, + -6.568677376430668e-09, + 1.0393580529714648e-08, + 4.531501344506207e-09, + 1.1521125853314904e-07 + ] + ], + "parameter_std": { + "rvec_std_deg": [ + 0.022546579968103234, + 0.018460424438188426, + 0.024844526084444037 + ], + "tvec_std_m": [ + 0.0001246805157057745, + 0.00014878371926336557, + 0.0003394278399500386 + ] + }, + "camera_center_std_m": [ + 0.0003545857525229363, + 0.0004070677011541022, + 0.0004736036839720404 + ], + "camera_center_std_mm": [ + 0.3545857525229363, + 0.40706770115410223, + 0.47360368397204045 + ], + "orientation_std_deg": { + "roll": 0.03250044077834975, + "pitch": 0.021578780424367262, + "yaw": 0.027073158674549694 + } + } + }, + "observations": { + "markers": [ + { + "marker_id": 92, + "observed_center_px": [ + 1023.0, + 688.5 + ], + "projected_center_px": [ + 1022.9679565429688, + 688.4140625 + ], + "reprojection_error_px": 0.09171715785371658, + "confidence": 0.15369374989294518 + }, + { + "marker_id": 217, + "observed_center_px": [ + 1141.25, + 600.5 + ], + "projected_center_px": [ + 1140.6944580078125, + 600.3023071289062 + ], + "reprojection_error_px": 0.5896688700999455, + "confidence": 0.3233651345714012 + }, + { + "marker_id": 85, + "observed_center_px": [ + 675.25, + 665.5 + ], + "projected_center_px": [ + 675.0033569335938, + 665.3787231445312 + ], + "reprojection_error_px": 0.2748470081311891, + "confidence": 0.37089318871684795 + }, + { + "marker_id": 105, + "observed_center_px": [ + 760.5, + 654.75 + ], + "projected_center_px": [ + 761.2002563476562, + 655.0924682617188 + ], + "reprojection_error_px": 0.7795148893494807, + "confidence": 0.420622587927407 + }, + { + "marker_id": 206, + "observed_center_px": [ + 1223.0, + 567.0 + ], + "projected_center_px": [ + 1222.284423828125, + 566.8446044921875 + ], + "reprojection_error_px": 0.7322547518477325, + "confidence": 0.14078817554935588 + }, + { + "marker_id": 97, + "observed_center_px": [ + 411.0, + 578.0 + ], + "projected_center_px": [ + 411.44232177734375, + 578.3140869140625 + ], + "reprojection_error_px": 0.5424934509262193, + "confidence": 0.22596816505744277 + }, + { + "marker_id": 47, + "observed_center_px": [ + 543.75, + 569.25 + ], + "projected_center_px": [ + 543.7235107421875, + 569.2677612304688 + ], + "reprojection_error_px": 0.03189266510063318, + "confidence": 0.24626971873720385 + }, + { + "marker_id": 96, + "observed_center_px": [ + 690.0, + 544.25 + ], + "projected_center_px": [ + 690.022705078125, + 544.456298828125 + ], + "reprojection_error_px": 0.20754451825671197, + "confidence": 0.28140192555287236 + }, + { + "marker_id": 62, + "observed_center_px": [ + 738.5, + 556.0 + ], + "projected_center_px": [ + 738.579833984375, + 555.78564453125 + ], + "reprojection_error_px": 0.2287394413830286, + "confidence": 0.2664122029520185 + }, + { + "marker_id": 66, + "observed_center_px": [ + 331.25, + 537.25 + ], + "projected_center_px": [ + 330.9709777832031, + 537.0518798828125 + ], + "reprojection_error_px": 0.34220604655767123, + "confidence": 0.16725963004706537 + }, + { + "marker_id": 79, + "observed_center_px": [ + 666.75, + 511.75 + ], + "projected_center_px": [ + 666.0632934570312, + 511.67083740234375 + ], + "reprojection_error_px": 0.691254362028752, + "confidence": 0.21195569262290176 + }, + { + "marker_id": 55, + "observed_center_px": [ + 519.5, + 534.0 + ], + "projected_center_px": [ + 519.4553833007812, + 533.9685668945312 + ], + "reprojection_error_px": 0.05457737597746861, + "confidence": 0.22298824455832925 + }, + { + "marker_id": 214, + "observed_center_px": [ + 858.0, + 444.5 + ], + "projected_center_px": [ + 858.559814453125, + 444.61431884765625 + ], + "reprojection_error_px": 0.571367675719493, + "confidence": 0.1697872859143744 + }, + { + "marker_id": 51, + "observed_center_px": [ + 529.25, + 463.25 + ], + "projected_center_px": [ + 528.9022827148438, + 463.1120910644531 + ], + "reprojection_error_px": 0.37406708609566947, + "confidence": 0.12157403976480062 + }, + { + "marker_id": 72, + "observed_center_px": [ + 1132.75, + 455.25 + ], + "projected_center_px": [ + 1133.8419189453125, + 455.6318054199219 + ], + "reprojection_error_px": 1.156746455284857, + "confidence": 0.14675484287524884 + }, + { + "marker_id": 95, + "observed_center_px": [ + 425.25, + 498.75 + ], + "projected_center_px": [ + 425.9288635253906, + 498.8289794921875 + ], + "reprojection_error_px": 0.6834423503793009, + "confidence": 0.14922985097126407 + }, + { + "marker_id": 103, + "observed_center_px": [ + 465.0, + 447.0 + ], + "projected_center_px": [ + 465.22216796875, + 446.9941101074219 + ], + "reprojection_error_px": 0.22224602847538769, + "confidence": 0.10609680160172753 + }, + { + "marker_id": 60, + "observed_center_px": [ + 1195.75, + 431.0 + ], + "projected_center_px": [ + 1195.7926025390625, + 430.972900390625 + ], + "reprojection_error_px": 0.05049123847609035, + "confidence": 0.1208904643109979 + }, + { + "marker_id": 69, + "observed_center_px": [ + 295.5, + 440.25 + ], + "projected_center_px": [ + 294.4291687011719, + 439.9130554199219 + ], + "reprojection_error_px": 1.1225913417597488, + "confidence": 0.08927835602899967 + }, + { + "marker_id": 215, + "observed_center_px": [ + 683.75, + 432.75 + ], + "projected_center_px": [ + 684.21142578125, + 432.9552917480469 + ], + "reprojection_error_px": 0.5050331211102045, + "confidence": 0.09972560457674447 + }, + { + "marker_id": 211, + "observed_center_px": [ + 763.75, + 413.0 + ], + "projected_center_px": [ + 764.0985107421875, + 412.87042236328125 + ], + "reprojection_error_px": 0.37181998515101156, + "confidence": 0.13332463075982282 + }, + { + "marker_id": 84, + "observed_center_px": [ + 1147.5, + 429.0 + ], + "projected_center_px": [ + 1147.703125, + 429.0707092285156 + ], + "reprojection_error_px": 0.21508035852275045, + "confidence": 0.13255097071329755 + }, + { + "marker_id": 86, + "observed_center_px": [ + 1127.25, + 408.75 + ], + "projected_center_px": [ + 1126.677978515625, + 408.52398681640625 + ], + "reprojection_error_px": 0.6150532804113482, + "confidence": 0.11774828338549573 + }, + { + "marker_id": 64, + "observed_center_px": [ + 379.0, + 409.25 + ], + "projected_center_px": [ + 378.81402587890625, + 409.4864501953125 + ], + "reprojection_error_px": 0.3008239827206471, + "confidence": 0.08897781183808398 + } + ] + }, + "qa": { + "sanity_notes": [] + }, + "v8_z_correction_mm": 11.151935468550299 +} \ No newline at end of file diff --git a/data/evaluations/Scene8/render_f_aruco_detection.json b/data/evaluations/Scene8/render_f_aruco_detection.json new file mode 100644 index 0000000..0ac8db4 --- /dev/null +++ b/data/evaluations/Scene8/render_f_aruco_detection.json @@ -0,0 +1,1892 @@ +{ + "schema_version": "1.0", + "created_utc": "2026-06-01T18:36:45Z", + "vision_config": { + "MarkerType": "DICT_4X4_250", + "MarkerSize": 0.025 + }, + "camera": { + "camera_id": "f", + "intrinsics_file": "C:\\Users\\kech\\SynologyDrive\\2026-AppServer-AppRobot\\appRobotRendering\\data\\simulation\\Scene8\\render_a.npz", + "camera_matrix": [ + [ + 1777.77783203125, + 0.0, + 640.0 + ], + [ + 0.0, + 1777.77783203125, + 360.0 + ], + [ + 0.0, + 0.0, + 1.0 + ] + ], + "distortion_coefficients": [ + 0.0, + 0.0, + 0.0, + 0.0, + 0.0 + ] + }, + "image": { + "image_file": "C:\\Users\\kech\\SynologyDrive\\2026-AppServer-AppRobot\\appRobotRendering\\data\\simulation\\Scene8\\render_f.png", + "image_sha256": "22f539260c8b9f5d0b7606b6a5ebf48769cf3a73b110b258c3234fe43600be8c", + "width_px": 1280, + "height_px": 720 + }, + "aruco": { + "dictionary": "DICT_4X4_250", + "num_detected_markers": 29, + "num_rejected_candidates": 11 + }, + "detections": [ + { + "observation_id": "b712b167-9399-429e-9fbb-028e93448213", + "type": "aruco", + "marker_id": 41, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 756.0, + 327.0 + ], + [ + 784.0, + 353.0 + ], + [ + 761.0, + 382.0 + ], + [ + 734.0, + 356.0 + ] + ], + "center_px": [ + 758.75, + 354.5 + ], + "quality": { + "area_px": 1382.5, + "perimeter_px": 149.10733795166016, + "sharpness": { + "laplacian_var": 2706.351212856978 + }, + "contrast": { + "p05": 40.0, + "p95": 187.0, + "dynamic_range": 147.0, + "mean_gray": 79.24301075268818, + "std_gray": 58.06111981305666 + }, + "geometry": { + "distance_to_center_norm": 0.16189147531986237, + "distance_to_border_px": 327.0 + }, + "edge_ratio": 1.0497078971212677, + "edge_lengths_px": [ + 38.20994567871094, + 37.013511657714844, + 37.48332977294922, + 36.400550842285156 + ] + }, + "confidence": 0.8780220375537395 + }, + { + "observation_id": "c7b61b37-3b92-448d-b73b-686546b51c21", + "type": "aruco", + "marker_id": 43, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 678.0, + 336.0 + ], + [ + 704.0, + 322.0 + ], + [ + 723.0, + 357.0 + ], + [ + 698.0, + 371.0 + ] + ], + "center_px": [ + 700.75, + 346.5 + ], + "quality": { + "area_px": 1165.5, + "perimeter_px": 138.31864547729492, + "sharpness": { + "laplacian_var": 1286.8501585124218 + }, + "contrast": { + "p05": 8.0, + "p95": 132.0, + "dynamic_range": 124.0, + "mean_gray": 49.648148148148145, + "std_gray": 49.89362415317758 + }, + "geometry": { + "distance_to_center_norm": 0.0847497284412384, + "distance_to_border_px": 322.0 + }, + "edge_ratio": 1.4068736343378838, + "edge_lengths_px": [ + 29.529645919799805, + 39.824615478515625, + 28.65309715270996, + 40.31128692626953 + ] + }, + "confidence": 0.5522884081665793 + }, + { + "observation_id": "f3345dae-f366-47d3-a1a6-328a0f50bce7", + "type": "aruco", + "marker_id": 198, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 814.0, + 264.0 + ], + [ + 824.0, + 292.0 + ], + [ + 794.0, + 301.0 + ], + [ + 784.0, + 273.0 + ] + ], + "center_px": [ + 804.0, + 282.5 + ], + "quality": { + "area_px": 930.0, + "perimeter_px": 122.10611343383789, + "sharpness": { + "laplacian_var": 3845.15728872323 + }, + "contrast": { + "p05": 26.0, + "p95": 180.0, + "dynamic_range": 154.0, + "mean_gray": 87.71341463414635, + "std_gray": 66.61273364351763 + }, + "geometry": { + "distance_to_center_norm": 0.24702326953411102, + "distance_to_border_px": 264.0 + }, + "edge_ratio": 1.0534364993835403, + "edge_lengths_px": [ + 29.73213768005371, + 31.320919036865234, + 29.73213768005371, + 31.320919036865234 + ] + }, + "confidence": 0.5885499509109636 + }, + { + "observation_id": "d2970c67-7d5f-4f38-87e0-1f34619bac1a", + "type": "aruco", + "marker_id": 46, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 1214.0, + 656.0 + ], + [ + 1242.0, + 647.0 + ], + [ + 1254.0, + 676.0 + ], + [ + 1226.0, + 685.0 + ] + ], + "center_px": [ + 1234.0, + 666.0 + ], + "quality": { + "area_px": 920.0, + "perimeter_px": 121.5911865234375, + "sharpness": { + "laplacian_var": 2716.906776310776 + }, + "contrast": { + "p05": 10.0, + "p95": 156.0, + "dynamic_range": 146.0, + "mean_gray": 79.70524691358025, + "std_gray": 64.75557917429427 + }, + "geometry": { + "distance_to_center_norm": 0.9099597334861755, + "distance_to_border_px": 26.0 + }, + "edge_ratio": 1.0671121423123415, + "edge_lengths_px": [ + 29.4108829498291, + 31.38471031188965, + 29.4108829498291, + 31.38471031188965 + ] + }, + "confidence": 0.2988751797371847 + }, + { + "observation_id": "a7a45b3d-b66b-42ba-8672-829f268e71ee", + "type": "aruco", + "marker_id": 56, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 1176.0, + 617.0 + ], + [ + 1204.0, + 608.0 + ], + [ + 1216.0, + 636.0 + ], + [ + 1188.0, + 646.0 + ] + ], + "center_px": [ + 1196.0, + 626.75 + ], + "quality": { + "area_px": 912.0, + "perimeter_px": 120.99082374572754, + "sharpness": { + "laplacian_var": 2157.4083981100443 + }, + "contrast": { + "p05": 10.0, + "p95": 157.0, + "dynamic_range": 147.0, + "mean_gray": 46.45524691358025, + "std_gray": 56.10872797690166 + }, + "geometry": { + "distance_to_center_norm": 0.8398146033287048, + "distance_to_border_px": 64.0 + }, + "edge_ratio": 1.0671121423123415, + "edge_lengths_px": [ + 29.4108829498291, + 30.463092803955078, + 29.73213768005371, + 31.38471031188965 + ] + }, + "confidence": 0.5697620483284124 + }, + { + "observation_id": "aa95dda5-6cee-4376-b0c8-f060bf54e470", + "type": "aruco", + "marker_id": 208, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 840.0, + 529.0 + ], + [ + 851.0, + 557.0 + ], + [ + 822.0, + 567.0 + ], + [ + 812.0, + 538.0 + ] + ], + "center_px": [ + 831.25, + 547.75 + ], + "quality": { + "area_px": 912.0, + "perimeter_px": 120.84554862976074, + "sharpness": { + "laplacian_var": 1980.4954615147337 + }, + "contrast": { + "p05": 13.0, + "p95": 151.0, + "dynamic_range": 138.0, + "mean_gray": 58.381024096385545, + "std_gray": 56.92338701546731 + }, + "geometry": { + "distance_to_center_norm": 0.3649789094924927, + "distance_to_border_px": 153.0 + }, + "edge_ratio": 1.043005886014016, + "edge_lengths_px": [ + 30.08321762084961, + 30.675724029541016, + 30.675724029541016, + 29.4108829498291 + ] + }, + "confidence": 0.5829305549976826 + }, + { + "observation_id": "16ec1580-1268-4ed8-bbe5-0d3490a2f676", + "type": "aruco", + "marker_id": 47, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 575.0, + 614.0 + ], + [ + 603.0, + 605.0 + ], + [ + 613.0, + 633.0 + ], + [ + 584.0, + 643.0 + ] + ], + "center_px": [ + 593.75, + 623.75 + ], + "quality": { + "area_px": 902.5, + "perimeter_px": 120.18319702148438, + "sharpness": { + "laplacian_var": 2746.4251695243124 + }, + "contrast": { + "p05": 32.0, + "p95": 177.0, + "dynamic_range": 145.0, + "mean_gray": 80.67427701674276, + "std_gray": 61.606650979200566 + }, + "geometry": { + "distance_to_center_norm": 0.3646650016307831, + "distance_to_border_px": 77.0 + }, + "edge_ratio": 1.043005886014016, + "edge_lengths_px": [ + 29.4108829498291, + 29.73213768005371, + 30.675724029541016, + 30.364452362060547 + ] + }, + "confidence": 0.5768583617164568 + }, + { + "observation_id": "5799d2e4-a82a-4f48-9b85-f92408560b8d", + "type": "aruco", + "marker_id": 62, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 732.0, + 642.0 + ], + [ + 760.0, + 633.0 + ], + [ + 770.0, + 661.0 + ], + [ + 742.0, + 671.0 + ] + ], + "center_px": [ + 751.0, + 651.75 + ], + "quality": { + "area_px": 893.0, + "perimeter_px": 119.55088233947754, + "sharpness": { + "laplacian_var": 1932.8056317634505 + }, + "contrast": { + "p05": 24.0, + "p95": 173.0, + "dynamic_range": 149.0, + "mean_gray": 47.99691358024691, + "std_gray": 48.87300868708959 + }, + "geometry": { + "distance_to_center_norm": 0.42510050535202026, + "distance_to_border_px": 49.0 + }, + "edge_ratio": 1.043005886014016, + "edge_lengths_px": [ + 29.4108829498291, + 29.73213768005371, + 29.73213768005371, + 30.675724029541016 + ] + }, + "confidence": 0.5593704450665263 + }, + { + "observation_id": "49131669-2c66-4a7a-b4f0-f87dea111c35", + "type": "aruco", + "marker_id": 54, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 522.0, + 629.0 + ], + [ + 550.0, + 620.0 + ], + [ + 559.0, + 649.0 + ], + [ + 531.0, + 658.0 + ] + ], + "center_px": [ + 540.5, + 639.0 + ], + "quality": { + "area_px": 893.0, + "perimeter_px": 119.5506706237793, + "sharpness": { + "laplacian_var": 2061.987266386131 + }, + "contrast": { + "p05": 35.0, + "p95": 178.0, + "dynamic_range": 143.0, + "mean_gray": 64.78627145085804, + "std_gray": 51.990814609184824 + }, + "geometry": { + "distance_to_center_norm": 0.4033917188644409, + "distance_to_border_px": 62.0 + }, + "edge_ratio": 1.032422332027845, + "edge_lengths_px": [ + 29.4108829498291, + 30.364452362060547, + 29.4108829498291, + 30.364452362060547 + ] + }, + "confidence": 0.5766374039623903 + }, + { + "observation_id": "e4526f85-4a9a-4ab7-8192-18929fe53fe2", + "type": "aruco", + "marker_id": 53, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 1221.0, + 585.0 + ], + [ + 1248.0, + 576.0 + ], + [ + 1260.0, + 604.0 + ], + [ + 1233.0, + 614.0 + ] + ], + "center_px": [ + 1240.5, + 594.75 + ], + "quality": { + "area_px": 883.5, + "perimeter_px": 119.10066223144531, + "sharpness": { + "laplacian_var": 2908.917577102329 + }, + "contrast": { + "p05": 10.0, + "p95": 159.0, + "dynamic_range": 149.0, + "mean_gray": 86.50704225352112, + "std_gray": 66.04801826875524 + }, + "geometry": { + "distance_to_center_norm": 0.8780498504638672, + "distance_to_border_px": 20.0 + }, + "edge_ratio": 1.102746319437901, + "edge_lengths_px": [ + 28.460498809814453, + 30.463092803955078, + 28.792360305786133, + 31.38471031188965 + ] + }, + "confidence": 0.21364841201201337 + }, + { + "observation_id": "9e41c488-6730-40c5-9dd6-c794f406be97", + "type": "aruco", + "marker_id": 97, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 473.0, + 596.0 + ], + [ + 501.0, + 586.0 + ], + [ + 510.0, + 615.0 + ], + [ + 482.0, + 624.0 + ] + ], + "center_px": [ + 491.5, + 605.25 + ], + "quality": { + "area_px": 883.5, + "perimeter_px": 118.91835594177246, + "sharpness": { + "laplacian_var": 2665.2899598667254 + }, + "contrast": { + "p05": 39.0, + "p95": 180.0, + "dynamic_range": 141.0, + "mean_gray": 104.56474258970358, + "std_gray": 63.949443311234035 + }, + "geometry": { + "distance_to_center_norm": 0.3904455602169037, + "distance_to_border_px": 96.0 + }, + "edge_ratio": 1.032422332027845, + "edge_lengths_px": [ + 29.73213768005371, + 30.364452362060547, + 29.4108829498291, + 29.4108829498291 + ] + }, + "confidence": 0.5705029634947052 + }, + { + "observation_id": "7d6778b5-2fd1-492a-b0e0-81ba5437addf", + "type": "aruco", + "marker_id": 72, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 1178.0, + 539.0 + ], + [ + 1206.0, + 530.0 + ], + [ + 1217.0, + 558.0 + ], + [ + 1190.0, + 567.0 + ] + ], + "center_px": [ + 1197.75, + 548.5 + ], + "quality": { + "area_px": 873.5, + "perimeter_px": 118.41769218444824, + "sharpness": { + "laplacian_var": 2215.910202154405 + }, + "contrast": { + "p05": 10.0, + "p95": 159.0, + "dynamic_range": 149.0, + "mean_gray": 53.79556259904913, + "std_gray": 60.25169905180765 + }, + "geometry": { + "distance_to_center_norm": 0.8017706871032715, + "distance_to_border_px": 63.0 + }, + "edge_ratio": 1.0703639808818122, + "edge_lengths_px": [ + 29.4108829498291, + 30.08321762084961, + 28.460498809814453, + 30.463092803955078 + ] + }, + "confidence": 0.5440516905787338 + }, + { + "observation_id": "1693abd9-4459-4484-a09c-3783190c2fc1", + "type": "aruco", + "marker_id": 55, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 580.0, + 534.0 + ], + [ + 608.0, + 524.0 + ], + [ + 618.0, + 552.0 + ], + [ + 589.0, + 561.0 + ] + ], + "center_px": [ + 598.75, + 542.75 + ], + "quality": { + "area_px": 874.0, + "perimeter_px": 118.28922653198242, + "sharpness": { + "laplacian_var": 2668.284110619458 + }, + "contrast": { + "p05": 34.0, + "p95": 179.0, + "dynamic_range": 145.0, + "mean_gray": 89.34913112164297, + "std_gray": 63.433011798407705 + }, + "geometry": { + "distance_to_center_norm": 0.2551368772983551, + "distance_to_border_px": 159.0 + }, + "edge_ratio": 1.0668981090236382, + "edge_lengths_px": [ + 29.73213768005371, + 29.73213768005371, + 30.364452362060547, + 28.460498809814453 + ] + }, + "confidence": 0.5461315019106076 + }, + { + "observation_id": "1d2978b1-9f23-4555-af1b-2e55ed9ce860", + "type": "aruco", + "marker_id": 96, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 704.0, + 605.0 + ], + [ + 732.0, + 596.0 + ], + [ + 742.0, + 624.0 + ], + [ + 714.0, + 633.0 + ] + ], + "center_px": [ + 723.0, + 614.5 + ], + "quality": { + "area_px": 874.0, + "perimeter_px": 118.28604125976562, + "sharpness": { + "laplacian_var": 2524.409967853709 + }, + "contrast": { + "p05": 25.55, + "p95": 175.0, + "dynamic_range": 149.45, + "mean_gray": 89.68354430379746, + "std_gray": 67.23234214629062 + }, + "geometry": { + "distance_to_center_norm": 0.36455342173576355, + "distance_to_border_px": 87.0 + }, + "edge_ratio": 1.0109229882956123, + "edge_lengths_px": [ + 29.4108829498291, + 29.73213768005371, + 29.4108829498291, + 29.73213768005371 + ] + }, + "confidence": 0.5763709732716893 + }, + { + "observation_id": "ab06ef9f-8f12-4dfc-b532-27556619f42b", + "type": "aruco", + "marker_id": 84, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 1235.0, + 476.0 + ], + [ + 1262.0, + 467.0 + ], + [ + 1274.0, + 494.0 + ], + [ + 1246.0, + 503.0 + ] + ], + "center_px": [ + 1254.25, + 485.0 + ], + "quality": { + "area_px": 846.0, + "perimeter_px": 116.57271575927734, + "sharpness": { + "laplacian_var": 3166.1783476139167 + }, + "contrast": { + "p05": 10.0, + "p95": 159.0, + "dynamic_range": 149.0, + "mean_gray": 75.12850082372323, + "std_gray": 64.14483684443043 + }, + "geometry": { + "distance_to_center_norm": 0.8536534309387207, + "distance_to_border_px": 6.0 + }, + "edge_ratio": 1.0381607798359118, + "edge_lengths_px": [ + 28.460498809814453, + 29.546573638916016, + 29.4108829498291, + 29.154760360717773 + ] + }, + "confidence": 0.06519221426443914 + }, + { + "observation_id": "eb3e077c-a6cd-4423-950d-189c7c5691e5", + "type": "aruco", + "marker_id": 79, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 713.0, + 526.0 + ], + [ + 741.0, + 518.0 + ], + [ + 750.0, + 545.0 + ], + [ + 722.0, + 554.0 + ] + ], + "center_px": [ + 731.5, + 535.75 + ], + "quality": { + "area_px": 846.5, + "perimeter_px": 116.4027042388916, + "sharpness": { + "laplacian_var": 3318.5827853138876 + }, + "contrast": { + "p05": 26.0, + "p95": 175.0, + "dynamic_range": 149.0, + "mean_gray": 99.47126436781609, + "std_gray": 64.7332755042928 + }, + "geometry": { + "distance_to_center_norm": 0.26983729004859924, + "distance_to_border_px": 166.0 + }, + "edge_ratio": 1.0333930949828227, + "edge_lengths_px": [ + 29.120439529418945, + 28.460498809814453, + 29.4108829498291, + 29.4108829498291 + ] + }, + "confidence": 0.5460974493377216 + }, + { + "observation_id": "f2462082-97a0-4747-aedb-59459a55e2c7", + "type": "aruco", + "marker_id": 66, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 435.0, + 486.0 + ], + [ + 463.0, + 478.0 + ], + [ + 471.0, + 505.0 + ], + [ + 443.0, + 514.0 + ] + ], + "center_px": [ + 453.0, + 495.75 + ], + "quality": { + "area_px": 838.0, + "perimeter_px": 115.8120174407959, + "sharpness": { + "laplacian_var": 2230.7738888496574 + }, + "contrast": { + "p05": 43.0, + "p95": 182.0, + "dynamic_range": 139.0, + "mean_gray": 85.56638655462184, + "std_gray": 57.88351280814114 + }, + "geometry": { + "distance_to_center_norm": 0.31469058990478516, + "distance_to_border_px": 206.0 + }, + "edge_ratio": 1.0444110857131401, + "edge_lengths_px": [ + 29.120439529418945, + 28.160255432128906, + 29.4108829498291, + 29.120439529418945 + ] + }, + "confidence": 0.5349107016469481 + }, + { + "observation_id": "6b9dee28-0794-4876-beb2-5f12d5ed67b3", + "type": "aruco", + "marker_id": 95, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 531.0, + 426.0 + ], + [ + 558.0, + 417.0 + ], + [ + 567.0, + 444.0 + ], + [ + 539.0, + 453.0 + ] + ], + "center_px": [ + 548.75, + 435.0 + ], + "quality": { + "area_px": 819.0, + "perimeter_px": 114.49213600158691, + "sharpness": { + "laplacian_var": 2516.310690335306 + }, + "contrast": { + "p05": 37.2, + "p95": 182.0, + "dynamic_range": 144.8, + "mean_gray": 94.0051282051282, + "std_gray": 63.55094846361138 + }, + "geometry": { + "distance_to_center_norm": 0.1608557105064392, + "distance_to_border_px": 267.0 + }, + "edge_ratio": 1.0444110857131401, + "edge_lengths_px": [ + 28.460498809814453, + 28.460498809814453, + 29.4108829498291, + 28.160255432128906 + ] + }, + "confidence": 0.5227826547122322 + }, + { + "observation_id": "0d3030e8-a637-4169-9a28-0b6c59abb74a", + "type": "aruco", + "marker_id": 103, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 600.0, + 305.0 + ], + [ + 627.0, + 296.0 + ], + [ + 636.0, + 322.0 + ], + [ + 609.0, + 331.0 + ] + ], + "center_px": [ + 618.0, + 313.5 + ], + "quality": { + "area_px": 783.0, + "perimeter_px": 111.9482650756836, + "sharpness": { + "laplacian_var": 2580.6990471552635 + }, + "contrast": { + "p05": 34.0, + "p95": 182.0, + "dynamic_range": 148.0, + "mean_gray": 118.64324324324325, + "std_gray": 65.42236114073782 + }, + "geometry": { + "distance_to_center_norm": 0.07005522400140762, + "distance_to_border_px": 296.0 + }, + "edge_ratio": 1.0344143958281513, + "edge_lengths_px": [ + 28.460498809814453, + 27.513633728027344, + 28.460498809814453, + 27.513633728027344 + ] + }, + "confidence": 0.5046333482067283 + }, + { + "observation_id": "8575b9f3-cdd4-463d-b466-10cca2f2256a", + "type": "aruco", + "marker_id": 73, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 1229.0, + 243.0 + ], + [ + 1255.0, + 234.0 + ], + [ + 1266.0, + 260.0 + ], + [ + 1240.0, + 268.0 + ] + ], + "center_px": [ + 1247.5, + 251.25 + ], + "quality": { + "area_px": 756.5, + "perimeter_px": 110.26076316833496, + "sharpness": { + "laplacian_var": 3069.6192549041775 + }, + "contrast": { + "p05": 11.0, + "p95": 160.0, + "dynamic_range": 149.0, + "mean_gray": 86.88533834586467, + "std_gray": 63.13569950474289 + }, + "geometry": { + "distance_to_center_norm": 0.8404671549797058, + "distance_to_border_px": 14.0 + }, + "edge_ratio": 1.0377990707729312, + "edge_lengths_px": [ + 27.513633728027344, + 28.23118782043457, + 27.20294189453125, + 27.312999725341797 + ] + }, + "confidence": 0.13607001327160623 + }, + { + "observation_id": "9d03c9bf-ef92-47c7-9a29-948e078f28c5", + "type": "aruco", + "marker_id": 210, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 784.0, + 134.0 + ], + [ + 793.0, + 159.0 + ], + [ + 766.0, + 167.0 + ], + [ + 757.0, + 142.0 + ] + ], + "center_px": [ + 775.0, + 150.5 + ], + "quality": { + "area_px": 747.0, + "perimeter_px": 109.46183013916016, + "sharpness": { + "laplacian_var": 3147.8058523326927 + }, + "contrast": { + "p05": 26.0, + "p95": 182.0, + "dynamic_range": 156.0, + "mean_gray": 83.41634980988593, + "std_gray": 65.8753549840961 + }, + "geometry": { + "distance_to_center_norm": 0.33940964937210083, + "distance_to_border_px": 134.0 + }, + "edge_ratio": 1.0598252288940997, + "edge_lengths_px": [ + 26.570659637451172, + 28.160255432128906, + 26.570659637451172, + 28.160255432128906 + ] + }, + "confidence": 0.46988879526830113 + }, + { + "observation_id": "21af8fa3-4cd0-47d3-9f09-87bebed90ca3", + "type": "aruco", + "marker_id": 58, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 545.0, + 256.0 + ], + [ + 572.0, + 247.0 + ], + [ + 580.0, + 273.0 + ], + [ + 554.0, + 281.0 + ] + ], + "center_px": [ + 562.75, + 264.25 + ], + "quality": { + "area_px": 748.0, + "perimeter_px": 109.43704223632812, + "sharpness": { + "laplacian_var": 2755.6779662854747 + }, + "contrast": { + "p05": 37.0, + "p95": 183.0, + "dynamic_range": 146.0, + "mean_gray": 91.09695817490494, + "std_gray": 62.24797178018976 + }, + "geometry": { + "distance_to_center_norm": 0.16754259169101715, + "distance_to_border_px": 247.0 + }, + "edge_ratio": 1.071125037848122, + "edge_lengths_px": [ + 28.460498809814453, + 27.20294189453125, + 27.20294189453125, + 26.570659637451172 + ] + }, + "confidence": 0.4655541127751829 + }, + { + "observation_id": "ab627563-4d63-4f3d-b17b-1ef8b5bb443d", + "type": "aruco", + "marker_id": 69, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 459.0, + 232.0 + ], + [ + 485.0, + 224.0 + ], + [ + 494.0, + 249.0 + ], + [ + 467.0, + 258.0 + ] + ], + "center_px": [ + 476.25, + 240.75 + ], + "quality": { + "area_px": 748.0, + "perimeter_px": 109.43704223632812, + "sharpness": { + "laplacian_var": 2617.584191784077 + }, + "contrast": { + "p05": 43.0, + "p95": 184.0, + "dynamic_range": 141.0, + "mean_gray": 95.48007590132828, + "std_gray": 60.23013330442663 + }, + "geometry": { + "distance_to_center_norm": 0.2758673429489136, + "distance_to_border_px": 224.0 + }, + "edge_ratio": 1.071125037848122, + "edge_lengths_px": [ + 27.20294189453125, + 26.570659637451172, + 28.460498809814453, + 27.20294189453125 + ] + }, + "confidence": 0.4655541127751829 + }, + { + "observation_id": "59e37f70-e250-40eb-bb0f-3d8dc2b39bb5", + "type": "aruco", + "marker_id": 82, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 1189.0, + 253.0 + ], + [ + 1215.0, + 245.0 + ], + [ + 1226.0, + 270.0 + ], + [ + 1200.0, + 278.0 + ] + ], + "center_px": [ + 1207.5, + 261.5 + ], + "quality": { + "area_px": 738.0, + "perimeter_px": 109.0318832397461, + "sharpness": { + "laplacian_var": 2169.0593526530856 + }, + "contrast": { + "p05": 10.0, + "p95": 157.0, + "dynamic_range": 147.0, + "mean_gray": 77.1453488372093, + "std_gray": 64.2163871421578 + }, + "geometry": { + "distance_to_center_norm": 0.784397304058075, + "distance_to_border_px": 54.0 + }, + "edge_ratio": 1.0040458061939497, + "edge_lengths_px": [ + 27.20294189453125, + 27.312999725341797, + 27.20294189453125, + 27.312999725341797 + ] + }, + "confidence": 0.49001748422717006 + }, + { + "observation_id": "46ea1a58-1b2a-44c8-a10b-1a866fb5ea18", + "type": "aruco", + "marker_id": 81, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 1009.0, + 206.0 + ], + [ + 1035.0, + 197.0 + ], + [ + 1045.0, + 222.0 + ], + [ + 1020.0, + 231.0 + ] + ], + "center_px": [ + 1027.25, + 214.0 + ], + "quality": { + "area_px": 732.0, + "perimeter_px": 108.32311630249023, + "sharpness": { + "laplacian_var": 513.4135093688965 + }, + "contrast": { + "p05": 3.0, + "p95": 78.0, + "dynamic_range": 75.0, + "mean_gray": 28.263671875, + "std_gray": 30.623003898496535 + }, + "geometry": { + "distance_to_center_norm": 0.5636072754859924, + "distance_to_border_px": 197.0 + }, + "edge_ratio": 1.035489299228652, + "edge_lengths_px": [ + 27.513633728027344, + 26.925823211669922, + 26.570659637451172, + 27.312999725341797 + ] + }, + "confidence": 0.44182011377693337 + }, + { + "observation_id": "ff5bdaad-50e7-426c-85ec-d6c24ed6ca42", + "type": "aruco", + "marker_id": 101, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 1144.0, + 145.0 + ], + [ + 1170.0, + 137.0 + ], + [ + 1180.0, + 162.0 + ], + [ + 1155.0, + 170.0 + ] + ], + "center_px": [ + 1162.25, + 153.5 + ], + "quality": { + "area_px": 721.5, + "perimeter_px": 107.6905746459961, + "sharpness": { + "laplacian_var": 2650.0398675673973 + }, + "contrast": { + "p05": 11.0, + "p95": 158.0, + "dynamic_range": 147.0, + "mean_gray": 78.875, + "std_gray": 62.54999785885574 + }, + "geometry": { + "distance_to_center_norm": 0.7647988200187683, + "distance_to_border_px": 100.0 + }, + "edge_ratio": 1.0405424062428426, + "edge_lengths_px": [ + 27.20294189453125, + 26.925823211669922, + 26.248809814453125, + 27.312999725341797 + ] + }, + "confidence": 0.46225891142368675 + }, + { + "observation_id": "149b3800-cb44-46bd-8779-f5c430af922f", + "type": "aruco", + "marker_id": 64, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 553.0, + 169.0 + ], + [ + 580.0, + 162.0 + ], + [ + 588.0, + 186.0 + ], + [ + 561.0, + 194.0 + ] + ], + "center_px": [ + 570.5, + 177.75 + ], + "quality": { + "area_px": 721.5, + "perimeter_px": 107.59993743896484, + "sharpness": { + "laplacian_var": 2672.3096794431917 + }, + "contrast": { + "p05": 35.0, + "p95": 183.0, + "dynamic_range": 148.0, + "mean_gray": 90.38811881188118, + "std_gray": 63.32190162316671 + }, + "geometry": { + "distance_to_center_norm": 0.2656291127204895, + "distance_to_border_px": 162.0 + }, + "edge_ratio": 1.1131318197219238, + "edge_lengths_px": [ + 27.892650604248047, + 25.298221588134766, + 28.160255432128906, + 26.248809814453125 + ] + }, + "confidence": 0.43211414091114625 + }, + { + "observation_id": "de6997e0-9371-4e9a-aa1e-e5f5ef7c5e47", + "type": "aruco", + "marker_id": 52, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 1037.0, + 152.0 + ], + [ + 1062.0, + 144.0 + ], + [ + 1072.0, + 169.0 + ], + [ + 1047.0, + 177.0 + ] + ], + "center_px": [ + 1054.5, + 160.5 + ], + "quality": { + "area_px": 705.0, + "perimeter_px": 106.3492660522461, + "sharpness": { + "laplacian_var": 1718.0292069705297 + }, + "contrast": { + "p05": 8.0, + "p95": 138.0, + "dynamic_range": 130.0, + "mean_gray": 54.625766871165645, + "std_gray": 52.89748768272474 + }, + "geometry": { + "distance_to_center_norm": 0.6264604926109314, + "distance_to_border_px": 144.0 + }, + "edge_ratio": 1.0257921559873553, + "edge_lengths_px": [ + 26.248809814453125, + 26.925823211669922, + 26.248809814453125, + 26.925823211669922 + ] + }, + "confidence": 0.45818248585417487 + }, + { + "observation_id": "0622566f-c6b1-4427-acda-d89734a50883", + "type": "aruco", + "marker_id": 83, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 1155.0, + 56.0 + ], + [ + 1180.0, + 48.0 + ], + [ + 1191.0, + 72.0 + ], + [ + 1166.0, + 80.0 + ] + ], + "center_px": [ + 1173.0, + 64.0 + ], + "quality": { + "area_px": 688.0, + "perimeter_px": 105.29913330078125, + "sharpness": { + "laplacian_var": 3424.6607203261588 + }, + "contrast": { + "p05": 12.0, + "p95": 168.0, + "dynamic_range": 156.0, + "mean_gray": 94.50210970464136, + "std_gray": 65.18795444583183 + }, + "geometry": { + "distance_to_center_norm": 0.8302794098854065, + "distance_to_border_px": 48.0 + }, + "edge_ratio": 1.0057887204242193, + "edge_lengths_px": [ + 26.248809814453125, + 26.4007568359375, + 26.248809814453125, + 26.4007568359375 + ] + }, + "confidence": 0.4377857805109236 + } + ], + "rejected_candidates": [ + { + "image_points_px": [ + [ + 832.0, + 363.0 + ], + [ + 790.0, + 397.0 + ], + [ + 777.0, + 394.0 + ], + [ + 810.0, + 361.0 + ] + ], + "center_px": [ + 802.25, + 378.75 + ], + "area_px": 680.0 + }, + { + "image_points_px": [ + [ + 877.0, + 185.0 + ], + [ + 879.0, + 192.0 + ], + [ + 830.0, + 205.0 + ], + [ + 831.0, + 198.0 + ] + ], + "center_px": [ + 854.25, + 195.0 + ], + "area_px": 339.0 + }, + { + "image_points_px": [ + [ + 931.0, + 499.0 + ], + [ + 942.0, + 527.0 + ], + [ + 917.0, + 535.0 + ], + [ + 907.0, + 507.0 + ] + ], + "center_px": [ + 924.25, + 517.0 + ], + "area_px": 770.0 + }, + { + "image_points_px": [ + [ + 887.0, + 383.0 + ], + [ + 897.0, + 410.0 + ], + [ + 873.0, + 418.0 + ], + [ + 863.0, + 391.0 + ] + ], + "center_px": [ + 880.0, + 400.5 + ], + "area_px": 728.0 + }, + { + "image_points_px": [ + [ + 721.0, + 447.0 + ], + [ + 761.0, + 449.0 + ], + [ + 756.0, + 456.0 + ], + [ + 723.0, + 452.0 + ] + ], + "center_px": [ + 740.25, + 451.0 + ], + "area_px": 223.5 + }, + { + "image_points_px": [ + [ + 1141.0, + 545.0 + ], + [ + 1148.0, + 552.0 + ], + [ + 1160.0, + 579.0 + ], + [ + 1151.0, + 569.0 + ] + ], + "center_px": [ + 1150.0, + 561.25 + ], + "area_px": 110.5 + }, + { + "image_points_px": [ + [ + 808.0, + 189.0 + ], + [ + 819.0, + 220.0 + ], + [ + 810.0, + 214.0 + ], + [ + 804.0, + 193.0 + ] + ], + "center_px": [ + 810.25, + 204.0 + ], + "area_px": 160.5 + }, + { + "image_points_px": [ + [ + 1133.0, + 365.0 + ], + [ + 1139.0, + 371.0 + ], + [ + 1147.0, + 393.0 + ], + [ + 1141.0, + 386.0 + ] + ], + "center_px": [ + 1140.0, + 378.75 + ], + "area_px": 77.0 + }, + { + "image_points_px": [ + [ + 1104.0, + 244.0 + ], + [ + 1108.0, + 248.0 + ], + [ + 1116.0, + 272.0 + ], + [ + 1113.0, + 270.0 + ] + ], + "center_px": [ + 1110.25, + 258.5 + ], + "area_px": 62.0 + }, + { + "image_points_px": [ + [ + 768.0, + 344.0 + ], + [ + 772.0, + 350.0 + ], + [ + 759.0, + 365.0 + ], + [ + 754.0, + 358.0 + ] + ], + "center_px": [ + 763.25, + 354.25 + ], + "area_px": 153.0 + }, + { + "image_points_px": [ + [ + 663.0, + 109.0 + ], + [ + 667.0, + 112.0 + ], + [ + 673.0, + 130.0 + ], + [ + 670.0, + 128.0 + ] + ], + "center_px": [ + 668.25, + 119.75 + ], + "area_px": 48.5 + } + ] +} \ No newline at end of file diff --git a/data/evaluations/Scene8/render_f_camera_pose.json b/data/evaluations/Scene8/render_f_camera_pose.json new file mode 100644 index 0000000..6626164 --- /dev/null +++ b/data/evaluations/Scene8/render_f_camera_pose.json @@ -0,0 +1,568 @@ +{ + "schema_version": "1.0", + "created_utc": "2026-06-01T18:36:48Z", + "source": { + "detection_json": "C:\\Users\\kech\\SynologyDrive\\2026-AppServer-AppRobot\\appRobotRendering\\data\\evaluations\\Scene8\\render_f_aruco_detection.json", + "robot_json": "C:\\Users\\kech\\SynologyDrive\\2026-AppServer-AppRobot\\appRobotRendering\\data\\robot\\robot.json" + }, + "camera": { + "camera_id": "f", + "camera_matrix": [ + [ + 1777.77783203125, + 0.0, + 640.0 + ], + [ + 0.0, + 1777.77783203125, + 360.0 + ], + [ + 0.0, + 0.0, + 1.0 + ] + ], + "distortion_coefficients": [ + 0.0, + 0.0, + 0.0, + 0.0, + 0.0 + ] + }, + "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": 26, + "used_marker_ids": [ + 46, + 56, + 208, + 47, + 62, + 54, + 53, + 97, + 72, + 55, + 96, + 84, + 79, + 66, + 95, + 103, + 73, + 210, + 58, + 69, + 82, + 81, + 101, + 64, + 52, + 83 + ], + "history": { + "iters": [ + 0, + 1, + 2, + 3, + 4 + ], + "rms": [ + 0.007353373451031194, + 0.0003710600488929596, + 8.906113930528944e-05, + 8.900491419954867e-05, + 8.900489226102867e-05 + ], + "lambda": [ + 0.001, + 0.0005, + 0.00025, + 0.000125, + 6.25e-05 + ] + }, + "residual_rms_px": 0.22376788390648267, + "residual_median_px": 0.18825857568728324, + "residual_max_px": 0.39640627876435003, + "sigma2_normalized": 8.95515834760647e-09 + }, + "camera_pose": { + "world_to_camera": { + "rotation_matrix": [ + [ + 0.31644874811172485, + 0.9486086964607239, + 0.00130163982976228 + ], + [ + 0.9183046221733093, + -0.3059948980808258, + -0.2511647045612335 + ], + [ + -0.23785872757434845, + 0.08067604899406433, + -0.9679434895515442 + ] + ], + "translation_m": [ + 0.1261357069015503, + -0.200173020362854, + 1.497665524482727 + ], + "rvec_rad": [ + 2.374582435142889, + 1.711381147791732, + -0.21684955389903504 + ] + }, + "camera_in_world": { + "position_m": [ + 0.5001371502876282, + -0.30173107981681824, + 1.3992151021957397 + ], + "position_mm": [ + 500.13714599609375, + -301.7310791015625, + 1399.215087890625 + ], + "orientation_deg": { + "roll": 175.2355194091797, + "pitch": 13.760193824768066, + "yaw": 70.9859848022461 + } + }, + "uncertainty": { + "pose_covariance_6x6": [ + [ + 1.9619416958563405e-07, + 1.232837325475714e-07, + 3.537784977398958e-08, + -1.2874449920644035e-09, + -1.3120643407548253e-09, + -2.430518562789776e-09 + ], + [ + 1.2328373254757045e-07, + 1.0492379739637157e-07, + 5.587099350476958e-09, + 2.8771773145648727e-09, + -1.376635290194795e-09, + 2.095544274360706e-09 + ], + [ + 3.537784977401896e-08, + 5.587099350501193e-09, + 7.216196836933972e-07, + 4.454379192917962e-09, + -1.137281486631975e-08, + -1.3327718453309484e-07 + ], + [ + -1.287444992064164e-09, + 2.8771773145650617e-09, + 4.454379192917376e-09, + 1.574259199353428e-09, + -9.159737376748967e-11, + 1.4651163057535826e-09 + ], + [ + -1.3120643407551655e-09, + -1.3766352901952072e-09, + -1.1372814866319643e-08, + -9.159737376750992e-11, + 9.672826358233463e-10, + 2.788243505342515e-09 + ], + [ + -2.43051856279491e-09, + 2.0955442743564383e-09, + -1.3327718453309545e-07, + 1.4651163057534658e-09, + 2.7882435053425046e-09, + 4.3386424804938955e-08 + ] + ], + "parameter_std": { + "rvec_std_deg": [ + 0.02537848430759805, + 0.018559216264706715, + 0.048671733890649 + ], + "tvec_std_m": [ + 3.967693535737643e-05, + 3.110116775658667e-05, + 0.00020829408250101335 + ] + }, + "camera_center_std_m": [ + 0.0008369888619904323, + 0.0007984829430878973, + 0.0002871572860910438 + ], + "camera_center_std_mm": [ + 0.8369888619904322, + 0.7984829430878972, + 0.2871572860910438 + ], + "orientation_std_deg": { + "roll": 0.03325401245890173, + "pitch": 0.03236575464664165, + "yaw": 0.012048758808889037 + } + } + }, + "observations": { + "markers": [ + { + "marker_id": 46, + "observed_center_px": [ + 1234.0, + 666.0 + ], + "projected_center_px": [ + 1234.341064453125, + 665.8336181640625 + ], + "reprojection_error_px": 0.37948369729856446, + "confidence": 0.2988751797371847 + }, + { + "marker_id": 56, + "observed_center_px": [ + 1196.0, + 626.75 + ], + "projected_center_px": [ + 1196.113525390625, + 626.8538208007812 + ], + "reprojection_error_px": 0.1538400890256465, + "confidence": 0.5697620483284124 + }, + { + "marker_id": 208, + "observed_center_px": [ + 831.25, + 547.75 + ], + "projected_center_px": [ + 831.465576171875, + 547.9014282226562 + ], + "reprojection_error_px": 0.2634456158244247, + "confidence": 0.5829305549976826 + }, + { + "marker_id": 47, + "observed_center_px": [ + 593.75, + 623.75 + ], + "projected_center_px": [ + 593.9198608398438, + 623.669189453125 + ], + "reprojection_error_px": 0.18810382611382645, + "confidence": 0.5768583617164568 + }, + { + "marker_id": 62, + "observed_center_px": [ + 751.0, + 651.75 + ], + "projected_center_px": [ + 750.7454223632812, + 651.6237182617188 + ], + "reprojection_error_px": 0.28417749830104067, + "confidence": 0.5593704450665263 + }, + { + "marker_id": 54, + "observed_center_px": [ + 540.5, + 639.0 + ], + "projected_center_px": [ + 540.5787353515625, + 638.9071655273438 + ], + "reprojection_error_px": 0.12172713296153204, + "confidence": 0.5766374039623903 + }, + { + "marker_id": 53, + "observed_center_px": [ + 1240.5, + 594.75 + ], + "projected_center_px": [ + 1240.2264404296875, + 594.78125 + ], + "reprojection_error_px": 0.27533870234596447, + "confidence": 0.21364841201201337 + }, + { + "marker_id": 97, + "observed_center_px": [ + 491.5, + 605.25 + ], + "projected_center_px": [ + 491.5794372558594, + 605.20458984375 + ], + "reprojection_error_px": 0.09150060059429786, + "confidence": 0.5705029634947052 + }, + { + "marker_id": 72, + "observed_center_px": [ + 1197.75, + 548.5 + ], + "projected_center_px": [ + 1197.5211181640625, + 548.55517578125 + ], + "reprojection_error_px": 0.2354384455832745, + "confidence": 0.5440516905787338 + }, + { + "marker_id": 55, + "observed_center_px": [ + 598.75, + 542.75 + ], + "projected_center_px": [ + 598.8782958984375, + 542.7704467773438 + ], + "reprojection_error_px": 0.12991500398195047, + "confidence": 0.5461315019106076 + }, + { + "marker_id": 96, + "observed_center_px": [ + 723.0, + 614.5 + ], + "projected_center_px": [ + 722.8250122070312, + 614.3399658203125 + ], + "reprojection_error_px": 0.237132170648196, + "confidence": 0.5763709732716893 + }, + { + "marker_id": 84, + "observed_center_px": [ + 1254.25, + 485.0 + ], + "projected_center_px": [ + 1254.1002197265625, + 484.99395751953125 + ], + "reprojection_error_px": 0.14990210766105824, + "confidence": 0.06519221426443914 + }, + { + "marker_id": 79, + "observed_center_px": [ + 731.5, + 535.75 + ], + "projected_center_px": [ + 731.5431518554688, + 535.8726806640625 + ], + "reprojection_error_px": 0.13004856002744464, + "confidence": 0.5460974493377216 + }, + { + "marker_id": 66, + "observed_center_px": [ + 453.0, + 495.75 + ], + "projected_center_px": [ + 452.8733825683594, + 495.8895263671875 + ], + "reprojection_error_px": 0.18841332526074003, + "confidence": 0.5349107016469481 + }, + { + "marker_id": 95, + "observed_center_px": [ + 548.75, + 435.0 + ], + "projected_center_px": [ + 548.5177001953125, + 434.867431640625 + ], + "reprojection_error_px": 0.2674650802726027, + "confidence": 0.5227826547122322 + }, + { + "marker_id": 103, + "observed_center_px": [ + 618.0, + 313.5 + ], + "projected_center_px": [ + 617.8211059570312, + 313.5081481933594 + ], + "reprojection_error_px": 0.1790795121300221, + "confidence": 0.5046333482067283 + }, + { + "marker_id": 73, + "observed_center_px": [ + 1247.5, + 251.25 + ], + "projected_center_px": [ + 1247.839599609375, + 251.27215576171875 + ], + "reprojection_error_px": 0.3403215721416887, + "confidence": 0.13607001327160623 + }, + { + "marker_id": 210, + "observed_center_px": [ + 775.0, + 150.5 + ], + "projected_center_px": [ + 775.3216552734375, + 150.4322509765625 + ], + "reprojection_error_px": 0.328712709074182, + "confidence": 0.46988879526830113 + }, + { + "marker_id": 58, + "observed_center_px": [ + 562.75, + 264.25 + ], + "projected_center_px": [ + 562.7431030273438, + 264.154052734375 + ], + "reprojection_error_px": 0.09619483360729601, + "confidence": 0.4655541127751829 + }, + { + "marker_id": 69, + "observed_center_px": [ + 476.25, + 240.75 + ], + "projected_center_px": [ + 476.10382080078125, + 241.11846923828125 + ], + "reprojection_error_px": 0.39640627876435003, + "confidence": 0.4655541127751829 + }, + { + "marker_id": 82, + "observed_center_px": [ + 1207.5, + 261.5 + ], + "projected_center_px": [ + 1207.3634033203125, + 261.34552001953125 + ], + "reprojection_error_px": 0.20621037138629777, + "confidence": 0.49001748422717006 + }, + { + "marker_id": 81, + "observed_center_px": [ + 1027.25, + 214.0 + ], + "projected_center_px": [ + 1027.4215087890625, + 214.0127716064453 + ], + "reprojection_error_px": 0.17198365810994679, + "confidence": 0.44182011377693337 + }, + { + "marker_id": 101, + "observed_center_px": [ + 1162.25, + 153.5 + ], + "projected_center_px": [ + 1162.3416748046875, + 153.4523468017578 + ], + "reprojection_error_px": 0.10332036158086408, + "confidence": 0.46225891142368675 + }, + { + "marker_id": 64, + "observed_center_px": [ + 570.5, + 177.75 + ], + "projected_center_px": [ + 570.4990844726562, + 177.69577026367188 + ], + "reprojection_error_px": 0.054237463920569835, + "confidence": 0.43211414091114625 + }, + { + "marker_id": 52, + "observed_center_px": [ + 1054.5, + 160.5 + ], + "projected_center_px": [ + 1054.46826171875, + 160.70294189453125 + ], + "reprojection_error_px": 0.20540869273873757, + "confidence": 0.45818248585417487 + }, + { + "marker_id": 83, + "observed_center_px": [ + 1173.0, + 64.0 + ], + "projected_center_px": [ + 1172.84375, + 64.00605773925781 + ], + "reprojection_error_px": 0.15636738376309697, + "confidence": 0.4377857805109236 + } + ] + }, + "qa": { + "sanity_notes": [] + } +} \ No newline at end of file diff --git a/data/evaluations/Scene8/render_f_camera_pose_v8.json b/data/evaluations/Scene8/render_f_camera_pose_v8.json new file mode 100644 index 0000000..d21e823 --- /dev/null +++ b/data/evaluations/Scene8/render_f_camera_pose_v8.json @@ -0,0 +1,569 @@ +{ + "schema_version": "1.0", + "created_utc": "2026-06-01T18:37:02Z", + "source": { + "detection_json": "C:\\Users\\kech\\SynologyDrive\\2026-AppServer-AppRobot\\appRobotRendering\\data\\evaluations\\Scene8\\render_f_aruco_detection.json", + "robot_json": "C:\\Users\\kech\\SynologyDrive\\2026-AppServer-AppRobot\\appRobotRendering\\data\\robot\\robot.json" + }, + "camera": { + "camera_id": "f", + "camera_matrix": [ + [ + 1777.77783203125, + 0.0, + 640.0 + ], + [ + 0.0, + 1777.77783203125, + 360.0 + ], + [ + 0.0, + 0.0, + 1.0 + ] + ], + "distortion_coefficients": [ + 0.0, + 0.0, + 0.0, + 0.0, + 0.0 + ] + }, + "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": 26, + "used_marker_ids": [ + 46, + 56, + 208, + 47, + 62, + 54, + 53, + 97, + 72, + 55, + 96, + 84, + 79, + 66, + 95, + 103, + 73, + 210, + 58, + 69, + 82, + 81, + 101, + 64, + 52, + 83 + ], + "history": { + "iters": [ + 0, + 1, + 2, + 3, + 4 + ], + "rms": [ + 0.007353373451031194, + 0.0003710600488929596, + 8.906113930528944e-05, + 8.900491419954867e-05, + 8.900489226102867e-05 + ], + "lambda": [ + 0.001, + 0.0005, + 0.00025, + 0.000125, + 6.25e-05 + ] + }, + "residual_rms_px": 0.22376788390648267, + "residual_median_px": 0.18825857568728324, + "residual_max_px": 0.39640627876435003, + "sigma2_normalized": 8.95515834760647e-09 + }, + "camera_pose": { + "world_to_camera": { + "rotation_matrix": [ + [ + 0.31644874811172485, + 0.9486086964607239, + 0.00130163982976228 + ], + [ + 0.9183046221733093, + -0.3059948980808258, + -0.2511647045612335 + ], + [ + -0.23785872757434845, + 0.08067604899406433, + -0.9679434895515442 + ] + ], + "translation_m": [ + 0.1261211733254225, + -0.19737202247525956, + 1.5084599614675736 + ], + "rvec_rad": [ + 2.374582435142889, + 1.711381147791732, + -0.21684955389903504 + ] + }, + "camera_in_world": { + "position_m": [ + 0.5001371392778484, + -0.3017310886953837, + 1.4103669486367805 + ], + "position_mm": [ + 500.1371392778484, + -301.7310886953837, + 1410.3669486367805 + ], + "orientation_deg": { + "roll": 175.2355194091797, + "pitch": 13.760193824768066, + "yaw": 70.9859848022461 + } + }, + "uncertainty": { + "pose_covariance_6x6": [ + [ + 1.9619416958563405e-07, + 1.232837325475714e-07, + 3.537784977398958e-08, + -1.2874449920644035e-09, + -1.3120643407548253e-09, + -2.430518562789776e-09 + ], + [ + 1.2328373254757045e-07, + 1.0492379739637157e-07, + 5.587099350476958e-09, + 2.8771773145648727e-09, + -1.376635290194795e-09, + 2.095544274360706e-09 + ], + [ + 3.537784977401896e-08, + 5.587099350501193e-09, + 7.216196836933972e-07, + 4.454379192917962e-09, + -1.137281486631975e-08, + -1.3327718453309484e-07 + ], + [ + -1.287444992064164e-09, + 2.8771773145650617e-09, + 4.454379192917376e-09, + 1.574259199353428e-09, + -9.159737376748967e-11, + 1.4651163057535826e-09 + ], + [ + -1.3120643407551655e-09, + -1.3766352901952072e-09, + -1.1372814866319643e-08, + -9.159737376750992e-11, + 9.672826358233463e-10, + 2.788243505342515e-09 + ], + [ + -2.43051856279491e-09, + 2.0955442743564383e-09, + -1.3327718453309545e-07, + 1.4651163057534658e-09, + 2.7882435053425046e-09, + 4.3386424804938955e-08 + ] + ], + "parameter_std": { + "rvec_std_deg": [ + 0.02537848430759805, + 0.018559216264706715, + 0.048671733890649 + ], + "tvec_std_m": [ + 3.967693535737643e-05, + 3.110116775658667e-05, + 0.00020829408250101335 + ] + }, + "camera_center_std_m": [ + 0.0008369888619904323, + 0.0007984829430878973, + 0.0002871572860910438 + ], + "camera_center_std_mm": [ + 0.8369888619904322, + 0.7984829430878972, + 0.2871572860910438 + ], + "orientation_std_deg": { + "roll": 0.03325401245890173, + "pitch": 0.03236575464664165, + "yaw": 0.012048758808889037 + } + } + }, + "observations": { + "markers": [ + { + "marker_id": 46, + "observed_center_px": [ + 1234.0, + 666.0 + ], + "projected_center_px": [ + 1234.341064453125, + 665.8336181640625 + ], + "reprojection_error_px": 0.37948369729856446, + "confidence": 0.2988751797371847 + }, + { + "marker_id": 56, + "observed_center_px": [ + 1196.0, + 626.75 + ], + "projected_center_px": [ + 1196.113525390625, + 626.8538208007812 + ], + "reprojection_error_px": 0.1538400890256465, + "confidence": 0.5697620483284124 + }, + { + "marker_id": 208, + "observed_center_px": [ + 831.25, + 547.75 + ], + "projected_center_px": [ + 831.465576171875, + 547.9014282226562 + ], + "reprojection_error_px": 0.2634456158244247, + "confidence": 0.5829305549976826 + }, + { + "marker_id": 47, + "observed_center_px": [ + 593.75, + 623.75 + ], + "projected_center_px": [ + 593.9198608398438, + 623.669189453125 + ], + "reprojection_error_px": 0.18810382611382645, + "confidence": 0.5768583617164568 + }, + { + "marker_id": 62, + "observed_center_px": [ + 751.0, + 651.75 + ], + "projected_center_px": [ + 750.7454223632812, + 651.6237182617188 + ], + "reprojection_error_px": 0.28417749830104067, + "confidence": 0.5593704450665263 + }, + { + "marker_id": 54, + "observed_center_px": [ + 540.5, + 639.0 + ], + "projected_center_px": [ + 540.5787353515625, + 638.9071655273438 + ], + "reprojection_error_px": 0.12172713296153204, + "confidence": 0.5766374039623903 + }, + { + "marker_id": 53, + "observed_center_px": [ + 1240.5, + 594.75 + ], + "projected_center_px": [ + 1240.2264404296875, + 594.78125 + ], + "reprojection_error_px": 0.27533870234596447, + "confidence": 0.21364841201201337 + }, + { + "marker_id": 97, + "observed_center_px": [ + 491.5, + 605.25 + ], + "projected_center_px": [ + 491.5794372558594, + 605.20458984375 + ], + "reprojection_error_px": 0.09150060059429786, + "confidence": 0.5705029634947052 + }, + { + "marker_id": 72, + "observed_center_px": [ + 1197.75, + 548.5 + ], + "projected_center_px": [ + 1197.5211181640625, + 548.55517578125 + ], + "reprojection_error_px": 0.2354384455832745, + "confidence": 0.5440516905787338 + }, + { + "marker_id": 55, + "observed_center_px": [ + 598.75, + 542.75 + ], + "projected_center_px": [ + 598.8782958984375, + 542.7704467773438 + ], + "reprojection_error_px": 0.12991500398195047, + "confidence": 0.5461315019106076 + }, + { + "marker_id": 96, + "observed_center_px": [ + 723.0, + 614.5 + ], + "projected_center_px": [ + 722.8250122070312, + 614.3399658203125 + ], + "reprojection_error_px": 0.237132170648196, + "confidence": 0.5763709732716893 + }, + { + "marker_id": 84, + "observed_center_px": [ + 1254.25, + 485.0 + ], + "projected_center_px": [ + 1254.1002197265625, + 484.99395751953125 + ], + "reprojection_error_px": 0.14990210766105824, + "confidence": 0.06519221426443914 + }, + { + "marker_id": 79, + "observed_center_px": [ + 731.5, + 535.75 + ], + "projected_center_px": [ + 731.5431518554688, + 535.8726806640625 + ], + "reprojection_error_px": 0.13004856002744464, + "confidence": 0.5460974493377216 + }, + { + "marker_id": 66, + "observed_center_px": [ + 453.0, + 495.75 + ], + "projected_center_px": [ + 452.8733825683594, + 495.8895263671875 + ], + "reprojection_error_px": 0.18841332526074003, + "confidence": 0.5349107016469481 + }, + { + "marker_id": 95, + "observed_center_px": [ + 548.75, + 435.0 + ], + "projected_center_px": [ + 548.5177001953125, + 434.867431640625 + ], + "reprojection_error_px": 0.2674650802726027, + "confidence": 0.5227826547122322 + }, + { + "marker_id": 103, + "observed_center_px": [ + 618.0, + 313.5 + ], + "projected_center_px": [ + 617.8211059570312, + 313.5081481933594 + ], + "reprojection_error_px": 0.1790795121300221, + "confidence": 0.5046333482067283 + }, + { + "marker_id": 73, + "observed_center_px": [ + 1247.5, + 251.25 + ], + "projected_center_px": [ + 1247.839599609375, + 251.27215576171875 + ], + "reprojection_error_px": 0.3403215721416887, + "confidence": 0.13607001327160623 + }, + { + "marker_id": 210, + "observed_center_px": [ + 775.0, + 150.5 + ], + "projected_center_px": [ + 775.3216552734375, + 150.4322509765625 + ], + "reprojection_error_px": 0.328712709074182, + "confidence": 0.46988879526830113 + }, + { + "marker_id": 58, + "observed_center_px": [ + 562.75, + 264.25 + ], + "projected_center_px": [ + 562.7431030273438, + 264.154052734375 + ], + "reprojection_error_px": 0.09619483360729601, + "confidence": 0.4655541127751829 + }, + { + "marker_id": 69, + "observed_center_px": [ + 476.25, + 240.75 + ], + "projected_center_px": [ + 476.10382080078125, + 241.11846923828125 + ], + "reprojection_error_px": 0.39640627876435003, + "confidence": 0.4655541127751829 + }, + { + "marker_id": 82, + "observed_center_px": [ + 1207.5, + 261.5 + ], + "projected_center_px": [ + 1207.3634033203125, + 261.34552001953125 + ], + "reprojection_error_px": 0.20621037138629777, + "confidence": 0.49001748422717006 + }, + { + "marker_id": 81, + "observed_center_px": [ + 1027.25, + 214.0 + ], + "projected_center_px": [ + 1027.4215087890625, + 214.0127716064453 + ], + "reprojection_error_px": 0.17198365810994679, + "confidence": 0.44182011377693337 + }, + { + "marker_id": 101, + "observed_center_px": [ + 1162.25, + 153.5 + ], + "projected_center_px": [ + 1162.3416748046875, + 153.4523468017578 + ], + "reprojection_error_px": 0.10332036158086408, + "confidence": 0.46225891142368675 + }, + { + "marker_id": 64, + "observed_center_px": [ + 570.5, + 177.75 + ], + "projected_center_px": [ + 570.4990844726562, + 177.69577026367188 + ], + "reprojection_error_px": 0.054237463920569835, + "confidence": 0.43211414091114625 + }, + { + "marker_id": 52, + "observed_center_px": [ + 1054.5, + 160.5 + ], + "projected_center_px": [ + 1054.46826171875, + 160.70294189453125 + ], + "reprojection_error_px": 0.20540869273873757, + "confidence": 0.45818248585417487 + }, + { + "marker_id": 83, + "observed_center_px": [ + 1173.0, + 64.0 + ], + "projected_center_px": [ + 1172.84375, + 64.00605773925781 + ], + "reprojection_error_px": 0.15636738376309697, + "confidence": 0.4377857805109236 + } + ] + }, + "qa": { + "sanity_notes": [] + }, + "v8_z_correction_mm": 11.151935468550299 +} \ No newline at end of file diff --git a/data/evaluations/Scene8/render_g_aruco_detection.json b/data/evaluations/Scene8/render_g_aruco_detection.json new file mode 100644 index 0000000..911207a --- /dev/null +++ b/data/evaluations/Scene8/render_g_aruco_detection.json @@ -0,0 +1,2037 @@ +{ + "schema_version": "1.0", + "created_utc": "2026-06-01T18:36:46Z", + "vision_config": { + "MarkerType": "DICT_4X4_250", + "MarkerSize": 0.025 + }, + "camera": { + "camera_id": "g", + "intrinsics_file": "C:\\Users\\kech\\SynologyDrive\\2026-AppServer-AppRobot\\appRobotRendering\\data\\simulation\\Scene8\\render_a.npz", + "camera_matrix": [ + [ + 1777.77783203125, + 0.0, + 640.0 + ], + [ + 0.0, + 1777.77783203125, + 360.0 + ], + [ + 0.0, + 0.0, + 1.0 + ] + ], + "distortion_coefficients": [ + 0.0, + 0.0, + 0.0, + 0.0, + 0.0 + ] + }, + "image": { + "image_file": "C:\\Users\\kech\\SynologyDrive\\2026-AppServer-AppRobot\\appRobotRendering\\data\\simulation\\Scene8\\render_g.png", + "image_sha256": "57b85bb1078eb0ae084482f8b5ba3b0f2aa886d0f6e5f6cc75ecffb77fdecd3d", + "width_px": 1280, + "height_px": 720 + }, + "aruco": { + "dictionary": "DICT_4X4_250", + "num_detected_markers": 34, + "num_rejected_candidates": 6 + }, + "detections": [ + { + "observation_id": "ae887c4d-f084-4ba1-91a8-3e60c6a664ac", + "type": "aruco", + "marker_id": 43, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 586.0, + 226.0 + ], + [ + 574.0, + 261.0 + ], + [ + 546.0, + 247.0 + ], + [ + 558.0, + 214.0 + ] + ], + "center_px": [ + 566.0, + 237.0 + ], + "quality": { + "area_px": 1108.0, + "perimeter_px": 133.88214683532715, + "sharpness": { + "laplacian_var": 1414.0144799008929 + }, + "contrast": { + "p05": 7.0, + "p95": 131.0, + "dynamic_range": 124.0, + "mean_gray": 48.32941176470588, + "std_gray": 51.19248551161189 + }, + "geometry": { + "distance_to_center_norm": 0.19548407196998596, + "distance_to_border_px": 214.0 + }, + "edge_ratio": 1.2145844887816586, + "edge_lengths_px": [ + 37.0, + 31.30495262145996, + 35.11410140991211, + 30.463092803955078 + ] + }, + "confidence": 0.6081640869690491 + }, + { + "observation_id": "83a0699d-8158-48af-9f51-184f355f78c0", + "type": "aruco", + "marker_id": 198, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 541.0, + 585.0 + ], + [ + 520.0, + 563.0 + ], + [ + 542.0, + 543.0 + ], + [ + 563.0, + 564.0 + ] + ], + "center_px": [ + 541.5, + 563.75 + ], + "quality": { + "area_px": 903.5, + "perimeter_px": 120.25824737548828, + "sharpness": { + "laplacian_var": 5103.143214269628 + }, + "contrast": { + "p05": 27.0, + "p95": 180.0, + "dynamic_range": 153.0, + "mean_gray": 92.83892617449665, + "std_gray": 67.03690930812036 + }, + "geometry": { + "distance_to_center_norm": 0.30819758772850037, + "distance_to_border_px": 135.0 + }, + "edge_ratio": 1.0240863542535628, + "edge_lengths_px": [ + 30.4138126373291, + 29.73213768005371, + 29.698484420776367, + 30.4138126373291 + ] + }, + "confidence": 0.5881665455569544 + }, + { + "observation_id": "7dae8ead-207a-4069-affb-d3f45cdb69ba", + "type": "aruco", + "marker_id": 229, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 624.0, + 508.0 + ], + [ + 603.0, + 487.0 + ], + [ + 625.0, + 468.0 + ], + [ + 646.0, + 488.0 + ] + ], + "center_px": [ + 624.5, + 487.75 + ], + "quality": { + "area_px": 860.5, + "perimeter_px": 117.4995059967041, + "sharpness": { + "laplacian_var": 3645.4879206302335 + }, + "contrast": { + "p05": 32.0, + "p95": 182.0, + "dynamic_range": 150.0, + "mean_gray": 78.27115716753022, + "std_gray": 63.61048930355877 + }, + "geometry": { + "distance_to_center_norm": 0.17525053024291992, + "distance_to_border_px": 212.0 + }, + "edge_ratio": 1.0252461268984039, + "edge_lengths_px": [ + 29.698484420776367, + 29.068883895874023, + 29.0, + 29.73213768005371 + ] + }, + "confidence": 0.5595404377699383 + }, + { + "observation_id": "45f5d0e6-014c-4e1c-bd98-07487b318446", + "type": "aruco", + "marker_id": 84, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 86.0, + 662.0 + ], + [ + 62.0, + 682.0 + ], + [ + 45.0, + 662.0 + ], + [ + 68.0, + 642.0 + ] + ], + "center_px": [ + 65.25, + 662.0 + ], + "quality": { + "area_px": 820.0, + "perimeter_px": 114.87655830383301, + "sharpness": { + "laplacian_var": 4622.010696713017 + }, + "contrast": { + "p05": 10.0, + "p95": 160.0, + "dynamic_range": 150.0, + "mean_gray": 80.29326047358835, + "std_gray": 64.80880926122214 + }, + "geometry": { + "distance_to_center_norm": 0.8841893672943115, + "distance_to_border_px": 38.0 + }, + "edge_ratio": 1.1901872672565836, + "edge_lengths_px": [ + 31.240999221801758, + 26.248809814453125, + 30.479501724243164, + 26.90724754333496 + ] + }, + "confidence": 0.3490767193505014 + }, + { + "observation_id": "fd4ce98c-b37f-404c-a7f6-8ad633d3d57e", + "type": "aruco", + "marker_id": 64, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 840.0, + 647.0 + ], + [ + 820.0, + 667.0 + ], + [ + 799.0, + 647.0 + ], + [ + 819.0, + 627.0 + ] + ], + "center_px": [ + 819.5, + 647.0 + ], + "quality": { + "area_px": 820.0, + "perimeter_px": 114.56854248046875, + "sharpness": { + "laplacian_var": 3878.055503745476 + }, + "contrast": { + "p05": 41.0, + "p95": 184.0, + "dynamic_range": 143.0, + "mean_gray": 94.43302752293577, + "std_gray": 61.879874831666626 + }, + "geometry": { + "distance_to_center_norm": 0.4609958529472351, + "distance_to_border_px": 53.0 + }, + "edge_ratio": 1.0253048329824916, + "edge_lengths_px": [ + 28.284271240234375, + 29.0, + 28.284271240234375, + 29.0 + ] + }, + "confidence": 0.5331747682067169 + }, + { + "observation_id": "718b1530-953b-4f1a-a6e6-48d3175820c1", + "type": "aruco", + "marker_id": 72, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 123.0, + 581.0 + ], + [ + 99.0, + 600.0 + ], + [ + 82.0, + 581.0 + ], + [ + 105.0, + 562.0 + ] + ], + "center_px": [ + 102.25, + 581.0 + ], + "quality": { + "area_px": 779.0, + "perimeter_px": 112.11092758178711, + "sharpness": { + "laplacian_var": 3159.2503815930804 + }, + "contrast": { + "p05": 10.0, + "p95": 160.0, + "dynamic_range": 150.0, + "mean_gray": 56.17669172932331, + "std_gray": 61.66842867969203 + }, + "geometry": { + "distance_to_center_norm": 0.7917603254318237, + "distance_to_border_px": 82.0 + }, + "edge_ratio": 1.2006408576968535, + "edge_lengths_px": [ + 30.610456466674805, + 25.495098114013672, + 29.832868576049805, + 26.172504425048828 + ] + }, + "confidence": 0.43254677700170213 + }, + { + "observation_id": "50473352-4974-44cc-8b28-1ee90828fec1", + "type": "aruco", + "marker_id": 53, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 72.0, + 559.0 + ], + [ + 49.0, + 578.0 + ], + [ + 32.0, + 559.0 + ], + [ + 55.0, + 540.0 + ] + ], + "center_px": [ + 52.0, + 559.0 + ], + "quality": { + "area_px": 760.0, + "perimeter_px": 110.65593338012695, + "sharpness": { + "laplacian_var": 4106.049055910453 + }, + "contrast": { + "p05": 10.0, + "p95": 160.0, + "dynamic_range": 150.0, + "mean_gray": 90.30639097744361, + "std_gray": 65.45711243385217 + }, + "geometry": { + "distance_to_center_norm": 0.8453760743141174, + "distance_to_border_px": 32.0 + }, + "edge_ratio": 1.170141351982161, + "edge_lengths_px": [ + 29.832868576049805, + 25.495098114013672, + 29.832868576049805, + 25.495098114013672 + ] + }, + "confidence": 0.27711751756945874 + }, + { + "observation_id": "069bc891-0c1d-4796-8041-483cf43b4bd5", + "type": "aruco", + "marker_id": 58, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 801.0, + 564.0 + ], + [ + 782.0, + 583.0 + ], + [ + 761.0, + 564.0 + ], + [ + 780.0, + 545.0 + ] + ], + "center_px": [ + 781.0, + 564.0 + ], + "quality": { + "area_px": 760.0, + "perimeter_px": 110.37932586669922, + "sharpness": { + "laplacian_var": 4240.313421146316 + }, + "contrast": { + "p05": 38.0, + "p95": 184.0, + "dynamic_range": 146.0, + "mean_gray": 91.30943396226415, + "std_gray": 62.58861269673776 + }, + "geometry": { + "distance_to_center_norm": 0.33771631121635437, + "distance_to_border_px": 137.0 + }, + "edge_ratio": 1.053946545658541, + "edge_lengths_px": [ + 26.870058059692383, + 28.319604873657227, + 26.870058059692383, + 28.319604873657227 + ] + }, + "confidence": 0.48073279309443956 + }, + { + "observation_id": "31cbfbb4-3b38-4d24-bbe5-76e3ebcd2342", + "type": "aruco", + "marker_id": 69, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 889.0, + 547.0 + ], + [ + 871.0, + 566.0 + ], + [ + 849.0, + 548.0 + ], + [ + 867.0, + 529.0 + ] + ], + "center_px": [ + 869.0, + 547.5 + ], + "quality": { + "area_px": 742.0, + "perimeter_px": 109.1956901550293, + "sharpness": { + "laplacian_var": 4113.315773399943 + }, + "contrast": { + "p05": 44.0, + "p95": 185.29999999999995, + "dynamic_range": 141.29999999999995, + "mean_gray": 96.88543689320389, + "std_gray": 60.64802545672378 + }, + "geometry": { + "distance_to_center_norm": 0.40306055545806885, + "distance_to_border_px": 154.0 + }, + "edge_ratio": 1.0860764484296306, + "edge_lengths_px": [ + 26.172504425048828, + 28.42534065246582, + 26.172504425048828, + 28.42534065246582 + ] + }, + "confidence": 0.45546210617301425 + }, + { + "observation_id": "43be8184-5d86-494e-8455-2e1de0158509", + "type": "aruco", + "marker_id": 103, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 728.0, + 543.0 + ], + [ + 709.0, + 562.0 + ], + [ + 688.0, + 544.0 + ], + [ + 708.0, + 525.0 + ] + ], + "center_px": [ + 708.25, + 543.5 + ], + "quality": { + "area_px": 740.5, + "perimeter_px": 109.02216911315918, + "sharpness": { + "laplacian_var": 3703.9558686623423 + }, + "contrast": { + "p05": 34.0, + "p95": 182.0, + "dynamic_range": 148.0, + "mean_gray": 122.44054580896686, + "std_gray": 65.20366109632847 + }, + "geometry": { + "distance_to_center_norm": 0.2666221559047699, + "distance_to_border_px": 158.0 + }, + "edge_ratio": 1.0293477641301256, + "edge_lengths_px": [ + 26.870058059692383, + 27.658634185791016, + 27.58622932434082, + 26.90724754333496 + ] + }, + "confidence": 0.4795917219326271 + }, + { + "observation_id": "27ed2049-3429-4cc9-995a-c884469fdc63", + "type": "aruco", + "marker_id": 56, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 104.0, + 515.0 + ], + [ + 81.0, + 533.0 + ], + [ + 65.0, + 515.0 + ], + [ + 87.0, + 496.0 + ] + ], + "center_px": [ + 84.25, + 514.75 + ], + "quality": { + "area_px": 721.5, + "perimeter_px": 107.85333442687988, + "sharpness": { + "laplacian_var": 3116.4511549612603 + }, + "contrast": { + "p05": 9.0, + "p95": 157.0, + "dynamic_range": 148.0, + "mean_gray": 48.32553606237817, + "std_gray": 57.67284615975553 + }, + "geometry": { + "distance_to_center_norm": 0.7856342196464539, + "distance_to_border_px": 65.0 + }, + "edge_ratio": 1.2127199347849176, + "edge_lengths_px": [ + 29.20616340637207, + 24.083189010620117, + 29.068883895874023, + 25.495098114013672 + ] + }, + "confidence": 0.39662908657084783 + }, + { + "observation_id": "07a21cf9-b4e7-4aaa-94fa-fba58b18f852", + "type": "aruco", + "marker_id": 215, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 503.0, + 514.0 + ], + [ + 485.0, + 495.0 + ], + [ + 506.0, + 477.0 + ], + [ + 524.0, + 496.0 + ] + ], + "center_px": [ + 504.5, + 495.5 + ], + "quality": { + "area_px": 723.0, + "perimeter_px": 107.66227722167969, + "sharpness": { + "laplacian_var": 582.9357029133371 + }, + "contrast": { + "p05": 2.0, + "p95": 71.0, + "dynamic_range": 69.0, + "mean_gray": 27.84990253411306, + "std_gray": 28.254394420763433 + }, + "geometry": { + "distance_to_center_norm": 0.2609632611274719, + "distance_to_border_px": 206.0 + }, + "edge_ratio": 1.056782099894111, + "edge_lengths_px": [ + 26.172504425048828, + 27.658634185791016, + 26.172504425048828, + 27.658634185791016 + ] + }, + "confidence": 0.39338762460270227 + }, + { + "observation_id": "b6c8eeac-c98f-4888-ae24-8693039aa7e3", + "type": "aruco", + "marker_id": 46, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 61.0, + 498.0 + ], + [ + 38.0, + 516.0 + ], + [ + 22.0, + 498.0 + ], + [ + 45.0, + 480.0 + ] + ], + "center_px": [ + 41.5, + 498.0 + ], + "quality": { + "area_px": 702.0, + "perimeter_px": 106.57870483398438, + "sharpness": { + "laplacian_var": 3995.4965160782485 + }, + "contrast": { + "p05": 9.0, + "p95": 156.0, + "dynamic_range": 147.0, + "mean_gray": 82.92585170340682, + "std_gray": 63.90737687202768 + }, + "geometry": { + "distance_to_center_norm": 0.8364452719688416, + "distance_to_border_px": 22.0 + }, + "edge_ratio": 1.2127199347849176, + "edge_lengths_px": [ + 29.20616340637207, + 24.083189010620117, + 29.20616340637207, + 24.083189010620117 + ] + }, + "confidence": 0.1698001278724927 + }, + { + "observation_id": "3e5c27a2-ab64-4ee0-aa2d-d67fb6a0d612", + "type": "aruco", + "marker_id": 68, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 49.0, + 458.0 + ], + [ + 26.0, + 476.0 + ], + [ + 10.0, + 458.0 + ], + [ + 32.0, + 440.0 + ] + ], + "center_px": [ + 29.25, + 458.0 + ], + "quality": { + "area_px": 702.0, + "perimeter_px": 106.47352981567383, + "sharpness": { + "laplacian_var": 3711.328518394066 + }, + "contrast": { + "p05": 8.0, + "p95": 155.0, + "dynamic_range": 147.0, + "mean_gray": 60.0, + "std_gray": 60.87411558031966 + }, + "geometry": { + "distance_to_center_norm": 0.8423811793327332, + "distance_to_border_px": 10.0 + }, + "edge_ratio": 1.2127199347849176, + "edge_lengths_px": [ + 29.20616340637207, + 24.083189010620117, + 28.42534065246582, + 24.75883674621582 + ] + }, + "confidence": 0.07718187630567852 + }, + { + "observation_id": "bfb2b60b-91be-4600-a455-d241059d97b2", + "type": "aruco", + "marker_id": 208, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 423.0, + 436.0 + ], + [ + 405.0, + 417.0 + ], + [ + 426.0, + 400.0 + ], + [ + 444.0, + 418.0 + ] + ], + "center_px": [ + 424.5, + 417.75 + ], + "quality": { + "area_px": 703.5, + "perimeter_px": 106.30549621582031, + "sharpness": { + "laplacian_var": 2826.766498386699 + }, + "contrast": { + "p05": 14.0, + "p95": 151.2, + "dynamic_range": 137.2, + "mean_gray": 61.40643863179074, + "std_gray": 57.4109738491046 + }, + "geometry": { + "distance_to_center_norm": 0.3038310110569, + "distance_to_border_px": 284.0 + }, + "edge_ratio": 1.0865337338869794, + "edge_lengths_px": [ + 26.172504425048828, + 27.018512725830078, + 25.45584487915039, + 27.658634185791016 + ] + }, + "confidence": 0.4316478958478293 + }, + { + "observation_id": "78212b6e-1c4a-40aa-b372-6ec39b06ddd5", + "type": "aruco", + "marker_id": 42, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 527.0, + 198.0 + ], + [ + 508.0, + 211.0 + ], + [ + 520.0, + 186.0 + ], + [ + 539.0, + 171.0 + ] + ], + "center_px": [ + 523.5, + 191.5 + ], + "quality": { + "area_px": 326.0, + "perimeter_px": 104.50658798217773, + "sharpness": { + "laplacian_var": 1613.9235894698782 + }, + "contrast": { + "p05": 19.0, + "p95": 81.0, + "dynamic_range": 62.0, + "mean_gray": 37.55601659751037, + "std_gray": 22.897887504796095 + }, + "geometry": { + "distance_to_center_norm": 0.2789755165576935, + "distance_to_border_px": 171.0 + }, + "edge_ratio": 1.2834211653074858, + "edge_lengths_px": [ + 23.021728515625, + 27.73084831237793, + 24.20743751525879, + 29.546573638916016 + ] + }, + "confidence": 0.13123777126815542 + }, + { + "observation_id": "e8528f6e-83b0-4d0c-82b3-543813673e73", + "type": "aruco", + "marker_id": 41, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 528.0, + 266.0 + ], + [ + 495.0, + 254.0 + ], + [ + 504.0, + 240.0 + ], + [ + 537.0, + 252.0 + ] + ], + "center_px": [ + 516.0, + 253.0 + ], + "quality": { + "area_px": 570.0, + "perimeter_px": 103.51483535766602, + "sharpness": { + "laplacian_var": 3325.5749954907365 + }, + "contrast": { + "p05": 25.0, + "p95": 185.0, + "dynamic_range": 160.0, + "mean_gray": 73.52030456852792, + "std_gray": 61.639906019724236 + }, + "geometry": { + "distance_to_center_norm": 0.22304624319076538, + "distance_to_border_px": 240.0 + }, + "edge_ratio": 2.1098019675010837, + "edge_lengths_px": [ + 35.11410140991211, + 16.6433162689209, + 35.11410140991211, + 16.6433162689209 + ] + }, + "confidence": 0.1801116909802127 + }, + { + "observation_id": "f3eb45b1-dd31-4d9b-879a-528c91637014", + "type": "aruco", + "marker_id": 95, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 730.0, + 415.0 + ], + [ + 711.0, + 433.0 + ], + [ + 692.0, + 415.0 + ], + [ + 710.0, + 398.0 + ] + ], + "center_px": [ + 710.75, + 415.25 + ], + "quality": { + "area_px": 665.0, + "perimeter_px": 103.3526554107666, + "sharpness": { + "laplacian_var": 3879.2134925852874 + }, + "contrast": { + "p05": 30.0, + "p95": 182.0, + "dynamic_range": 152.0, + "mean_gray": 93.47008547008546, + "std_gray": 66.77066537554909 + }, + "geometry": { + "distance_to_center_norm": 0.1222480833530426, + "distance_to_border_px": 287.0 + }, + "edge_ratio": 1.0601794455656337, + "edge_lengths_px": [ + 26.172504425048828, + 26.172504425048828, + 24.75883674621582, + 26.248809814453125 + ] + }, + "confidence": 0.4181682027393045 + }, + { + "observation_id": "fdd51327-b1bc-4bf0-84bb-5bdcc185ca80", + "type": "aruco", + "marker_id": 55, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 641.0, + 352.0 + ], + [ + 623.0, + 369.0 + ], + [ + 604.0, + 351.0 + ], + [ + 623.0, + 335.0 + ] + ], + "center_px": [ + 622.75, + 351.75 + ], + "quality": { + "area_px": 629.0, + "perimeter_px": 100.5296630859375, + "sharpness": { + "laplacian_var": 4175.852684959178 + }, + "contrast": { + "p05": 24.0, + "p95": 179.0, + "dynamic_range": 155.0, + "mean_gray": 90.11467889908256, + "std_gray": 67.32224754037642 + }, + "geometry": { + "distance_to_center_norm": 0.026040121912956238, + "distance_to_border_px": 335.0 + }, + "edge_ratio": 1.057097499907748, + "edge_lengths_px": [ + 24.75883674621582, + 26.172504425048828, + 24.83948516845703, + 24.75883674621582 + ] + }, + "confidence": 0.39668368657567366 + }, + { + "observation_id": "8c0b3594-6716-47eb-b2ef-bd9194bdd836", + "type": "aruco", + "marker_id": 66, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 780.0, + 332.0 + ], + [ + 763.0, + 349.0 + ], + [ + 743.0, + 333.0 + ], + [ + 760.0, + 316.0 + ] + ], + "center_px": [ + 761.5, + 332.5 + ], + "quality": { + "area_px": 612.0, + "perimeter_px": 99.30825424194336, + "sharpness": { + "laplacian_var": 4010.7918145350113 + }, + "contrast": { + "p05": 30.0, + "p95": 182.0, + "dynamic_range": 152.0, + "mean_gray": 80.78384798099762, + "std_gray": 63.73451710202778 + }, + "geometry": { + "distance_to_center_norm": 0.16964846849441528, + "distance_to_border_px": 316.0 + }, + "edge_ratio": 1.0653394779010876, + "edge_lengths_px": [ + 24.041629791259766, + 25.612497329711914, + 24.041629791259766, + 25.612497329711914 + ] + }, + "confidence": 0.3829765144945479 + }, + { + "observation_id": "8ccee9fb-eff5-460d-887a-db981f1e6267", + "type": "aruco", + "marker_id": 217, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 199.0, + 218.0 + ], + [ + 183.0, + 202.0 + ], + [ + 204.0, + 186.0 + ], + [ + 220.0, + 202.0 + ] + ], + "center_px": [ + 201.5, + 202.0 + ], + "quality": { + "area_px": 592.0, + "perimeter_px": 98.05634689331055, + "sharpness": { + "laplacian_var": 3645.144319202116 + }, + "contrast": { + "p05": 10.0, + "p95": 165.0, + "dynamic_range": 155.0, + "mean_gray": 70.0960591133005, + "std_gray": 63.48420643930294 + }, + "geometry": { + "distance_to_center_norm": 0.6347478032112122, + "distance_to_border_px": 183.0 + }, + "edge_ratio": 1.1667596566650227, + "edge_lengths_px": [ + 22.627416610717773, + 26.4007568359375, + 22.627416610717773, + 26.4007568359375 + ] + }, + "confidence": 0.3382587531306593 + }, + { + "observation_id": "186dbe67-bf7a-49ce-9308-01108929bba3", + "type": "aruco", + "marker_id": 97, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 701.0, + 268.0 + ], + [ + 683.0, + 285.0 + ], + [ + 665.0, + 269.0 + ], + [ + 682.0, + 253.0 + ] + ], + "center_px": [ + 682.75, + 268.75 + ], + "quality": { + "area_px": 576.5, + "perimeter_px": 96.39469909667969, + "sharpness": { + "laplacian_var": 3862.863279623074 + }, + "contrast": { + "p05": 25.0, + "p95": 179.0, + "dynamic_range": 154.0, + "mean_gray": 108.67091836734694, + "std_gray": 67.36237952052174 + }, + "geometry": { + "distance_to_center_norm": 0.13722912967205048, + "distance_to_border_px": 253.0 + }, + "edge_ratio": 1.0605520086518976, + "edge_lengths_px": [ + 24.75883674621582, + 24.083189010620117, + 23.34523582458496, + 24.20743751525879 + ] + }, + "confidence": 0.3623898971459892 + }, + { + "observation_id": "b8d38328-1d07-42c8-b91a-a7a8cc35f3cc", + "type": "aruco", + "marker_id": 54, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 648.0, + 262.0 + ], + [ + 631.0, + 278.0 + ], + [ + 612.0, + 263.0 + ], + [ + 630.0, + 247.0 + ] + ], + "center_px": [ + 630.25, + 262.5 + ], + "quality": { + "area_px": 558.5, + "perimeter_px": 95.06661224365234, + "sharpness": { + "laplacian_var": 3569.1988256207833 + }, + "contrast": { + "p05": 22.0, + "p95": 177.0, + "dynamic_range": 155.0, + "mean_gray": 59.98941798941799, + "std_gray": 58.87121532498847 + }, + "geometry": { + "distance_to_center_norm": 0.13344134390354156, + "distance_to_border_px": 247.0 + }, + "edge_ratio": 1.0369326614283263, + "edge_lengths_px": [ + 23.34523582458496, + 24.20743751525879, + 24.083189010620117, + 23.430749893188477 + ] + }, + "confidence": 0.3590718541167963 + }, + { + "observation_id": "9fa962b4-251e-4879-a12a-f90e54dbce8a", + "type": "aruco", + "marker_id": 205, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 130.0, + 150.0 + ], + [ + 115.0, + 135.0 + ], + [ + 136.0, + 120.0 + ], + [ + 151.0, + 135.0 + ] + ], + "center_px": [ + 133.0, + 135.0 + ], + "quality": { + "area_px": 540.0, + "perimeter_px": 94.04035949707031, + "sharpness": { + "laplacian_var": 3633.0481789423593 + }, + "contrast": { + "p05": 9.0, + "p95": 163.0, + "dynamic_range": 154.0, + "mean_gray": 78.17989417989418, + "std_gray": 62.911791931322114 + }, + "geometry": { + "distance_to_center_norm": 0.7553886771202087, + "distance_to_border_px": 115.0 + }, + "edge_ratio": 1.216552530753038, + "edge_lengths_px": [ + 21.21320343017578, + 25.806976318359375, + 21.21320343017578, + 25.806976318359375 + ] + }, + "confidence": 0.29591817114314195 + }, + { + "observation_id": "8b182704-9e9e-4a36-ac00-c39745027753", + "type": "aruco", + "marker_id": 92, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 309.0, + 157.0 + ], + [ + 289.0, + 172.0 + ], + [ + 273.0, + 157.0 + ], + [ + 293.0, + 142.0 + ] + ], + "center_px": [ + 291.0, + 157.0 + ], + "quality": { + "area_px": 540.0, + "perimeter_px": 93.8634262084961, + "sharpness": { + "laplacian_var": 3374.5356512975563 + }, + "contrast": { + "p05": 11.0, + "p95": 167.0, + "dynamic_range": 156.0, + "mean_gray": 63.473544973544975, + "std_gray": 63.53947728103725 + }, + "geometry": { + "distance_to_center_norm": 0.5498347282409668, + "distance_to_border_px": 142.0 + }, + "edge_ratio": 1.1399018344425471, + "edge_lengths_px": [ + 25.0, + 21.931713104248047, + 25.0, + 21.931713104248047 + ] + }, + "confidence": 0.3158166687011719 + }, + { + "observation_id": "adc4586c-3e2d-4546-acd1-44e89a09bc38", + "type": "aruco", + "marker_id": 105, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 460.0, + 183.0 + ], + [ + 441.0, + 198.0 + ], + [ + 425.0, + 182.0 + ], + [ + 444.0, + 168.0 + ] + ], + "center_px": [ + 442.5, + 182.75 + ], + "quality": { + "area_px": 526.5, + "perimeter_px": 92.3674144744873, + "sharpness": { + "laplacian_var": 2584.1210283355226 + }, + "contrast": { + "p05": 14.0, + "p95": 168.0, + "dynamic_range": 154.0, + "mean_gray": 43.797260273972604, + "std_gray": 52.64934393847121 + }, + "geometry": { + "distance_to_center_norm": 0.36139723658561707, + "distance_to_border_px": 168.0 + }, + "edge_ratio": 1.1037640972318732, + "edge_lengths_px": [ + 24.20743751525879, + 22.627416610717773, + 23.600847244262695, + 21.931713104248047 + ] + }, + "confidence": 0.31800273344664126 + }, + { + "observation_id": "f4ce4955-ed6c-46fd-bc5d-10699583a141", + "type": "aruco", + "marker_id": 85, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 511.0, + 166.0 + ], + [ + 493.0, + 181.0 + ], + [ + 476.0, + 166.0 + ], + [ + 496.0, + 151.0 + ] + ], + "center_px": [ + 494.0, + 166.0 + ], + "quality": { + "area_px": 525.0, + "perimeter_px": 92.31552124023438, + "sharpness": { + "laplacian_var": 3988.960863329007 + }, + "contrast": { + "p05": 17.0, + "p95": 172.89999999999998, + "dynamic_range": 155.89999999999998, + "mean_gray": 125.2892561983471, + "std_gray": 58.87060630547796 + }, + "geometry": { + "distance_to_center_norm": 0.33065441250801086, + "distance_to_border_px": 151.0 + }, + "edge_ratio": 1.1785113022787261, + "edge_lengths_px": [ + 23.430749893188477, + 22.671567916870117, + 25.0, + 21.21320343017578 + ] + }, + "confidence": 0.2969848480224609 + }, + { + "observation_id": "4fba6bdb-916d-4ed7-8689-4fd3a0d0ae97", + "type": "aruco", + "marker_id": 102, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 336.0, + 130.0 + ], + [ + 317.0, + 145.0 + ], + [ + 301.0, + 130.0 + ], + [ + 320.0, + 115.0 + ] + ], + "center_px": [ + 318.5, + 130.0 + ], + "quality": { + "area_px": 525.0, + "perimeter_px": 92.27830123901367, + "sharpness": { + "laplacian_var": 4094.997830737474 + }, + "contrast": { + "p05": 12.0, + "p95": 168.0, + "dynamic_range": 156.0, + "mean_gray": 102.7068493150685, + "std_gray": 63.62690119616552 + }, + "geometry": { + "distance_to_center_norm": 0.5383343696594238, + "distance_to_border_px": 115.0 + }, + "edge_ratio": 1.1037640972318732, + "edge_lengths_px": [ + 24.20743751525879, + 21.931713104248047, + 24.20743751525879, + 21.931713104248047 + ] + }, + "confidence": 0.3170967427530611 + }, + { + "observation_id": "af0d7507-a881-4563-8287-772400f0cc42", + "type": "aruco", + "marker_id": 59, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 397.0, + 109.0 + ], + [ + 379.0, + 124.0 + ], + [ + 362.0, + 109.0 + ], + [ + 381.0, + 94.0 + ] + ], + "center_px": [ + 379.75, + 109.0 + ], + "quality": { + "area_px": 525.0, + "perimeter_px": 92.24146842956543, + "sharpness": { + "laplacian_var": 3375.194925877275 + }, + "contrast": { + "p05": 12.0, + "p95": 169.0, + "dynamic_range": 157.0, + "mean_gray": 99.71506849315068, + "std_gray": 66.8933390857147 + }, + "geometry": { + "distance_to_center_norm": 0.49239593744277954, + "distance_to_border_px": 94.0 + }, + "edge_ratio": 1.1037640972318732, + "edge_lengths_px": [ + 23.430749893188477, + 22.671567916870117, + 24.20743751525879, + 21.931713104248047 + ] + }, + "confidence": 0.3170967427530611 + }, + { + "observation_id": "10c76166-3fc9-4980-9109-338dbdc4e802", + "type": "aruco", + "marker_id": 113, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 523.0, + 392.0 + ], + [ + 494.0, + 380.0 + ], + [ + 489.0, + 367.0 + ], + [ + 519.0, + 379.0 + ] + ], + "center_px": [ + 506.25, + 379.5 + ], + "quality": { + "area_px": 329.5, + "perimeter_px": 91.22555923461914, + "sharpness": { + "laplacian_var": 960.690516374605 + }, + "contrast": { + "p05": 18.0, + "p95": 87.0, + "dynamic_range": 69.0, + "mean_gray": 35.29237288135593, + "std_gray": 23.67441820658496 + }, + "geometry": { + "distance_to_center_norm": 0.18407133221626282, + "distance_to_border_px": 328.0 + }, + "edge_ratio": 2.375551108049711, + "edge_lengths_px": [ + 31.38471031188965, + 13.928388595581055, + 32.31098937988281, + 13.601470947265625 + ] + }, + "confidence": 0.07975517738094284 + }, + { + "observation_id": "28060a2c-5c51-460a-b704-bc555cf4c689", + "type": "aruco", + "marker_id": 48, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 387.0, + 44.0 + ], + [ + 368.0, + 59.0 + ], + [ + 352.0, + 44.0 + ], + [ + 371.0, + 30.0 + ] + ], + "center_px": [ + 369.5, + 44.25 + ], + "quality": { + "area_px": 507.5, + "perimeter_px": 91.00028991699219, + "sharpness": { + "laplacian_var": 3261.5671683242635 + }, + "contrast": { + "p05": 11.0, + "p95": 167.0, + "dynamic_range": 156.0, + "mean_gray": 62.131506849315066, + "std_gray": 62.01987502187831 + }, + "geometry": { + "distance_to_center_norm": 0.5662168264389038, + "distance_to_border_px": 30.0 + }, + "edge_ratio": 1.1386220591259189, + "edge_lengths_px": [ + 24.20743751525879, + 21.931713104248047, + 23.600847244262695, + 21.260292053222656 + ] + }, + "confidence": 0.17828567290874034 + }, + { + "observation_id": "03fa5394-a5fb-4441-8a32-f20f622a3ab7", + "type": "aruco", + "marker_id": 57, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 480.0, + 71.0 + ], + [ + 462.0, + 85.0 + ], + [ + 446.0, + 70.0 + ], + [ + 464.0, + 56.0 + ] + ], + "center_px": [ + 463.0, + 70.5 + ], + "quality": { + "area_px": 494.0, + "perimeter_px": 89.47044372558594, + "sharpness": { + "laplacian_var": 4670.437491929235 + }, + "contrast": { + "p05": 13.0, + "p95": 171.0, + "dynamic_range": 158.0, + "mean_gray": 84.45170454545455, + "std_gray": 65.03327773535342 + }, + "geometry": { + "distance_to_center_norm": 0.4621008336544037, + "distance_to_border_px": 56.0 + }, + "edge_ratio": 1.0397504586236819, + "edge_lengths_px": [ + 22.803508758544922, + 21.931713104248047, + 22.803508758544922, + 21.931713104248047 + ] + }, + "confidence": 0.3167426670523156 + }, + { + "observation_id": "1f56f17a-56fe-4e30-96bc-7138bfddeeb2", + "type": "aruco", + "marker_id": 63, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 260.0, + 42.0 + ], + [ + 241.0, + 56.0 + ], + [ + 226.0, + 42.0 + ], + [ + 245.0, + 28.0 + ] + ], + "center_px": [ + 243.0, + 42.0 + ], + "quality": { + "area_px": 476.0, + "perimeter_px": 88.23826217651367, + "sharpness": { + "laplacian_var": 3207.674136059662 + }, + "contrast": { + "p05": 9.0, + "p95": 163.0, + "dynamic_range": 154.0, + "mean_gray": 54.16568047337278, + "std_gray": 59.906799455376174 + }, + "geometry": { + "distance_to_center_norm": 0.6927092671394348, + "distance_to_border_px": 28.0 + }, + "edge_ratio": 1.1502349525772275, + "edge_lengths_px": [ + 23.600847244262695, + 20.51828384399414, + 23.600847244262695, + 20.51828384399414 + ] + }, + "confidence": 0.15449597168691093 + }, + { + "observation_id": "ad23479c-f3bd-4090-a23f-afede230b015", + "type": "aruco", + "marker_id": 71, + "marker_size_m": 0.025, + "image_points_px": [ + [ + 316.0, + 30.0 + ], + [ + 297.0, + 43.0 + ], + [ + 282.0, + 29.0 + ], + [ + 302.0, + 16.0 + ] + ], + "center_px": [ + 299.25, + 29.5 + ], + "quality": { + "area_px": 461.5, + "perimeter_px": 87.19272422790527, + "sharpness": { + "laplacian_var": 4543.295715211096 + }, + "contrast": { + "p05": 10.0, + "p95": 165.0, + "dynamic_range": 155.0, + "mean_gray": 102.7746913580247, + "std_gray": 63.54507859617162 + }, + "geometry": { + "distance_to_center_norm": 0.646465003490448, + "distance_to_border_px": 16.0 + }, + "edge_ratio": 1.2047948566010105, + "edge_lengths_px": [ + 23.021728515625, + 20.51828384399414, + 23.853721618652344, + 19.79899024963379 + ] + }, + "confidence": 0.08171792300897739 + } + ], + "rejected_candidates": [ + { + "image_points_px": [ + [ + 477.0, + 441.0 + ], + [ + 513.0, + 473.0 + ], + [ + 495.0, + 467.0 + ], + [ + 482.0, + 453.0 + ] + ], + "center_px": [ + 491.75, + 458.5 + ], + "area_px": 223.0 + }, + { + "image_points_px": [ + [ + 492.0, + 291.0 + ], + [ + 496.0, + 304.0 + ], + [ + 480.0, + 333.0 + ], + [ + 478.0, + 317.0 + ] + ], + "center_px": [ + 486.5, + 311.25 + ], + "area_px": 300.0 + }, + { + "image_points_px": [ + [ + 587.0, + 506.0 + ], + [ + 598.0, + 521.0 + ], + [ + 580.0, + 536.0 + ], + [ + 566.0, + 524.0 + ] + ], + "center_px": [ + 582.75, + 521.75 + ], + "area_px": 469.5 + }, + { + "image_points_px": [ + [ + 552.0, + 443.0 + ], + [ + 537.0, + 440.0 + ], + [ + 529.0, + 435.0 + ], + [ + 550.0, + 433.0 + ] + ], + "center_px": [ + 542.0, + 437.75 + ], + "area_px": 132.5 + }, + { + "image_points_px": [ + [ + 569.0, + 312.0 + ], + [ + 569.0, + 317.0 + ], + [ + 559.0, + 333.0 + ], + [ + 562.0, + 320.0 + ] + ], + "center_px": [ + 564.75, + 320.5 + ], + "area_px": 58.5 + }, + { + "image_points_px": [ + [ + 273.0, + 678.0 + ], + [ + 275.0, + 678.0 + ], + [ + 290.0, + 692.0 + ], + [ + 281.0, + 687.0 + ] + ], + "center_px": [ + 279.75, + 683.75 + ], + "area_px": 34.5 + } + ] +} \ No newline at end of file diff --git a/data/evaluations/Scene8/render_g_camera_pose.json b/data/evaluations/Scene8/render_g_camera_pose.json new file mode 100644 index 0000000..3004fe2 --- /dev/null +++ b/data/evaluations/Scene8/render_g_camera_pose.json @@ -0,0 +1,596 @@ +{ + "schema_version": "1.0", + "created_utc": "2026-06-01T18:36:49Z", + "source": { + "detection_json": "C:\\Users\\kech\\SynologyDrive\\2026-AppServer-AppRobot\\appRobotRendering\\data\\evaluations\\Scene8\\render_g_aruco_detection.json", + "robot_json": "C:\\Users\\kech\\SynologyDrive\\2026-AppServer-AppRobot\\appRobotRendering\\data\\robot\\robot.json" + }, + "camera": { + "camera_id": "g", + "camera_matrix": [ + [ + 1777.77783203125, + 0.0, + 640.0 + ], + [ + 0.0, + 1777.77783203125, + 360.0 + ], + [ + 0.0, + 0.0, + 1.0 + ] + ], + "distortion_coefficients": [ + 0.0, + 0.0, + 0.0, + 0.0, + 0.0 + ] + }, + "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": 28, + "used_marker_ids": [ + 84, + 64, + 72, + 53, + 58, + 69, + 103, + 56, + 215, + 46, + 68, + 208, + 95, + 55, + 66, + 217, + 97, + 54, + 205, + 92, + 105, + 85, + 102, + 59, + 48, + 57, + 63, + 71 + ], + "history": { + "iters": [ + 0, + 1, + 2, + 3, + 4 + ], + "rms": [ + 0.008380596797804013, + 0.0005410758584715768, + 8.709259916235042e-05, + 8.70385355675932e-05, + 8.703853441047451e-05 + ], + "lambda": [ + 0.001, + 0.0005, + 0.00025, + 0.000125, + 6.25e-05 + ] + }, + "residual_rms_px": 0.2188329588756622, + "residual_median_px": 0.17794355789098962, + "residual_max_px": 0.4241965193657976, + "sigma2_normalized": 8.484791248994484e-09 + }, + "camera_pose": { + "world_to_camera": { + "rotation_matrix": [ + [ + -0.7071990370750427, + -0.707014262676239, + 0.0005838429206050932 + ], + [ + -0.6415448188781738, + 0.6413649320602417, + -0.4207983911037445 + ], + [ + 0.29713600873947144, + -0.2979627847671509, + -0.9071540236473083 + ] + ], + "translation_m": [ + -0.00035469781141728163, + 0.33173155784606934, + 1.3885538578033447 + ], + "rvec_rad": [ + 1.1162839608628714, + -2.694954763187016, + 0.5949621099248436 + ] + }, + "camera_in_world": { + "position_m": [ + -0.20001952350139618, + 0.20072562992572784, + 1.3992245197296143 + ], + "position_mm": [ + -200.01951599121094, + 200.7256317138672, + 1399.2244873046875 + ], + "orientation_deg": { + "roll": -161.81675720214844, + "pitch": -17.285663604736328, + "yaw": -137.78683471679688 + } + }, + "uncertainty": { + "pose_covariance_6x6": [ + [ + 3.9202614266929536e-08, + -5.624758064579657e-08, + 1.9002092979602563e-08, + 3.677793045991329e-09, + 9.642384554519452e-09, + 3.500057257207911e-08 + ], + [ + -5.624758064579686e-08, + 1.7730001193758587e-07, + -8.799489872535942e-08, + -2.7037218009021926e-08, + -1.6119859220649852e-08, + -9.32896875306131e-08 + ], + [ + 1.9002092979602557e-08, + -8.799489872535837e-08, + 3.322018445588287e-07, + 3.421511111216491e-08, + -1.9357076042169092e-08, + 2.3056213184165007e-09 + ], + [ + 3.6777930459913576e-09, + -2.7037218009021913e-08, + 3.4215111112165093e-08, + 7.574076973655562e-09, + -2.5214832959351115e-10, + 7.570328774670964e-09 + ], + [ + 9.642384554519472e-09, + -1.611985922064988e-08, + -1.9357076042168993e-08, + -2.5214832959349947e-10, + 5.455720841232948e-09, + 1.33187555209256e-08 + ], + [ + 3.5000572572079415e-08, + -9.328968753061321e-08, + 2.3056213184173316e-09, + 7.570328774670982e-09, + 1.3318755520925603e-08, + 7.751291617219285e-08 + ] + ], + "parameter_std": { + "rvec_std_deg": [ + 0.011344363845211298, + 0.024125538440537754, + 0.03302354197846344 + ], + "tvec_std_m": [ + 8.702917311830304e-05, + 7.38628515644566e-05, + 0.00027841141530510715 + ] + }, + "camera_center_std_m": [ + 0.0006001213331363563, + 0.0007005844631310261, + 0.00037386586549212754 + ], + "camera_center_std_mm": [ + 0.6001213331363563, + 0.7005844631310261, + 0.3738658654921275 + ], + "orientation_std_deg": { + "roll": 0.020799509337956407, + "pitch": 0.024459922187381827, + "yaw": 0.011530363449194381 + } + } + }, + "observations": { + "markers": [ + { + "marker_id": 84, + "observed_center_px": [ + 65.25, + 662.0 + ], + "projected_center_px": [ + 65.15103149414062, + 661.9536743164062 + ], + "reprojection_error_px": 0.10927412370943719, + "confidence": 0.3490767193505014 + }, + { + "marker_id": 64, + "observed_center_px": [ + 819.5, + 647.0 + ], + "projected_center_px": [ + 819.5327758789062, + 646.9321899414062 + ], + "reprojection_error_px": 0.07531575057426548, + "confidence": 0.5331747682067169 + }, + { + "marker_id": 72, + "observed_center_px": [ + 102.25, + 581.0 + ], + "projected_center_px": [ + 102.25408935546875, + 581.1792602539062 + ], + "reprojection_error_px": 0.17930689183264265, + "confidence": 0.43254677700170213 + }, + { + "marker_id": 53, + "observed_center_px": [ + 52.0, + 559.0 + ], + "projected_center_px": [ + 52.02786636352539, + 559.1117553710938 + ], + "reprojection_error_px": 0.11517724247624178, + "confidence": 0.27711751756945874 + }, + { + "marker_id": 58, + "observed_center_px": [ + 781.0, + 564.0 + ], + "projected_center_px": [ + 780.9808349609375, + 563.824462890625 + ], + "reprojection_error_px": 0.1765802239493366, + "confidence": 0.48073279309443956 + }, + { + "marker_id": 69, + "observed_center_px": [ + 869.0, + 547.5 + ], + "projected_center_px": [ + 868.9163208007812, + 547.3129272460938 + ], + "reprojection_error_px": 0.20493516934864944, + "confidence": 0.45546210617301425 + }, + { + "marker_id": 103, + "observed_center_px": [ + 708.25, + 543.5 + ], + "projected_center_px": [ + 708.2188720703125, + 543.635986328125 + ], + "reprojection_error_px": 0.139503510506188, + "confidence": 0.4795917219326271 + }, + { + "marker_id": 56, + "observed_center_px": [ + 84.25, + 514.75 + ], + "projected_center_px": [ + 84.41259765625, + 514.6609497070312 + ], + "reprojection_error_px": 0.185385955497749, + "confidence": 0.39662908657084783 + }, + { + "marker_id": 215, + "observed_center_px": [ + 504.5, + 495.5 + ], + "projected_center_px": [ + 504.49505615234375, + 495.4730224609375 + ], + "reprojection_error_px": 0.027426797908558738, + "confidence": 0.39338762460270227 + }, + { + "marker_id": 46, + "observed_center_px": [ + 41.5, + 498.0 + ], + "projected_center_px": [ + 41.32355880737305, + 498.03680419921875 + ], + "reprojection_error_px": 0.18023885134941084, + "confidence": 0.1698001278724927 + }, + { + "marker_id": 68, + "observed_center_px": [ + 29.25, + 458.0 + ], + "projected_center_px": [ + 29.114898681640625, + 458.09796142578125 + ], + "reprojection_error_px": 0.16687961877813764, + "confidence": 0.07718187630567852 + }, + { + "marker_id": 208, + "observed_center_px": [ + 424.5, + 417.75 + ], + "projected_center_px": [ + 424.3829650878906, + 417.7440185546875 + ], + "reprojection_error_px": 0.11718766291924913, + "confidence": 0.4316478958478293 + }, + { + "marker_id": 95, + "observed_center_px": [ + 710.75, + 415.25 + ], + "projected_center_px": [ + 710.908203125, + 415.144775390625 + ], + "reprojection_error_px": 0.19000117678026882, + "confidence": 0.4181682027393045 + }, + { + "marker_id": 55, + "observed_center_px": [ + 622.75, + 351.75 + ], + "projected_center_px": [ + 622.661376953125, + 351.86688232421875 + ], + "reprojection_error_px": 0.14668170353587198, + "confidence": 0.39668368657567366 + }, + { + "marker_id": 66, + "observed_center_px": [ + 761.5, + 332.5 + ], + "projected_center_px": [ + 761.3377075195312, + 332.7164611816406 + ], + "reprojection_error_px": 0.2705444369673035, + "confidence": 0.3829765144945479 + }, + { + "marker_id": 217, + "observed_center_px": [ + 201.5, + 202.0 + ], + "projected_center_px": [ + 201.80841064453125, + 201.79034423828125 + ], + "reprojection_error_px": 0.37292447503757425, + "confidence": 0.3382587531306593 + }, + { + "marker_id": 97, + "observed_center_px": [ + 682.75, + 268.75 + ], + "projected_center_px": [ + 682.692138671875, + 268.71795654296875 + ], + "reprojection_error_px": 0.06614163916098906, + "confidence": 0.3623898971459892 + }, + { + "marker_id": 54, + "observed_center_px": [ + 630.25, + 262.5 + ], + "projected_center_px": [ + 630.4234008789062, + 262.6108703613281 + ], + "reprojection_error_px": 0.20581569868814423, + "confidence": 0.3590718541167963 + }, + { + "marker_id": 205, + "observed_center_px": [ + 133.0, + 135.0 + ], + "projected_center_px": [ + 133.00042724609375, + 135.02919006347656 + ], + "reprojection_error_px": 0.029193190044775386, + "confidence": 0.29591817114314195 + }, + { + "marker_id": 92, + "observed_center_px": [ + 291.0, + 157.0 + ], + "projected_center_px": [ + 291.0001220703125, + 157.40155029296875 + ], + "reprojection_error_px": 0.40155031152328863, + "confidence": 0.3158166687011719 + }, + { + "marker_id": 105, + "observed_center_px": [ + 442.5, + 182.75 + ], + "projected_center_px": [ + 442.3433837890625, + 182.87738037109375 + ], + "reprojection_error_px": 0.20187718164369384, + "confidence": 0.31800273344664126 + }, + { + "marker_id": 85, + "observed_center_px": [ + 494.0, + 166.0 + ], + "projected_center_px": [ + 493.9403076171875, + 165.65689086914062 + ], + "reprojection_error_px": 0.3482629125314807, + "confidence": 0.2969848480224609 + }, + { + "marker_id": 102, + "observed_center_px": [ + 318.5, + 130.0 + ], + "projected_center_px": [ + 318.8728332519531, + 129.79766845703125 + ], + "reprojection_error_px": 0.4241965193657976, + "confidence": 0.3170967427530611 + }, + { + "marker_id": 59, + "observed_center_px": [ + 379.75, + 109.0 + ], + "projected_center_px": [ + 379.90716552734375, + 109.25081634521484 + ], + "reprojection_error_px": 0.29598959781075196, + "confidence": 0.3170967427530611 + }, + { + "marker_id": 48, + "observed_center_px": [ + 369.5, + 44.25 + ], + "projected_center_px": [ + 369.56671142578125, + 44.28301239013672 + ], + "reprojection_error_px": 0.0744327362946315, + "confidence": 0.17828567290874034 + }, + { + "marker_id": 57, + "observed_center_px": [ + 463.0, + 70.5 + ], + "projected_center_px": [ + 463.0251770019531, + 70.45142364501953 + ], + "reprojection_error_px": 0.054713286234114755, + "confidence": 0.3167426670523156 + }, + { + "marker_id": 63, + "observed_center_px": [ + 243.0, + 42.0 + ], + "projected_center_px": [ + 242.71270751953125, + 41.72708511352539 + ], + "reprojection_error_px": 0.3962568669352444, + "confidence": 0.15449597168691093 + }, + { + "marker_id": 71, + "observed_center_px": [ + 299.25, + 29.5 + ], + "projected_center_px": [ + 299.2705383300781, + 29.458524703979492 + ], + "reprojection_error_px": 0.04628199630943727, + "confidence": 0.08171792300897739 + } + ] + }, + "qa": { + "sanity_notes": [] + } +} \ No newline at end of file diff --git a/data/evaluations/Scene8/render_g_camera_pose_v8.json b/data/evaluations/Scene8/render_g_camera_pose_v8.json new file mode 100644 index 0000000..c527405 --- /dev/null +++ b/data/evaluations/Scene8/render_g_camera_pose_v8.json @@ -0,0 +1,597 @@ +{ + "schema_version": "1.0", + "created_utc": "2026-06-01T18:37:02Z", + "source": { + "detection_json": "C:\\Users\\kech\\SynologyDrive\\2026-AppServer-AppRobot\\appRobotRendering\\data\\evaluations\\Scene8\\render_g_aruco_detection.json", + "robot_json": "C:\\Users\\kech\\SynologyDrive\\2026-AppServer-AppRobot\\appRobotRendering\\data\\robot\\robot.json" + }, + "camera": { + "camera_id": "g", + "camera_matrix": [ + [ + 1777.77783203125, + 0.0, + 640.0 + ], + [ + 0.0, + 1777.77783203125, + 360.0 + ], + [ + 0.0, + 0.0, + 1.0 + ] + ], + "distortion_coefficients": [ + 0.0, + 0.0, + 0.0, + 0.0, + 0.0 + ] + }, + "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": 28, + "used_marker_ids": [ + 84, + 64, + 72, + 53, + 58, + 69, + 103, + 56, + 215, + 46, + 68, + 208, + 95, + 55, + 66, + 217, + 97, + 54, + 205, + 92, + 105, + 85, + 102, + 59, + 48, + 57, + 63, + 71 + ], + "history": { + "iters": [ + 0, + 1, + 2, + 3, + 4 + ], + "rms": [ + 0.008380596797804013, + 0.0005410758584715768, + 8.709259916235042e-05, + 8.70385355675932e-05, + 8.703853441047451e-05 + ], + "lambda": [ + 0.001, + 0.0005, + 0.00025, + 0.000125, + 6.25e-05 + ] + }, + "residual_rms_px": 0.2188329588756622, + "residual_median_px": 0.17794355789098962, + "residual_max_px": 0.4241965193657976, + "sigma2_normalized": 8.484791248994484e-09 + }, + "camera_pose": { + "world_to_camera": { + "rotation_matrix": [ + [ + -0.7071990370750427, + -0.707014262676239, + 0.0005838429206050932 + ], + [ + -0.6415448188781738, + 0.6413649320602417, + -0.4207983911037445 + ], + [ + 0.29713600873947144, + -0.2979627847671509, + -0.9071540236473083 + ] + ], + "translation_m": [ + -0.0003611890118904548, + 0.33642428752059383, + 1.3986704541566517 + ], + "rvec_rad": [ + 1.1162839608628714, + -2.694954763187016, + 0.5949621099248436 + ] + }, + "camera_in_world": { + "position_m": [ + -0.20001953098363734, + 0.20072560979846057, + 1.410376467533618 + ], + "position_mm": [ + -200.01953098363734, + 200.72560979846057, + 1410.3764675336179 + ], + "orientation_deg": { + "roll": -161.81675720214844, + "pitch": -17.285663604736328, + "yaw": -137.78683471679688 + } + }, + "uncertainty": { + "pose_covariance_6x6": [ + [ + 3.9202614266929536e-08, + -5.624758064579657e-08, + 1.9002092979602563e-08, + 3.677793045991329e-09, + 9.642384554519452e-09, + 3.500057257207911e-08 + ], + [ + -5.624758064579686e-08, + 1.7730001193758587e-07, + -8.799489872535942e-08, + -2.7037218009021926e-08, + -1.6119859220649852e-08, + -9.32896875306131e-08 + ], + [ + 1.9002092979602557e-08, + -8.799489872535837e-08, + 3.322018445588287e-07, + 3.421511111216491e-08, + -1.9357076042169092e-08, + 2.3056213184165007e-09 + ], + [ + 3.6777930459913576e-09, + -2.7037218009021913e-08, + 3.4215111112165093e-08, + 7.574076973655562e-09, + -2.5214832959351115e-10, + 7.570328774670964e-09 + ], + [ + 9.642384554519472e-09, + -1.611985922064988e-08, + -1.9357076042168993e-08, + -2.5214832959349947e-10, + 5.455720841232948e-09, + 1.33187555209256e-08 + ], + [ + 3.5000572572079415e-08, + -9.328968753061321e-08, + 2.3056213184173316e-09, + 7.570328774670982e-09, + 1.3318755520925603e-08, + 7.751291617219285e-08 + ] + ], + "parameter_std": { + "rvec_std_deg": [ + 0.011344363845211298, + 0.024125538440537754, + 0.03302354197846344 + ], + "tvec_std_m": [ + 8.702917311830304e-05, + 7.38628515644566e-05, + 0.00027841141530510715 + ] + }, + "camera_center_std_m": [ + 0.0006001213331363563, + 0.0007005844631310261, + 0.00037386586549212754 + ], + "camera_center_std_mm": [ + 0.6001213331363563, + 0.7005844631310261, + 0.3738658654921275 + ], + "orientation_std_deg": { + "roll": 0.020799509337956407, + "pitch": 0.024459922187381827, + "yaw": 0.011530363449194381 + } + } + }, + "observations": { + "markers": [ + { + "marker_id": 84, + "observed_center_px": [ + 65.25, + 662.0 + ], + "projected_center_px": [ + 65.15103149414062, + 661.9536743164062 + ], + "reprojection_error_px": 0.10927412370943719, + "confidence": 0.3490767193505014 + }, + { + "marker_id": 64, + "observed_center_px": [ + 819.5, + 647.0 + ], + "projected_center_px": [ + 819.5327758789062, + 646.9321899414062 + ], + "reprojection_error_px": 0.07531575057426548, + "confidence": 0.5331747682067169 + }, + { + "marker_id": 72, + "observed_center_px": [ + 102.25, + 581.0 + ], + "projected_center_px": [ + 102.25408935546875, + 581.1792602539062 + ], + "reprojection_error_px": 0.17930689183264265, + "confidence": 0.43254677700170213 + }, + { + "marker_id": 53, + "observed_center_px": [ + 52.0, + 559.0 + ], + "projected_center_px": [ + 52.02786636352539, + 559.1117553710938 + ], + "reprojection_error_px": 0.11517724247624178, + "confidence": 0.27711751756945874 + }, + { + "marker_id": 58, + "observed_center_px": [ + 781.0, + 564.0 + ], + "projected_center_px": [ + 780.9808349609375, + 563.824462890625 + ], + "reprojection_error_px": 0.1765802239493366, + "confidence": 0.48073279309443956 + }, + { + "marker_id": 69, + "observed_center_px": [ + 869.0, + 547.5 + ], + "projected_center_px": [ + 868.9163208007812, + 547.3129272460938 + ], + "reprojection_error_px": 0.20493516934864944, + "confidence": 0.45546210617301425 + }, + { + "marker_id": 103, + "observed_center_px": [ + 708.25, + 543.5 + ], + "projected_center_px": [ + 708.2188720703125, + 543.635986328125 + ], + "reprojection_error_px": 0.139503510506188, + "confidence": 0.4795917219326271 + }, + { + "marker_id": 56, + "observed_center_px": [ + 84.25, + 514.75 + ], + "projected_center_px": [ + 84.41259765625, + 514.6609497070312 + ], + "reprojection_error_px": 0.185385955497749, + "confidence": 0.39662908657084783 + }, + { + "marker_id": 215, + "observed_center_px": [ + 504.5, + 495.5 + ], + "projected_center_px": [ + 504.49505615234375, + 495.4730224609375 + ], + "reprojection_error_px": 0.027426797908558738, + "confidence": 0.39338762460270227 + }, + { + "marker_id": 46, + "observed_center_px": [ + 41.5, + 498.0 + ], + "projected_center_px": [ + 41.32355880737305, + 498.03680419921875 + ], + "reprojection_error_px": 0.18023885134941084, + "confidence": 0.1698001278724927 + }, + { + "marker_id": 68, + "observed_center_px": [ + 29.25, + 458.0 + ], + "projected_center_px": [ + 29.114898681640625, + 458.09796142578125 + ], + "reprojection_error_px": 0.16687961877813764, + "confidence": 0.07718187630567852 + }, + { + "marker_id": 208, + "observed_center_px": [ + 424.5, + 417.75 + ], + "projected_center_px": [ + 424.3829650878906, + 417.7440185546875 + ], + "reprojection_error_px": 0.11718766291924913, + "confidence": 0.4316478958478293 + }, + { + "marker_id": 95, + "observed_center_px": [ + 710.75, + 415.25 + ], + "projected_center_px": [ + 710.908203125, + 415.144775390625 + ], + "reprojection_error_px": 0.19000117678026882, + "confidence": 0.4181682027393045 + }, + { + "marker_id": 55, + "observed_center_px": [ + 622.75, + 351.75 + ], + "projected_center_px": [ + 622.661376953125, + 351.86688232421875 + ], + "reprojection_error_px": 0.14668170353587198, + "confidence": 0.39668368657567366 + }, + { + "marker_id": 66, + "observed_center_px": [ + 761.5, + 332.5 + ], + "projected_center_px": [ + 761.3377075195312, + 332.7164611816406 + ], + "reprojection_error_px": 0.2705444369673035, + "confidence": 0.3829765144945479 + }, + { + "marker_id": 217, + "observed_center_px": [ + 201.5, + 202.0 + ], + "projected_center_px": [ + 201.80841064453125, + 201.79034423828125 + ], + "reprojection_error_px": 0.37292447503757425, + "confidence": 0.3382587531306593 + }, + { + "marker_id": 97, + "observed_center_px": [ + 682.75, + 268.75 + ], + "projected_center_px": [ + 682.692138671875, + 268.71795654296875 + ], + "reprojection_error_px": 0.06614163916098906, + "confidence": 0.3623898971459892 + }, + { + "marker_id": 54, + "observed_center_px": [ + 630.25, + 262.5 + ], + "projected_center_px": [ + 630.4234008789062, + 262.6108703613281 + ], + "reprojection_error_px": 0.20581569868814423, + "confidence": 0.3590718541167963 + }, + { + "marker_id": 205, + "observed_center_px": [ + 133.0, + 135.0 + ], + "projected_center_px": [ + 133.00042724609375, + 135.02919006347656 + ], + "reprojection_error_px": 0.029193190044775386, + "confidence": 0.29591817114314195 + }, + { + "marker_id": 92, + "observed_center_px": [ + 291.0, + 157.0 + ], + "projected_center_px": [ + 291.0001220703125, + 157.40155029296875 + ], + "reprojection_error_px": 0.40155031152328863, + "confidence": 0.3158166687011719 + }, + { + "marker_id": 105, + "observed_center_px": [ + 442.5, + 182.75 + ], + "projected_center_px": [ + 442.3433837890625, + 182.87738037109375 + ], + "reprojection_error_px": 0.20187718164369384, + "confidence": 0.31800273344664126 + }, + { + "marker_id": 85, + "observed_center_px": [ + 494.0, + 166.0 + ], + "projected_center_px": [ + 493.9403076171875, + 165.65689086914062 + ], + "reprojection_error_px": 0.3482629125314807, + "confidence": 0.2969848480224609 + }, + { + "marker_id": 102, + "observed_center_px": [ + 318.5, + 130.0 + ], + "projected_center_px": [ + 318.8728332519531, + 129.79766845703125 + ], + "reprojection_error_px": 0.4241965193657976, + "confidence": 0.3170967427530611 + }, + { + "marker_id": 59, + "observed_center_px": [ + 379.75, + 109.0 + ], + "projected_center_px": [ + 379.90716552734375, + 109.25081634521484 + ], + "reprojection_error_px": 0.29598959781075196, + "confidence": 0.3170967427530611 + }, + { + "marker_id": 48, + "observed_center_px": [ + 369.5, + 44.25 + ], + "projected_center_px": [ + 369.56671142578125, + 44.28301239013672 + ], + "reprojection_error_px": 0.0744327362946315, + "confidence": 0.17828567290874034 + }, + { + "marker_id": 57, + "observed_center_px": [ + 463.0, + 70.5 + ], + "projected_center_px": [ + 463.0251770019531, + 70.45142364501953 + ], + "reprojection_error_px": 0.054713286234114755, + "confidence": 0.3167426670523156 + }, + { + "marker_id": 63, + "observed_center_px": [ + 243.0, + 42.0 + ], + "projected_center_px": [ + 242.71270751953125, + 41.72708511352539 + ], + "reprojection_error_px": 0.3962568669352444, + "confidence": 0.15449597168691093 + }, + { + "marker_id": 71, + "observed_center_px": [ + 299.25, + 29.5 + ], + "projected_center_px": [ + 299.2705383300781, + 29.458524703979492 + ], + "reprojection_error_px": 0.04628199630943727, + "confidence": 0.08171792300897739 + } + ] + }, + "qa": { + "sanity_notes": [] + }, + "v8_z_correction_mm": 11.151935468550299 +} \ No newline at end of file diff --git a/data/evaluations/Scene8/robot_state.json b/data/evaluations/Scene8/robot_state.json new file mode 100644 index 0000000..36fce90 --- /dev/null +++ b/data/evaluations/Scene8/robot_state.json @@ -0,0 +1,5426 @@ +{ + "schema_version": "1.0", + "method": "deterministic_geometric_sequential_prefix", + "created_utc": "2026-06-01T18:33:57Z", + "root_pose": { + "translation_m": [ + 2.5489033214309842e-05, + 1.7092737860519014e-06, + 7.944340592782456e-05 + ], + "rotation_matrix": [ + [ + 0.9999999656176027, + -1.7590809042794414e-05, + 0.0002616397474472569 + ], + [ + 1.7624736364087737e-05, + 0.9999999914375103, + -0.00012967015251402915 + ], + [ + -0.00026163746420406495, + 0.0001296747593872449, + 0.9999999573651464 + ] + ], + "euler_xyz_deg": [ + 0.007429816697387264, + 0.014990722632427634, + 0.0010098230433085514 + ] + }, + "movements": { + "x": { + "value_m": 0.04892022155170399, + "value_mm": 48.92022155170399, + "joint_type": "linear", + "link": "Base" + }, + "y": { + "value_rad": -0.08836641382860355, + "value_deg": -5.0630225630854575, + "joint_type": "revolute", + "link": "Arm1" + }, + "z": { + "value_rad": 1.4943262922107685, + "value_deg": 85.61858975911002, + "joint_type": "revolute", + "link": "Ellbow" + }, + "a": { + "value_rad": 1.0937896539089307, + "value_deg": 62.669530844056716, + "joint_type": "revolute", + "link": "Arm2" + }, + "b": { + "value_rad": 0.0, + "value_deg": 0.0, + "joint_type": "revolute", + "link": "Hand" + }, + "c": { + "value_rad": 0.0, + "value_deg": 0.0, + "joint_type": "revolute", + "link": "Palm" + }, + "e": { + "value_m": 0.0, + "value_mm": 0.0, + "joint_type": "linear", + "link": "FingerB" + } + }, + "link_poses": { + "Board": { + "translation_m": [ + 2.5489033214309842e-05, + 1.7092737860519014e-06, + 7.944340592782456e-05 + ], + "rotation_matrix": [ + [ + 0.9999999656176027, + -1.7590809042794414e-05, + 0.0002616397474472569 + ], + [ + 1.7624736364087737e-05, + 0.9999999914375103, + -0.00012967015251402915 + ], + [ + -0.00026163746420406495, + 0.0001296747593872449, + 0.9999999573651464 + ] + ] + }, + "Base": { + "translation_m": [ + 0.04894989513883405, + 4.967573535481185e-07, + 0.01606664336105509 + ], + "rotation_matrix": [ + [ + 0.9999999656176027, + -1.7590809042794414e-05, + 0.0002616397474472569 + ], + [ + 1.7624736364087737e-05, + 0.9999999914375103, + -0.00012967015251402915 + ], + [ + -0.00026163746420406495, + 0.0001296747593872449, + 0.9999999573651464 + ] + ] + }, + "Arm1": { + "translation_m": [ + 0.15895976533802886, + 0.10799659939674157, + 0.06105186619543805 + ], + "rotation_matrix": [ + [ + 0.999999965617595, + 5.567914774980563e-06, + 0.0002621713034107698 + ], + [ + 1.76247363640876e-05, + 0.9960867762916883, + -0.088380618837987 + ], + [ + -0.0002616374642040629, + 0.08838062041994954, + 0.9960867419457038 + ] + ] + }, + "Ellbow": { + "translation_m": [ + 0.1589583733593351, + -0.14102509467618052, + 0.038956711090450666 + ], + "rotation_matrix": [ + [ + 0.9999999656157478, + -0.0002609797679578342, + 2.558035815976095e-05 + ], + [ + 1.7624736364055045e-05, + 0.16421890960175983, + 0.9864239197305457 + ], + [ + -0.0002616374642035796, + -0.9864238853640793, + 0.16421890855521962 + ] + ] + }, + "Arm2": { + "translation_m": [ + 0.2489583702647524, + -0.14102350844990774, + 0.038933163718672344 + ], + "rotation_matrix": [ + [ + 0.45914475390133697, + -0.0002609797679575519, + -0.8883614280511924 + ], + [ + 0.876320669094017, + 0.1642189096015822, + 0.45287330970624 + ], + [ + 0.14576755427581817, + -0.9864238853630123, + 0.07562895280006258 + ] + ] + }, + "Hand": { + "translation_m": [ + 0.2490236152067418, + -0.1820782358503033, + 0.2855391350594254 + ], + "rotation_matrix": [ + [ + 0.45914475390133697, + -0.0002609797679575519, + -0.8883614280511924 + ], + [ + 0.876320669094017, + 0.1642189096015822, + 0.45287330970624 + ], + [ + 0.14576755427581817, + -0.9864238853630123, + 0.07562895280006258 + ] + ] + }, + "Palm": { + "translation_m": [ + 0.2490236152067418, + -0.1820782358503033, + 0.2855391350594254 + ], + "rotation_matrix": [ + [ + 0.45914475390133697, + -0.0002609797679575519, + -0.8883614280511924 + ], + [ + 0.876320669094017, + 0.1642189096015822, + 0.45287330970624 + ], + [ + 0.14576755427581817, + -0.9864238853630123, + 0.07562895280006258 + ] + ] + }, + "FingerA": { + "translation_m": [ + 0.25086932851422566, + -0.18432061500998262, + 0.3206470412642341 + ], + "rotation_matrix": [ + [ + 0.45914475390133697, + -0.0002609797679575519, + -0.8883614280511924 + ], + [ + 0.876320669094017, + 0.1642189096015822, + 0.45287330970624 + ], + [ + 0.14576755427581817, + -0.9864238853630123, + 0.07562895280006258 + ] + ] + }, + "FingerB": { + "translation_m": [ + 0.24719617048301495, + -0.19133118036273475, + 0.31948090083002756 + ], + "rotation_matrix": [ + [ + 0.45914475390133697, + -0.0002609797679575519, + -0.8883614280511924 + ], + [ + 0.876320669094017, + 0.1642189096015822, + 0.45287330970624 + ], + [ + 0.14576755427581817, + -0.9864238853630123, + 0.07562895280006258 + ] + ] + } + }, + "stage_reports": [ + { + "method": "deterministic_geometric_prefix", + "active_links": [ + "Board", + "Base", + "Arm1" + ], + "active_observations": 44, + "joint_updates": [ + { + "pass": 0, + "updates": [ + { + "link": "Base", + "joint_variable": "x", + "joint_type": "linear", + "old": 0.0, + "new": 0.04985624739185442, + "info": { + "reason": "weighted_projection", + "used_markers": 3, + "axis_world": [ + 0.9999999656166024, + 1.7624736364070108e-05, + -0.0002616374642038032 + ], + "per_marker": [ + { + "marker_id": 198, + "q_i": 0.04991735366699347, + "weight": 1.0 + }, + { + "marker_id": 229, + "q_i": 0.049922381582998346, + "weight": 1.0 + }, + { + "marker_id": 243, + "q_i": 0.04972900692557143, + "weight": 1.0 + } + ] + } + }, + { + "link": "Arm1", + "joint_variable": "y", + "joint_type": "revolute", + "old": 0.0, + "new": 0.03517561517938228, + "info": { + "reason": "2d_alignment+normal_tiebreak", + "used_markers": 3, + "axis_world": [ + -0.9999999656166024, + -1.7624736364070108e-05, + 0.0002616374642038032 + ], + "axis_id": 0, + "theta_rad": 0.03517561517938248, + "theta_alt_rad": -3.1064170384104113, + "score_theta": 0.0009122065391979505, + "score_theta_alt": 0.8867671827777639, + "best_score": 0.0009122065391979505, + "per_marker": [ + { + "marker_id": 198, + "weight": 1.0 + }, + { + "marker_id": 229, + "weight": 1.0 + }, + { + "marker_id": 243, + "weight": 1.0 + } + ] + } + } + ] + }, + { + "pass": 1, + "updates": [ + { + "link": "Base", + "joint_variable": "x", + "joint_type": "linear", + "old": 0.04985624739185442, + "new": 0.04985624739185441, + "info": { + "reason": "weighted_projection", + "used_markers": 3, + "axis_world": [ + 0.9999999656166024, + 1.7624736364070108e-05, + -0.0002616374642038032 + ], + "per_marker": [ + { + "marker_id": 198, + "q_i": 0.04991735366699348, + "weight": 1.0 + }, + { + "marker_id": 229, + "q_i": 0.049922381582998346, + "weight": 1.0 + }, + { + "marker_id": 243, + "q_i": 0.049729006925571424, + "weight": 1.0 + } + ] + } + }, + { + "link": "Arm1", + "joint_variable": "y", + "joint_type": "revolute", + "old": 0.03517561517938228, + "new": 0.03517561517938228, + "info": { + "reason": "2d_alignment+normal_tiebreak", + "used_markers": 3, + "axis_world": [ + -0.9999999656166024, + -1.7624736364070108e-05, + 0.0002616374642038032 + ], + "axis_id": 0, + "theta_rad": 0.03517561517938248, + "theta_alt_rad": -3.1064170384104113, + "score_theta": 0.0009122065391979505, + "score_theta_alt": 0.8867671827777639, + "best_score": 0.0009122065391979505, + "per_marker": [ + { + "marker_id": 198, + "weight": 1.0 + }, + { + "marker_id": 229, + "weight": 1.0 + }, + { + "marker_id": 243, + "weight": 1.0 + } + ] + } + } + ] + } + ], + "root_link": "Board", + "root_pose": { + "reason": "kabsch", + "used_markers": [ + 210, + 211, + 215, + 214, + 208, + 206, + 205, + 207, + 217, + 46, + 47, + 51, + 53, + 54, + 55, + 56, + 58, + 60, + 61, + 62, + 63, + 64, + 66, + 68, + 69, + 72, + 73, + 75, + 79, + 82, + 83, + 84, + 85, + 86, + 92, + 95, + 96, + 97, + 102, + 103, + 105 + ] + }, + "marker_stats": { + "num_markers_used": 44, + "mean_error_m": 0.0013936047712252637, + "rms_error_m": 0.004410182585613019, + "median_error_m": 0.0002721472868352096, + "worst_error_m": 0.02017381595076261 + }, + "marker_reports": [ + { + "marker_id": 46, + "link": "Board", + "error_m": [ + 0.00023119187005882225, + 0.0001638179674103568, + -0.00010463200703492853 + ], + "error_norm_m": 0.0003020494398669089, + "predicted_m": [ + 0.5367250657751038, + 0.18545470705337558, + -0.027336931986172867 + ], + "observed_m": [ + 0.536493873905045, + 0.18529088908596522, + -0.02723229997913794 + ] + }, + { + "marker_id": 47, + "link": "Board", + "error_m": [ + -0.00014744286046136645, + 0.00012173977173757233, + -0.0001348842178661505 + ], + "error_norm_m": 0.0002339951310457321, + "predicted_m": [ + 0.3442533749030795, + -0.2865286813145559, + -0.02734777589999846 + ], + "observed_m": [ + 0.34440081776354087, + -0.28665042108629346, + -0.02721289168213231 + ] + }, + { + "marker_id": 51, + "link": "Board", + "error_m": [ + 5.309812312059847e-05, + -0.00020886326021332668, + 0.0002325329052500283 + ], + "error_norm_m": 0.00031704072951261117, + "predicted_m": [ + 0.16782136752516283, + -0.1720717918268552, + -0.027286772629229475 + ], + "observed_m": [ + 0.16776826940204223, + -0.17186292856664187, + -0.027519305534479503 + ] + }, + { + "marker_id": 53, + "link": "Board", + "error_m": [ + -3.082762285167018e-05, + 5.734226533921083e-05, + -8.574129649907211e-05 + ], + "error_norm_m": 0.00010765708360465219, + "predicted_m": [ + 0.4862645960763571, + 0.2122538174797039, + -0.02732025447617755 + ], + "observed_m": [ + 0.48629542369920875, + 0.2121964752143647, + -0.02723451317967848 + ] + }, + { + "marker_id": 54, + "link": "Board", + "error_m": [ + -8.689741467815537e-05, + 2.084652103728768e-05, + -0.00013996332264986158 + ], + "error_norm_m": 0.00016605863363370973, + "predicted_m": [ + 0.34229414984560724, + -0.33057871548186146, + -0.027352975263719628 + ], + "observed_m": [ + 0.3423810472602854, + -0.33059956200289875, + -0.027213011941069766 + ] + }, + { + "marker_id": 55, + "link": "Board", + "error_m": [ + -3.283680479632123e-05, + 8.93325736997519e-05, + -4.533787401645936e-05 + ], + "error_norm_m": 0.00010542337166580117, + "predicted_m": [ + 0.2837429555077737, + -0.2625697479925105, + -0.027328837209804554 + ], + "observed_m": [ + 0.28377579231257, + -0.26265908056621023, + -0.027283499335788094 + ] + }, + { + "marker_id": 56, + "link": "Board", + "error_m": [ + 5.6683143949021186e-05, + -4.187347286849219e-05, + -1.0361057953760244e-05 + ], + "error_norm_m": 7.123003622022796e-05, + "predicted_m": [ + 0.4986953620805339, + 0.16868403692824455, + -0.027329156559124112 + ], + "observed_m": [ + 0.49863867893658487, + 0.16872591040111304, + -0.02731879550117035 + ] + }, + { + "marker_id": 58, + "link": "Board", + "error_m": [ + 0.00010898286639899474, + -0.00013531298462457486, + 2.4156409186272543e-05 + ], + "error_norm_m": 0.00017541493973241332, + "predicted_m": [ + 0.05011218127725505, + -0.21810386604044124, + -0.027261944212492607 + ], + "observed_m": [ + 0.050003198410856056, + -0.21796855305581667, + -0.02728610062167888 + ] + }, + { + "marker_id": 60, + "link": "Board", + "error_m": [ + 1.692622537791122e-05, + 4.309980570010863e-05, + 1.0628662820987705e-05 + ], + "error_norm_m": 4.750851324018894e-05, + "predicted_m": [ + 0.43437333888625645, + 0.2838229023193166, + -0.02729739728563066 + ], + "observed_m": [ + 0.43435641266087854, + 0.2837798025136165, + -0.027308025948451647 + ] + }, + { + "marker_id": 61, + "link": "Board", + "error_m": [ + 2.1550213066802437e-05, + -0.00039134191686995834, + 0.0003126923269400131 + ], + "error_norm_m": 0.0005013874738262195, + "predicted_m": [ + -0.0224075604824385, + 0.3358348512468195, + -0.0271711408437482 + ], + "observed_m": [ + -0.0224291106955053, + 0.33622619316368946, + -0.027483833170688213 + ] + }, + { + "marker_id": 62, + "link": "Board", + "error_m": [ + 4.5764718946572636e-05, + 3.2876613692278678e-06, + 6.080875086055329e-05 + ], + "error_norm_m": 7.617691513023049e-05, + "predicted_m": [ + 0.4047214125042162, + -0.1750876165009518, + -0.027349146162272766 + ], + "observed_m": [ + 0.40467564778526965, + -0.17509090416232104, + -0.02740995491313332 + ] + }, + { + "marker_id": 63, + "link": "Board", + "error_m": [ + 5.723858885597899e-05, + 9.356691776807313e-05, + 0.00018386234045146901 + ], + "error_norm_m": 0.0002140943352616623, + "predicted_m": [ + 0.7774224736087888, + -0.2361310472389689, + -0.02745457508924221 + ], + "observed_m": [ + 0.7773652350199328, + -0.23622461415673698, + -0.02763843742969368 + ] + }, + { + "marker_id": 64, + "link": "Board", + "error_m": [ + 4.1423947968247804e-05, + -0.00014205404642433916, + -0.00011512492785336476 + ], + "error_norm_m": 0.0001874807845728379, + "predicted_m": [ + -0.021248341882591285, + -0.18822512399747535, + -0.027239399081236515 + ], + "observed_m": [ + -0.021289765830559533, + -0.188083069951051, + -0.02712427415338315 + ] + }, + { + "marker_id": 66, + "link": "Board", + "error_m": [ + -0.00012599533402873897, + 0.00010588321984128513, + 1.9222121424126992e-05 + ], + "error_norm_m": 0.00016569722506130062, + "predicted_m": [ + 0.2097747285659698, + -0.3632210508324448, + -0.027322535651109706 + ], + "observed_m": [ + 0.20990072389999853, + -0.3633269340522861, + -0.027341757772533833 + ] + }, + { + "marker_id": 68, + "link": "Board", + "error_m": [ + 7.825327892119205e-06, + 0.00015493004001096433, + -6.2036268805194805e-06 + ], + "error_norm_m": 0.00015525153152510572, + "predicted_m": [ + 0.5737453248462413, + 0.1706553596478406, + -0.027348536991536634 + ], + "observed_m": [ + 0.5737374995183492, + 0.17050042960782963, + -0.027342333364656114 + ] + }, + { + "marker_id": 69, + "link": "Board", + "error_m": [ + -5.922502571516393e-05, + -0.00038388839300179667, + 0.0002968696214815658 + ], + "error_norm_m": 0.0004888859520492196, + "predicted_m": [ + 0.007633292717869882, + -0.28120461419894877, + -0.027259012330330554 + ], + "observed_m": [ + 0.007692517743585046, + -0.28082072580594697, + -0.02755588195181212 + ] + }, + { + "marker_id": 72, + "link": "Board", + "error_m": [ + 0.00038155310689075295, + 0.0003161964191133182, + -0.00039087258499147584 + ], + "error_norm_m": 0.0006311452499512217, + "predicted_m": [ + 0.4410049128598024, + 0.1943330199375759, + -0.027310736536235895 + ], + "observed_m": [ + 0.44062335975291167, + 0.19401682351846258, + -0.02691986395124442 + ] + }, + { + "marker_id": 73, + "link": "Board", + "error_m": [ + -1.0809524911947754e-05, + 0.0005209083581688145, + -0.00047217776510506335 + ], + "error_norm_m": 0.0007031459345673303, + "predicted_m": [ + 0.2217424789700998, + 0.3331191543494928, + -0.027235372345979156 + ], + "observed_m": [ + 0.22175328849501175, + 0.332598245991324, + -0.026763194580874092 + ] + }, + { + "marker_id": 75, + "link": "Board", + "error_m": [ + 2.089296773622948e-05, + 5.2785255821891086e-05, + 0.00012760099364308997 + ], + "error_norm_m": 0.00013965963236280373, + "predicted_m": [ + -0.02568507566788694, + 0.1945847946471359, + -0.02718859923262906 + ], + "observed_m": [ + -0.025705968635623168, + 0.19453200939131401, + -0.02731620022627215 + ] + }, + { + "marker_id": 79, + "link": "Board", + "error_m": [ + -8.855756673514792e-05, + -0.00040320196247570217, + 0.00020058987954125682 + ], + "error_norm_m": 0.00045896684514753745, + "predicted_m": [ + 0.31232113440411313, + -0.15909924516350613, + -0.027322897361177708 + ], + "observed_m": [ + 0.3124096919708483, + -0.15869604320103042, + -0.027523487240718965 + ] + }, + { + "marker_id": 82, + "link": "Board", + "error_m": [ + -6.158694231089834e-05, + -8.580082970072178e-05, + 8.957893097094605e-05 + ], + "error_norm_m": 0.00013848869525862282, + "predicted_m": [ + 0.21917311004078294, + 0.2972491093610568, + -0.027239351371315373 + ], + "observed_m": [ + 0.21923469698309384, + 0.29733491019075753, + -0.02732893030228632 + ] + }, + { + "marker_id": 83, + "link": "Board", + "error_m": [ + -5.426234104181915e-05, + -0.00011111020260934357, + 0.00016511898797014202 + ], + "error_norm_m": 0.00020628659425060074, + "predicted_m": [ + 0.04417237759553884, + 0.3392260246727398, + -0.027188121068680585 + ], + "observed_m": [ + 0.04422663993658066, + 0.33933713487534917, + -0.027353240056650727 + ] + }, + { + "marker_id": 84, + "link": "Board", + "error_m": [ + 0.00014352441574932984, + 6.221915725929117e-05, + -3.7946691859542386e-05 + ], + "error_norm_m": 0.00016096717947869355, + "predicted_m": [ + 0.40750378644075314, + 0.25843242896005214, + -0.02729365952910834 + ], + "observed_m": [ + 0.4073602620250038, + 0.25837020980279285, + -0.027255712837248796 + ] + }, + { + "marker_id": 85, + "link": "Board", + "error_m": [ + 0.00018448005383175925, + -0.0001929986884540713, + 0.00010304636704261058 + ], + "error_norm_m": 0.0002861816516959829, + "predicted_m": [ + 0.5046038304449671, + -0.3127358549636571, + -0.027393128242827122 + ], + "observed_m": [ + 0.5044193503911354, + -0.312542856275203, + -0.027496174609869733 + ] + }, + { + "marker_id": 86, + "link": "Board", + "error_m": [ + -0.00041302127011444423, + -0.00022729111282671077, + 0.00012288976179672742 + ], + "error_norm_m": 0.00048718550172537946, + "predicted_m": [ + 0.36290319709893226, + 0.2920216426091962, + -0.027277634723037018 + ], + "observed_m": [ + 0.3633162183690467, + 0.29224893372202293, + -0.027400524484833745 + ] + }, + { + "marker_id": 92, + "link": "Board", + "error_m": [ + -0.0002249958117158668, + 0.0002764089032140371, + -0.0002382375432670586 + ], + "error_norm_m": 0.0004286981736462057, + "predicted_m": [ + 0.645111575573512, + -0.1848233796071786, + -0.027413304224449212 + ], + "observed_m": [ + 0.6453365713852278, + -0.18509978851039263, + -0.027175066681182154 + ] + }, + { + "marker_id": 95, + "link": "Board", + "error_m": [ + 0.00016437102236044332, + 0.00011049113339506311, + -1.4708207874688378e-05 + ], + "error_norm_m": 0.00019860124604248594, + "predicted_m": [ + 0.18606316098464215, + -0.27406146947837556, + -0.02730477042528646 + ], + "observed_m": [ + 0.1858987899622817, + -0.2741719606117706, + -0.027290062217411773 + ] + }, + { + "marker_id": 96, + "link": "Board", + "error_m": [ + 7.649016640010053e-05, + 9.828472211886874e-05, + -9.089716310750964e-05 + ], + "error_norm_m": 0.00015418471525703036, + "predicted_m": [ + 0.36979161406450833, + -0.18647823203546626, + -0.027341484161157538 + ], + "observed_m": [ + 0.36971512389810823, + -0.18657651675758513, + -0.02725058699805003 + ] + }, + { + "marker_id": 97, + "link": "Board", + "error_m": [ + 0.00020382614999203685, + 7.179636906051723e-05, + -0.0002027098903542475 + ], + "error_norm_m": 0.00029629565922956305, + "predicted_m": [ + 0.3043746626901148, + -0.35965938356286725, + -0.027346824913079992 + ], + "observed_m": [ + 0.3041708365401228, + -0.35973117993192777, + -0.027144115022725745 + ] + }, + { + "marker_id": 102, + "link": "Board", + "error_m": [ + -0.00013600903849941837, + -0.000190094809003033, + 0.00038261680713974275 + ], + "error_norm_m": 0.000448363821097607, + "predicted_m": [ + 0.649712246680626, + -0.22298329820664672, + -0.027419456145602768 + ], + "observed_m": [ + 0.6498482557191254, + -0.2227932033976437, + -0.02780207295274251 + ] + }, + { + "marker_id": 103, + "link": "Board", + "error_m": [ + -4.772273536859939e-06, + 0.0001558927351641426, + -3.216445323070416e-07 + ], + "error_norm_m": 0.0001559660954402375, + "predicted_m": [ + 0.1057316446043112, + -0.18770288601290436, + -0.027272554375566267 + ], + "observed_m": [ + 0.10573641687784806, + -0.1878587787480685, + -0.02727223273103396 + ] + }, + { + "marker_id": 105, + "link": "Board", + "error_m": [ + 0.0002116687607344181, + 0.00022434563679629704, + -0.00030475494066066824 + ], + "error_norm_m": 0.0004336014332050435, + "predicted_m": [ + 0.5248630117757593, + -0.2662354982846541, + -0.02739239914154039 + ], + "observed_m": [ + 0.5246513430150249, + -0.2664598439214504, + -0.02708764420087972 + ] + }, + { + "marker_id": 198, + "link": "Arm1", + "error_m": [ + -5.82140400769704e-05, + 0.002413605108835655, + 0.011216957502869537 + ], + "error_norm_m": 0.011473840425813881, + "predicted_m": [ + 0.15990920623900048, + -0.05067877967583175, + 0.1016363309883129 + ], + "observed_m": [ + 0.15996742027907745, + -0.05309238478466741, + 0.09041937348544336 + ] + }, + { + "marker_id": 205, + "link": "Board", + "error_m": [ + -5.006671163554355e-05, + 2.1165048207510972e-06, + -0.0002114886335585359 + ], + "error_norm_m": 0.00021734442097994972, + "predicted_m": [ + 0.7500271249111544, + -0.08998511030436256, + 0.0001715445666394677 + ], + "observed_m": [ + 0.75007719162279, + -0.08998722680918331, + 0.0003830332001980036 + ] + }, + { + "marker_id": 206, + "link": "Board", + "error_m": [ + -0.00010244785427382386, + -0.0004777894848594748, + 0.00017382965480367723 + ], + "error_norm_m": 0.0005186473788391864, + "predicted_m": [ + 0.6500257210846707, + -0.009986873462998147, + 0.0002080822938108538 + ], + "observed_m": [ + 0.6501281689389445, + -0.009509083978138672, + 3.4252639007176556e-05 + ] + }, + { + "marker_id": 207, + "link": "Board", + "error_m": [ + -0.0006581080226497615, + -0.000433861471745239, + 0.0005291329254721933 + ], + "error_norm_m": 0.0009493806396591862, + "predicted_m": [ + 0.750025717646431, + -0.009985110989361739, + 0.0001819185473904473 + ], + "observed_m": [ + 0.7506838256690808, + -0.0095512495176165, + -0.00034721437808174607 + ] + }, + { + "marker_id": 208, + "link": "Board", + "error_m": [ + 3.670025145363631e-05, + 2.9199448923003524e-05, + -5.1625268070184236e-05 + ], + "error_norm_m": 6.974729082541923e-05, + "predicted_m": [ + 0.3500271386641134, + -0.08999216019890818, + 0.0002761995523210937 + ], + "observed_m": [ + 0.34999043841265975, + -0.09002135964783119, + 0.0003278248203912779 + ] + }, + { + "marker_id": 210, + "link": "Board", + "error_m": [ + -4.198331445853104e-05, + 0.0003066847233939157, + -9.23607503197693e-05 + ], + "error_norm_m": 0.000323030380081746, + "predicted_m": [ + 0.020025918653671454, + -0.019997976961282627, + 0.0003716171486655422 + ], + "observed_m": [ + 0.020067901968129985, + -0.020304661684676543, + 0.0004639778989853115 + ] + }, + { + "marker_id": 211, + "link": "Board", + "error_m": [ + 0.00010807411786095678, + 0.00027529169532617206, + 6.0644706240166064e-05 + ], + "error_norm_m": 0.0003018995078862136, + "predicted_m": [ + 0.25002573483762963, + -0.009993923357543783, + 0.0003127372794924798 + ], + "observed_m": [ + 0.24991766071976868, + -0.010269215052869955, + 0.0002520925732523137 + ] + }, + { + "marker_id": 214, + "link": "Board", + "error_m": [ + 7.23100831970247e-05, + 0.00027996229800264505, + -0.0002693511552954145 + ], + "error_norm_m": 0.00039516791531430913, + "predicted_m": [ + 0.35002573139938997, + -0.009992160883907374, + 0.00028657353307207323 + ], + "observed_m": [ + 0.34995342131619295, + -0.01027212318191002, + 0.0005559246883674878 + ] + }, + { + "marker_id": 215, + "link": "Board", + "error_m": [ + 0.00020047129502520633, + 8.830003371299022e-05, + -0.0001365160957813505 + ], + "error_norm_m": 0.0002581129219744362, + "predicted_m": [ + 0.25002714210235305, + -0.0899939226725446, + 0.00030236329874150017 + ], + "observed_m": [ + 0.24982667080732784, + -0.09008222270625758, + 0.0004388793945228507 + ] + }, + { + "marker_id": 217, + "link": "Board", + "error_m": [ + -0.00011520168245726659, + -0.00029924750252879884, + 6.039451249597691e-05 + ], + "error_norm_m": 0.0003262943342295956, + "predicted_m": [ + 0.6500271283493941, + -0.08998687277799897, + 0.0001977083130598742 + ], + "observed_m": [ + 0.6501423300318514, + -0.08968762527547017, + 0.00013731380056389728 + ] + }, + { + "marker_id": 229, + "link": "Arm1", + "error_m": [ + -6.160350608286347e-05, + 0.002525092984778876, + 0.017486759363762733 + ], + "error_norm_m": 0.017668238243239896, + "predicted_m": [ + 0.1599116165621809, + -0.14062351549675475, + 0.10478981989660092 + ], + "observed_m": [ + 0.15997322006826376, + -0.14314860848153363, + 0.08730306053283819 + ] + }, + { + "marker_id": 243, + "link": "Arm1", + "error_m": [ + 0.00013250917469836976, + 0.0004569669728789749, + 0.020168204494192397 + ], + "error_norm_m": 0.02017381595076261, + "predicted_m": [ + 0.15990342383606682, + -0.17682838087230598, + 0.07103766950558957 + ], + "observed_m": [ + 0.15977091466136845, + -0.17728534784518496, + 0.05086946501139717 + ] + } + ], + "stage_idx": 0, + "num_active_links": 3 + }, + { + "method": "deterministic_geometric_prefix", + "active_links": [ + "Board", + "Base", + "Arm1", + "Ellbow" + ], + "active_observations": 48, + "joint_updates": [ + { + "pass": 0, + "updates": [ + { + "link": "Base", + "joint_variable": "x", + "joint_type": "linear", + "old": 0.04985624739185441, + "new": 0.05008717839331065, + "info": { + "reason": "weighted_projection", + "used_markers": 7, + "axis_world": [ + 0.9999999656166024, + 1.7624736364070108e-05, + -0.0002616374642038032 + ], + "per_marker": [ + { + "marker_id": 198, + "q_i": 0.04991735366699348, + "weight": 1.0 + }, + { + "marker_id": 229, + "q_i": 0.049922381582998346, + "weight": 1.0 + }, + { + "marker_id": 243, + "q_i": 0.049729006925571424, + "weight": 1.0 + }, + { + "marker_id": 244, + "q_i": 0.05089028111808685, + "weight": 1.0 + }, + { + "marker_id": 245, + "q_i": 0.050195348215974565, + "weight": 1.0 + }, + { + "marker_id": 248, + "q_i": 0.04997451428991218, + "weight": 1.0 + }, + { + "marker_id": 232, + "q_i": 0.049981362953637684, + "weight": 1.0 + } + ] + } + }, + { + "link": "Arm1", + "joint_variable": "y", + "joint_type": "revolute", + "old": 0.03517561517938228, + "new": -0.017243939524830054, + "info": { + "reason": "2d_alignment+normal_tiebreak", + "used_markers": 7, + "axis_world": [ + -0.9999999656166024, + -1.7624736364070108e-05, + 0.0002616374642038032 + ], + "axis_id": 0, + "theta_rad": -0.01724393952482995, + "theta_alt_rad": 3.124348714064963, + "score_theta": 0.007392953748833335, + "score_theta_alt": 1.9690648712402221, + "best_score": 0.007392953748833335, + "per_marker": [ + { + "marker_id": 198, + "weight": 1.0 + }, + { + "marker_id": 229, + "weight": 1.0 + }, + { + "marker_id": 243, + "weight": 1.0 + }, + { + "marker_id": 244, + "weight": 1.0 + }, + { + "marker_id": 245, + "weight": 1.0 + }, + { + "marker_id": 248, + "weight": 1.0 + }, + { + "marker_id": 232, + "weight": 1.0 + } + ] + } + }, + { + "link": "Ellbow", + "joint_variable": "z", + "joint_type": "revolute", + "old": 0.0, + "new": 1.6185599976410803, + "info": { + "reason": "2d_alignment+normal_tiebreak", + "used_markers": 3, + "axis_world": [ + -0.9999999656166024, + -1.7624736364070108e-05, + 0.0002616374642038032 + ], + "axis_id": 0, + "theta_rad": -1.5230326559487128, + "theta_alt_rad": 1.6185599976410803, + "score_theta": 0.19652840249330344, + "score_theta_alt": 0.1188463797823421, + "best_score": 0.1188463797823421, + "per_marker": [ + { + "marker_id": 245, + "weight": 1.0 + }, + { + "marker_id": 248, + "weight": 1.0 + }, + { + "marker_id": 232, + "weight": 1.0 + } + ] + } + } + ] + }, + { + "pass": 1, + "updates": [ + { + "link": "Base", + "joint_variable": "x", + "joint_type": "linear", + "old": 0.05008717839331065, + "new": 0.05008717839341761, + "info": { + "reason": "weighted_projection", + "used_markers": 7, + "axis_world": [ + 0.9999999656166024, + 1.7624736364070108e-05, + -0.0002616374642038032 + ], + "per_marker": [ + { + "marker_id": 198, + "q_i": 0.049917353666993465, + "weight": 1.0 + }, + { + "marker_id": 229, + "q_i": 0.04992238158299834, + "weight": 1.0 + }, + { + "marker_id": 243, + "q_i": 0.04972900692557142, + "weight": 1.0 + }, + { + "marker_id": 244, + "q_i": 0.050890281118348646, + "weight": 1.0 + }, + { + "marker_id": 245, + "q_i": 0.05019534821616308, + "weight": 1.0 + }, + { + "marker_id": 248, + "q_i": 0.049974514290022115, + "weight": 1.0 + }, + { + "marker_id": 232, + "q_i": 0.04998136295382621, + "weight": 1.0 + } + ] + } + }, + { + "link": "Arm1", + "joint_variable": "y", + "joint_type": "revolute", + "old": -0.017243939524830054, + "new": 0.03332874108695938, + "info": { + "reason": "2d_alignment+normal_tiebreak", + "used_markers": 7, + "axis_world": [ + -0.9999999656166024, + -1.7624736364070108e-05, + 0.0002616374642038032 + ], + "axis_id": 0, + "theta_rad": 0.033328741086959254, + "theta_alt_rad": -3.1082639125028333, + "score_theta": 0.0021671255381716338, + "score_theta_alt": 2.094864341593537, + "best_score": 0.0021671255381716338, + "per_marker": [ + { + "marker_id": 198, + "weight": 1.0 + }, + { + "marker_id": 229, + "weight": 1.0 + }, + { + "marker_id": 243, + "weight": 1.0 + }, + { + "marker_id": 244, + "weight": 1.0 + }, + { + "marker_id": 245, + "weight": 1.0 + }, + { + "marker_id": 248, + "weight": 1.0 + }, + { + "marker_id": 232, + "weight": 1.0 + } + ] + } + }, + { + "link": "Ellbow", + "joint_variable": "z", + "joint_type": "revolute", + "old": 1.6185599976410803, + "new": -1.2018737301676388, + "info": { + "reason": "2d_alignment+normal_tiebreak", + "used_markers": 3, + "axis_world": [ + -0.9999999656166024, + -1.7624736364070108e-05, + 0.0002616374642038032 + ], + "axis_id": 0, + "theta_rad": -1.2018737301676388, + "theta_alt_rad": 1.939718923422154, + "score_theta": 0.14537083593036396, + "score_theta_alt": 0.17327430611201536, + "best_score": 0.14537083593036396, + "per_marker": [ + { + "marker_id": 245, + "weight": 1.0 + }, + { + "marker_id": 248, + "weight": 1.0 + }, + { + "marker_id": 232, + "weight": 1.0 + } + ] + } + } + ] + } + ], + "root_link": "Board", + "root_pose": { + "reason": "kabsch", + "used_markers": [ + 210, + 211, + 215, + 214, + 208, + 206, + 205, + 207, + 217, + 46, + 47, + 51, + 53, + 54, + 55, + 56, + 58, + 60, + 61, + 62, + 63, + 64, + 66, + 68, + 69, + 72, + 73, + 75, + 79, + 82, + 83, + 84, + 85, + 86, + 92, + 95, + 96, + 97, + 102, + 103, + 105 + ] + }, + "marker_stats": { + "num_markers_used": 48, + "mean_error_m": 0.006087966044176806, + "rms_error_m": 0.018608819411342806, + "median_error_m": 0.00029909758355788833, + "worst_error_m": 0.07997577691281804 + }, + "marker_reports": [ + { + "marker_id": 46, + "link": "Board", + "error_m": [ + 0.00023119187005882225, + 0.0001638179674103568, + -0.00010463200703492853 + ], + "error_norm_m": 0.0003020494398669089, + "predicted_m": [ + 0.5367250657751038, + 0.18545470705337558, + -0.027336931986172867 + ], + "observed_m": [ + 0.536493873905045, + 0.18529088908596522, + -0.02723229997913794 + ] + }, + { + "marker_id": 47, + "link": "Board", + "error_m": [ + -0.00014744286046136645, + 0.00012173977173757233, + -0.0001348842178661505 + ], + "error_norm_m": 0.0002339951310457321, + "predicted_m": [ + 0.3442533749030795, + -0.2865286813145559, + -0.02734777589999846 + ], + "observed_m": [ + 0.34440081776354087, + -0.28665042108629346, + -0.02721289168213231 + ] + }, + { + "marker_id": 51, + "link": "Board", + "error_m": [ + 5.309812312059847e-05, + -0.00020886326021332668, + 0.0002325329052500283 + ], + "error_norm_m": 0.00031704072951261117, + "predicted_m": [ + 0.16782136752516283, + -0.1720717918268552, + -0.027286772629229475 + ], + "observed_m": [ + 0.16776826940204223, + -0.17186292856664187, + -0.027519305534479503 + ] + }, + { + "marker_id": 53, + "link": "Board", + "error_m": [ + -3.082762285167018e-05, + 5.734226533921083e-05, + -8.574129649907211e-05 + ], + "error_norm_m": 0.00010765708360465219, + "predicted_m": [ + 0.4862645960763571, + 0.2122538174797039, + -0.02732025447617755 + ], + "observed_m": [ + 0.48629542369920875, + 0.2121964752143647, + -0.02723451317967848 + ] + }, + { + "marker_id": 54, + "link": "Board", + "error_m": [ + -8.689741467815537e-05, + 2.084652103728768e-05, + -0.00013996332264986158 + ], + "error_norm_m": 0.00016605863363370973, + "predicted_m": [ + 0.34229414984560724, + -0.33057871548186146, + -0.027352975263719628 + ], + "observed_m": [ + 0.3423810472602854, + -0.33059956200289875, + -0.027213011941069766 + ] + }, + { + "marker_id": 55, + "link": "Board", + "error_m": [ + -3.283680479632123e-05, + 8.93325736997519e-05, + -4.533787401645936e-05 + ], + "error_norm_m": 0.00010542337166580117, + "predicted_m": [ + 0.2837429555077737, + -0.2625697479925105, + -0.027328837209804554 + ], + "observed_m": [ + 0.28377579231257, + -0.26265908056621023, + -0.027283499335788094 + ] + }, + { + "marker_id": 56, + "link": "Board", + "error_m": [ + 5.6683143949021186e-05, + -4.187347286849219e-05, + -1.0361057953760244e-05 + ], + "error_norm_m": 7.123003622022796e-05, + "predicted_m": [ + 0.4986953620805339, + 0.16868403692824455, + -0.027329156559124112 + ], + "observed_m": [ + 0.49863867893658487, + 0.16872591040111304, + -0.02731879550117035 + ] + }, + { + "marker_id": 58, + "link": "Board", + "error_m": [ + 0.00010898286639899474, + -0.00013531298462457486, + 2.4156409186272543e-05 + ], + "error_norm_m": 0.00017541493973241332, + "predicted_m": [ + 0.05011218127725505, + -0.21810386604044124, + -0.027261944212492607 + ], + "observed_m": [ + 0.050003198410856056, + -0.21796855305581667, + -0.02728610062167888 + ] + }, + { + "marker_id": 60, + "link": "Board", + "error_m": [ + 1.692622537791122e-05, + 4.309980570010863e-05, + 1.0628662820987705e-05 + ], + "error_norm_m": 4.750851324018894e-05, + "predicted_m": [ + 0.43437333888625645, + 0.2838229023193166, + -0.02729739728563066 + ], + "observed_m": [ + 0.43435641266087854, + 0.2837798025136165, + -0.027308025948451647 + ] + }, + { + "marker_id": 61, + "link": "Board", + "error_m": [ + 2.1550213066802437e-05, + -0.00039134191686995834, + 0.0003126923269400131 + ], + "error_norm_m": 0.0005013874738262195, + "predicted_m": [ + -0.0224075604824385, + 0.3358348512468195, + -0.0271711408437482 + ], + "observed_m": [ + -0.0224291106955053, + 0.33622619316368946, + -0.027483833170688213 + ] + }, + { + "marker_id": 62, + "link": "Board", + "error_m": [ + 4.5764718946572636e-05, + 3.2876613692278678e-06, + 6.080875086055329e-05 + ], + "error_norm_m": 7.617691513023049e-05, + "predicted_m": [ + 0.4047214125042162, + -0.1750876165009518, + -0.027349146162272766 + ], + "observed_m": [ + 0.40467564778526965, + -0.17509090416232104, + -0.02740995491313332 + ] + }, + { + "marker_id": 63, + "link": "Board", + "error_m": [ + 5.723858885597899e-05, + 9.356691776807313e-05, + 0.00018386234045146901 + ], + "error_norm_m": 0.0002140943352616623, + "predicted_m": [ + 0.7774224736087888, + -0.2361310472389689, + -0.02745457508924221 + ], + "observed_m": [ + 0.7773652350199328, + -0.23622461415673698, + -0.02763843742969368 + ] + }, + { + "marker_id": 64, + "link": "Board", + "error_m": [ + 4.1423947968247804e-05, + -0.00014205404642433916, + -0.00011512492785336476 + ], + "error_norm_m": 0.0001874807845728379, + "predicted_m": [ + -0.021248341882591285, + -0.18822512399747535, + -0.027239399081236515 + ], + "observed_m": [ + -0.021289765830559533, + -0.188083069951051, + -0.02712427415338315 + ] + }, + { + "marker_id": 66, + "link": "Board", + "error_m": [ + -0.00012599533402873897, + 0.00010588321984128513, + 1.9222121424126992e-05 + ], + "error_norm_m": 0.00016569722506130062, + "predicted_m": [ + 0.2097747285659698, + -0.3632210508324448, + -0.027322535651109706 + ], + "observed_m": [ + 0.20990072389999853, + -0.3633269340522861, + -0.027341757772533833 + ] + }, + { + "marker_id": 68, + "link": "Board", + "error_m": [ + 7.825327892119205e-06, + 0.00015493004001096433, + -6.2036268805194805e-06 + ], + "error_norm_m": 0.00015525153152510572, + "predicted_m": [ + 0.5737453248462413, + 0.1706553596478406, + -0.027348536991536634 + ], + "observed_m": [ + 0.5737374995183492, + 0.17050042960782963, + -0.027342333364656114 + ] + }, + { + "marker_id": 69, + "link": "Board", + "error_m": [ + -5.922502571516393e-05, + -0.00038388839300179667, + 0.0002968696214815658 + ], + "error_norm_m": 0.0004888859520492196, + "predicted_m": [ + 0.007633292717869882, + -0.28120461419894877, + -0.027259012330330554 + ], + "observed_m": [ + 0.007692517743585046, + -0.28082072580594697, + -0.02755588195181212 + ] + }, + { + "marker_id": 72, + "link": "Board", + "error_m": [ + 0.00038155310689075295, + 0.0003161964191133182, + -0.00039087258499147584 + ], + "error_norm_m": 0.0006311452499512217, + "predicted_m": [ + 0.4410049128598024, + 0.1943330199375759, + -0.027310736536235895 + ], + "observed_m": [ + 0.44062335975291167, + 0.19401682351846258, + -0.02691986395124442 + ] + }, + { + "marker_id": 73, + "link": "Board", + "error_m": [ + -1.0809524911947754e-05, + 0.0005209083581688145, + -0.00047217776510506335 + ], + "error_norm_m": 0.0007031459345673303, + "predicted_m": [ + 0.2217424789700998, + 0.3331191543494928, + -0.027235372345979156 + ], + "observed_m": [ + 0.22175328849501175, + 0.332598245991324, + -0.026763194580874092 + ] + }, + { + "marker_id": 75, + "link": "Board", + "error_m": [ + 2.089296773622948e-05, + 5.2785255821891086e-05, + 0.00012760099364308997 + ], + "error_norm_m": 0.00013965963236280373, + "predicted_m": [ + -0.02568507566788694, + 0.1945847946471359, + -0.02718859923262906 + ], + "observed_m": [ + -0.025705968635623168, + 0.19453200939131401, + -0.02731620022627215 + ] + }, + { + "marker_id": 79, + "link": "Board", + "error_m": [ + -8.855756673514792e-05, + -0.00040320196247570217, + 0.00020058987954125682 + ], + "error_norm_m": 0.00045896684514753745, + "predicted_m": [ + 0.31232113440411313, + -0.15909924516350613, + -0.027322897361177708 + ], + "observed_m": [ + 0.3124096919708483, + -0.15869604320103042, + -0.027523487240718965 + ] + }, + { + "marker_id": 82, + "link": "Board", + "error_m": [ + -6.158694231089834e-05, + -8.580082970072178e-05, + 8.957893097094605e-05 + ], + "error_norm_m": 0.00013848869525862282, + "predicted_m": [ + 0.21917311004078294, + 0.2972491093610568, + -0.027239351371315373 + ], + "observed_m": [ + 0.21923469698309384, + 0.29733491019075753, + -0.02732893030228632 + ] + }, + { + "marker_id": 83, + "link": "Board", + "error_m": [ + -5.426234104181915e-05, + -0.00011111020260934357, + 0.00016511898797014202 + ], + "error_norm_m": 0.00020628659425060074, + "predicted_m": [ + 0.04417237759553884, + 0.3392260246727398, + -0.027188121068680585 + ], + "observed_m": [ + 0.04422663993658066, + 0.33933713487534917, + -0.027353240056650727 + ] + }, + { + "marker_id": 84, + "link": "Board", + "error_m": [ + 0.00014352441574932984, + 6.221915725929117e-05, + -3.7946691859542386e-05 + ], + "error_norm_m": 0.00016096717947869355, + "predicted_m": [ + 0.40750378644075314, + 0.25843242896005214, + -0.02729365952910834 + ], + "observed_m": [ + 0.4073602620250038, + 0.25837020980279285, + -0.027255712837248796 + ] + }, + { + "marker_id": 85, + "link": "Board", + "error_m": [ + 0.00018448005383175925, + -0.0001929986884540713, + 0.00010304636704261058 + ], + "error_norm_m": 0.0002861816516959829, + "predicted_m": [ + 0.5046038304449671, + -0.3127358549636571, + -0.027393128242827122 + ], + "observed_m": [ + 0.5044193503911354, + -0.312542856275203, + -0.027496174609869733 + ] + }, + { + "marker_id": 86, + "link": "Board", + "error_m": [ + -0.00041302127011444423, + -0.00022729111282671077, + 0.00012288976179672742 + ], + "error_norm_m": 0.00048718550172537946, + "predicted_m": [ + 0.36290319709893226, + 0.2920216426091962, + -0.027277634723037018 + ], + "observed_m": [ + 0.3633162183690467, + 0.29224893372202293, + -0.027400524484833745 + ] + }, + { + "marker_id": 92, + "link": "Board", + "error_m": [ + -0.0002249958117158668, + 0.0002764089032140371, + -0.0002382375432670586 + ], + "error_norm_m": 0.0004286981736462057, + "predicted_m": [ + 0.645111575573512, + -0.1848233796071786, + -0.027413304224449212 + ], + "observed_m": [ + 0.6453365713852278, + -0.18509978851039263, + -0.027175066681182154 + ] + }, + { + "marker_id": 95, + "link": "Board", + "error_m": [ + 0.00016437102236044332, + 0.00011049113339506311, + -1.4708207874688378e-05 + ], + "error_norm_m": 0.00019860124604248594, + "predicted_m": [ + 0.18606316098464215, + -0.27406146947837556, + -0.02730477042528646 + ], + "observed_m": [ + 0.1858987899622817, + -0.2741719606117706, + -0.027290062217411773 + ] + }, + { + "marker_id": 96, + "link": "Board", + "error_m": [ + 7.649016640010053e-05, + 9.828472211886874e-05, + -9.089716310750964e-05 + ], + "error_norm_m": 0.00015418471525703036, + "predicted_m": [ + 0.36979161406450833, + -0.18647823203546626, + -0.027341484161157538 + ], + "observed_m": [ + 0.36971512389810823, + -0.18657651675758513, + -0.02725058699805003 + ] + }, + { + "marker_id": 97, + "link": "Board", + "error_m": [ + 0.00020382614999203685, + 7.179636906051723e-05, + -0.0002027098903542475 + ], + "error_norm_m": 0.00029629565922956305, + "predicted_m": [ + 0.3043746626901148, + -0.35965938356286725, + -0.027346824913079992 + ], + "observed_m": [ + 0.3041708365401228, + -0.35973117993192777, + -0.027144115022725745 + ] + }, + { + "marker_id": 102, + "link": "Board", + "error_m": [ + -0.00013600903849941837, + -0.000190094809003033, + 0.00038261680713974275 + ], + "error_norm_m": 0.000448363821097607, + "predicted_m": [ + 0.649712246680626, + -0.22298329820664672, + -0.027419456145602768 + ], + "observed_m": [ + 0.6498482557191254, + -0.2227932033976437, + -0.02780207295274251 + ] + }, + { + "marker_id": 103, + "link": "Board", + "error_m": [ + -4.772273536859939e-06, + 0.0001558927351641426, + -3.216445323070416e-07 + ], + "error_norm_m": 0.0001559660954402375, + "predicted_m": [ + 0.1057316446043112, + -0.18770288601290436, + -0.027272554375566267 + ], + "observed_m": [ + 0.10573641687784806, + -0.1878587787480685, + -0.02727223273103396 + ] + }, + { + "marker_id": 105, + "link": "Board", + "error_m": [ + 0.0002116687607344181, + 0.00022434563679629704, + -0.00030475494066066824 + ], + "error_norm_m": 0.0004336014332050435, + "predicted_m": [ + 0.5248630117757593, + -0.2662354982846541, + -0.02739239914154039 + ], + "observed_m": [ + 0.5246513430150249, + -0.2664598439214504, + -0.02708764420087972 + ] + }, + { + "marker_id": 198, + "link": "Arm1", + "error_m": [ + 0.00017264157800062074, + 0.002338924985120873, + 0.010923774565658156 + ], + "error_norm_m": 0.01117270003006423, + "predicted_m": [ + 0.16014006185707808, + -0.050753459799546534, + 0.10134314805110152 + ], + "observed_m": [ + 0.15996742027907745, + -0.05309238478466741, + 0.09041937348544336 + ] + }, + { + "marker_id": 205, + "link": "Board", + "error_m": [ + -5.006671163554355e-05, + 2.1165048207510972e-06, + -0.0002114886335585359 + ], + "error_norm_m": 0.00021734442097994972, + "predicted_m": [ + 0.7500271249111544, + -0.08998511030436256, + 0.0001715445666394677 + ], + "observed_m": [ + 0.75007719162279, + -0.08998722680918331, + 0.0003830332001980036 + ] + }, + { + "marker_id": 206, + "link": "Board", + "error_m": [ + -0.00010244785427382386, + -0.0004777894848594748, + 0.00017382965480367723 + ], + "error_norm_m": 0.0005186473788391864, + "predicted_m": [ + 0.6500257210846707, + -0.009986873462998147, + 0.0002080822938108538 + ], + "observed_m": [ + 0.6501281689389445, + -0.009509083978138672, + 3.4252639007176556e-05 + ] + }, + { + "marker_id": 207, + "link": "Board", + "error_m": [ + -0.0006581080226497615, + -0.000433861471745239, + 0.0005291329254721933 + ], + "error_norm_m": 0.0009493806396591862, + "predicted_m": [ + 0.750025717646431, + -0.009985110989361739, + 0.0001819185473904473 + ], + "observed_m": [ + 0.7506838256690808, + -0.0095512495176165, + -0.00034721437808174607 + ] + }, + { + "marker_id": 208, + "link": "Board", + "error_m": [ + 3.670025145363631e-05, + 2.9199448923003524e-05, + -5.1625268070184236e-05 + ], + "error_norm_m": 6.974729082541923e-05, + "predicted_m": [ + 0.3500271386641134, + -0.08999216019890818, + 0.0002761995523210937 + ], + "observed_m": [ + 0.34999043841265975, + -0.09002135964783119, + 0.0003278248203912779 + ] + }, + { + "marker_id": 210, + "link": "Board", + "error_m": [ + -4.198331445853104e-05, + 0.0003066847233939157, + -9.23607503197693e-05 + ], + "error_norm_m": 0.000323030380081746, + "predicted_m": [ + 0.020025918653671454, + -0.019997976961282627, + 0.0003716171486655422 + ], + "observed_m": [ + 0.020067901968129985, + -0.020304661684676543, + 0.0004639778989853115 + ] + }, + { + "marker_id": 211, + "link": "Board", + "error_m": [ + 0.00010807411786095678, + 0.00027529169532617206, + 6.0644706240166064e-05 + ], + "error_norm_m": 0.0003018995078862136, + "predicted_m": [ + 0.25002573483762963, + -0.009993923357543783, + 0.0003127372794924798 + ], + "observed_m": [ + 0.24991766071976868, + -0.010269215052869955, + 0.0002520925732523137 + ] + }, + { + "marker_id": 214, + "link": "Board", + "error_m": [ + 7.23100831970247e-05, + 0.00027996229800264505, + -0.0002693511552954145 + ], + "error_norm_m": 0.00039516791531430913, + "predicted_m": [ + 0.35002573139938997, + -0.009992160883907374, + 0.00028657353307207323 + ], + "observed_m": [ + 0.34995342131619295, + -0.01027212318191002, + 0.0005559246883674878 + ] + }, + { + "marker_id": 215, + "link": "Board", + "error_m": [ + 0.00020047129502520633, + 8.830003371299022e-05, + -0.0001365160957813505 + ], + "error_norm_m": 0.0002581129219744362, + "predicted_m": [ + 0.25002714210235305, + -0.0899939226725446, + 0.00030236329874150017 + ], + "observed_m": [ + 0.24982667080732784, + -0.09008222270625758, + 0.0004388793945228507 + ] + }, + { + "marker_id": 217, + "link": "Board", + "error_m": [ + -0.00011520168245726659, + -0.00029924750252879884, + 6.039451249597691e-05 + ], + "error_norm_m": 0.0003262943342295956, + "predicted_m": [ + 0.6500271283493941, + -0.08998687277799897, + 0.0001977083130598742 + ], + "observed_m": [ + 0.6501423300318514, + -0.08968762527547017, + 0.00013731380056389728 + ] + }, + { + "marker_id": 229, + "link": "Arm1", + "error_m": [ + 0.0001692087482302318, + 0.002444742164626118, + 0.017027454546097415 + ], + "error_norm_m": 0.017202895226426044, + "predicted_m": [ + 0.160142428816494, + -0.1407038663169075, + 0.1043305150789356 + ], + "observed_m": [ + 0.15997322006826376, + -0.14314860848153363, + 0.08730306053283819 + ] + }, + { + "marker_id": 232, + "link": "Ellbow", + "error_m": [ + 0.00011887142674299467, + 0.0591000647000602, + 0.053882215199836034 + ], + "error_norm_m": 0.07997577691281804, + "predicted_m": [ + 0.2501361464486919, + -0.1094018263571989, + 0.08241556607813931 + ], + "observed_m": [ + 0.2500172750219489, + -0.1685018910572591, + 0.028533350878303273 + ] + }, + { + "marker_id": 243, + "link": "Arm1", + "error_m": [ + 0.00036330284973376537, + 0.000439013837590041, + 0.019642091452553266 + ], + "error_norm_m": 0.019650355689928015, + "predicted_m": [ + 0.1601342175111022, + -0.17684633400759492, + 0.07051155646395044 + ], + "observed_m": [ + 0.15977091466136845, + -0.17728534784518496, + 0.05086946501139717 + ] + }, + { + "marker_id": 244, + "link": "Ellbow", + "error_m": [ + -0.0007986309759998589, + 0.0006828227405001608, + 0.017137495860633303 + ], + "error_norm_m": 0.01716967741991661, + "predicted_m": [ + 0.2851332927289253, + -0.14186341726990898, + 0.06931709793676727 + ], + "observed_m": [ + 0.28593192370492515, + -0.14254624001040914, + 0.052179602076133966 + ] + }, + { + "marker_id": 245, + "link": "Ellbow", + "error_m": [ + -0.00010883503527764349, + 0.0674991449496973, + 0.0020044754401203208 + ], + "error_norm_m": 0.06752898885512204, + "predicted_m": [ + 0.2501291423603053, + -0.10965588945545576, + 0.05562824812946068 + ], + "observed_m": [ + 0.25023797739558296, + -0.17715503440515307, + 0.05362377268934036 + ] + }, + { + "marker_id": 248, + "link": "Ellbow", + "error_m": [ + 0.0001119597610023948, + 0.0674936943393805, + 0.001854521809903302 + ], + "error_norm_m": 0.06751926067211649, + "predicted_m": [ + 0.2126291436496932, + -0.10965655038306941, + 0.05563805953436833 + ], + "observed_m": [ + 0.2125171838886908, + -0.17715024472244992, + 0.05378353772446503 + ] + } + ], + "stage_idx": 1, + "num_active_links": 4 + }, + { + "method": "deterministic_geometric_prefix", + "active_links": [ + "Board", + "Base", + "Arm1", + "Ellbow", + "Arm2" + ], + "active_observations": 52, + "joint_updates": [ + { + "pass": 0, + "updates": [ + { + "link": "Base", + "joint_variable": "x", + "joint_type": "linear", + "old": 0.05008717839341761, + "new": 0.052139867571197346, + "info": { + "reason": "weighted_projection", + "used_markers": 11, + "axis_world": [ + 0.9999999656166024, + 1.7624736364070108e-05, + -0.0002616374642038032 + ], + "per_marker": [ + { + "marker_id": 198, + "q_i": 0.04991735366699348, + "weight": 1.0 + }, + { + "marker_id": 229, + "q_i": 0.049922381582998346, + "weight": 1.0 + }, + { + "marker_id": 243, + "q_i": 0.049729006925571424, + "weight": 1.0 + }, + { + "marker_id": 244, + "q_i": 0.050890281118246686, + "weight": 1.0 + }, + { + "marker_id": 245, + "q_i": 0.05019534821608962, + "weight": 1.0 + }, + { + "marker_id": 248, + "q_i": 0.0499745142899793, + "weight": 1.0 + }, + { + "marker_id": 232, + "q_i": 0.049981362953752766, + "weight": 1.0 + }, + { + "marker_id": 120, + "q_i": 0.05721453727651868, + "weight": 1.0 + }, + { + "marker_id": 114, + "q_i": 0.05707455939301907, + "weight": 1.0 + }, + { + "marker_id": 115, + "q_i": 0.059998979855315104, + "weight": 1.0 + }, + { + "marker_id": 219, + "q_i": 0.04864021800468629, + "weight": 1.0 + } + ] + } + }, + { + "link": "Arm1", + "joint_variable": "y", + "joint_type": "revolute", + "old": 0.03332874108695938, + "new": -0.5316795436975772, + "info": { + "reason": "2d_alignment+normal_tiebreak", + "used_markers": 11, + "axis_world": [ + -0.9999999656166024, + -1.7624736364070108e-05, + 0.0002616374642038032 + ], + "axis_id": 0, + "theta_rad": -0.5316795436975774, + "theta_alt_rad": 2.609913109892216, + "score_theta": 1.0312685175858676, + "score_theta_alt": 2.556427733181886, + "best_score": 1.0312685175858676, + "per_marker": [ + { + "marker_id": 198, + "weight": 1.0 + }, + { + "marker_id": 229, + "weight": 1.0 + }, + { + "marker_id": 243, + "weight": 1.0 + }, + { + "marker_id": 244, + "weight": 1.0 + }, + { + "marker_id": 245, + "weight": 1.0 + }, + { + "marker_id": 248, + "weight": 1.0 + }, + { + "marker_id": 232, + "weight": 1.0 + }, + { + "marker_id": 120, + "weight": 1.0 + }, + { + "marker_id": 114, + "weight": 1.0 + }, + { + "marker_id": 115, + "weight": 1.0 + }, + { + "marker_id": 219, + "weight": 1.0 + } + ] + } + }, + { + "link": "Ellbow", + "joint_variable": "z", + "joint_type": "revolute", + "old": -1.2018737301676388, + "new": 1.0023915183057088, + "info": { + "reason": "2d_alignment+normal_tiebreak", + "used_markers": 7, + "axis_world": [ + -0.9999999656166024, + -1.7624736364070108e-05, + 0.0002616374642038032 + ], + "axis_id": 0, + "theta_rad": -2.1392011352840843, + "theta_alt_rad": 1.0023915183057088, + "score_theta": 1.0203661555325265, + "score_theta_alt": 0.38303893430417496, + "best_score": 0.38303893430417496, + "per_marker": [ + { + "marker_id": 245, + "weight": 1.0 + }, + { + "marker_id": 248, + "weight": 1.0 + }, + { + "marker_id": 232, + "weight": 1.0 + }, + { + "marker_id": 120, + "weight": 1.0 + }, + { + "marker_id": 114, + "weight": 1.0 + }, + { + "marker_id": 115, + "weight": 1.0 + }, + { + "marker_id": 219, + "weight": 1.0 + } + ] + } + }, + { + "link": "Arm2", + "joint_variable": "a", + "joint_type": "revolute", + "old": 0.0, + "new": 0.9472658659035833, + "info": { + "reason": "2d_alignment+normal_tiebreak", + "used_markers": 4, + "axis_world": [ + 0.00013433683687575696, + -0.8913044192134195, + 0.45340535312482055 + ], + "axis_id": 1, + "theta_rad": -2.19432678768621, + "theta_alt_rad": 0.9472658659035833, + "score_theta": 0.4441085479217772, + "score_theta_alt": 0.36466605644041394, + "best_score": 0.36466605644041394, + "per_marker": [ + { + "marker_id": 120, + "weight": 1.0 + }, + { + "marker_id": 114, + "weight": 1.0 + }, + { + "marker_id": 115, + "weight": 1.0 + }, + { + "marker_id": 219, + "weight": 1.0 + } + ] + } + } + ] + }, + { + "pass": 1, + "updates": [ + { + "link": "Base", + "joint_variable": "x", + "joint_type": "linear", + "old": 0.052139867571197346, + "new": 0.04892022155170399, + "info": { + "reason": "weighted_projection", + "used_markers": 11, + "axis_world": [ + 0.9999999656166024, + 1.7624736364070108e-05, + -0.0002616374642038032 + ], + "per_marker": [ + { + "marker_id": 198, + "q_i": 0.049917353666993465, + "weight": 1.0 + }, + { + "marker_id": 229, + "q_i": 0.04992238158299834, + "weight": 1.0 + }, + { + "marker_id": 243, + "q_i": 0.049729006925571424, + "weight": 1.0 + }, + { + "marker_id": 244, + "q_i": 0.05089028111823664, + "weight": 1.0 + }, + { + "marker_id": 245, + "q_i": 0.050195348216082424, + "weight": 1.0 + }, + { + "marker_id": 248, + "q_i": 0.0499745142899751, + "weight": 1.0 + }, + { + "marker_id": 232, + "q_i": 0.04998136295374555, + "weight": 1.0 + }, + { + "marker_id": 120, + "q_i": 0.04742029485709134, + "weight": 1.0 + }, + { + "marker_id": 114, + "q_i": 0.04728031697359171, + "weight": 1.0 + }, + { + "marker_id": 115, + "q_i": 0.029608029965032954, + "weight": 1.0 + }, + { + "marker_id": 219, + "q_i": 0.06320354651942489, + "weight": 1.0 + } + ] + } + }, + { + "link": "Arm1", + "joint_variable": "y", + "joint_type": "revolute", + "old": -0.5316795436975772, + "new": -0.08836641382860355, + "info": { + "reason": "2d_alignment+normal_tiebreak", + "used_markers": 11, + "axis_world": [ + -0.9999999656166024, + -1.7624736364070108e-05, + 0.0002616374642038032 + ], + "axis_id": 0, + "theta_rad": -0.0883664138286035, + "theta_alt_rad": 3.053226239761189, + "score_theta": 0.06011097684137366, + "score_theta_alt": 3.8811418101118305, + "best_score": 0.06011097684137366, + "per_marker": [ + { + "marker_id": 198, + "weight": 1.0 + }, + { + "marker_id": 229, + "weight": 1.0 + }, + { + "marker_id": 243, + "weight": 1.0 + }, + { + "marker_id": 244, + "weight": 1.0 + }, + { + "marker_id": 245, + "weight": 1.0 + }, + { + "marker_id": 248, + "weight": 1.0 + }, + { + "marker_id": 232, + "weight": 1.0 + }, + { + "marker_id": 120, + "weight": 1.0 + }, + { + "marker_id": 114, + "weight": 1.0 + }, + { + "marker_id": 115, + "weight": 1.0 + }, + { + "marker_id": 219, + "weight": 1.0 + } + ] + } + }, + { + "link": "Ellbow", + "joint_variable": "z", + "joint_type": "revolute", + "old": 1.0023915183057088, + "new": 1.4943262922107685, + "info": { + "reason": "2d_alignment+normal_tiebreak", + "used_markers": 7, + "axis_world": [ + -0.9999999656166024, + -1.7624736364070108e-05, + 0.00026163746420380317 + ], + "axis_id": 0, + "theta_rad": -1.6472663613790242, + "theta_alt_rad": 1.4943262922107685, + "score_theta": 0.7697046459474692, + "score_theta_alt": 0.0988607962379581, + "best_score": 0.0988607962379581, + "per_marker": [ + { + "marker_id": 245, + "weight": 1.0 + }, + { + "marker_id": 248, + "weight": 1.0 + }, + { + "marker_id": 232, + "weight": 1.0 + }, + { + "marker_id": 120, + "weight": 1.0 + }, + { + "marker_id": 114, + "weight": 1.0 + }, + { + "marker_id": 115, + "weight": 1.0 + }, + { + "marker_id": 219, + "weight": 1.0 + } + ] + } + }, + { + "link": "Arm2", + "joint_variable": "a", + "joint_type": "revolute", + "old": 0.9472658659035833, + "new": 1.0937896539089307, + "info": { + "reason": "2d_alignment+normal_tiebreak", + "used_markers": 4, + "axis_world": [ + 0.00026097976795783464, + -0.16421890960176014, + 0.986423885364081 + ], + "axis_id": 2, + "theta_rad": 1.0937896539089305, + "theta_alt_rad": -2.0478029996808624, + "score_theta": 0.15157290470500367, + "score_theta_alt": 0.17550794275752263, + "best_score": 0.15157290470500367, + "per_marker": [ + { + "marker_id": 120, + "weight": 1.0 + }, + { + "marker_id": 114, + "weight": 1.0 + }, + { + "marker_id": 115, + "weight": 1.0 + }, + { + "marker_id": 219, + "weight": 1.0 + } + ] + } + } + ] + } + ], + "root_link": "Board", + "root_pose": { + "reason": "kabsch", + "used_markers": [ + 210, + 211, + 215, + 214, + 208, + 206, + 205, + 207, + 217, + 46, + 47, + 51, + 53, + 54, + 55, + 56, + 58, + 60, + 61, + 62, + 63, + 64, + 66, + 68, + 69, + 72, + 73, + 75, + 79, + 82, + 83, + 84, + 85, + 86, + 92, + 95, + 96, + 97, + 102, + 103, + 105 + ] + }, + "marker_stats": { + "num_markers_used": 52, + "mean_error_m": 0.004676020002923168, + "rms_error_m": 0.011046497474104171, + "median_error_m": 0.00030954508468976, + "worst_error_m": 0.0516355036399338 + }, + "marker_reports": [ + { + "marker_id": 46, + "link": "Board", + "error_m": [ + 0.00023119187005882225, + 0.0001638179674103568, + -0.00010463200703492853 + ], + "error_norm_m": 0.0003020494398669089, + "predicted_m": [ + 0.5367250657751038, + 0.18545470705337558, + -0.027336931986172867 + ], + "observed_m": [ + 0.536493873905045, + 0.18529088908596522, + -0.02723229997913794 + ] + }, + { + "marker_id": 47, + "link": "Board", + "error_m": [ + -0.00014744286046136645, + 0.00012173977173757233, + -0.0001348842178661505 + ], + "error_norm_m": 0.0002339951310457321, + "predicted_m": [ + 0.3442533749030795, + -0.2865286813145559, + -0.02734777589999846 + ], + "observed_m": [ + 0.34440081776354087, + -0.28665042108629346, + -0.02721289168213231 + ] + }, + { + "marker_id": 51, + "link": "Board", + "error_m": [ + 5.309812312059847e-05, + -0.00020886326021332668, + 0.0002325329052500283 + ], + "error_norm_m": 0.00031704072951261117, + "predicted_m": [ + 0.16782136752516283, + -0.1720717918268552, + -0.027286772629229475 + ], + "observed_m": [ + 0.16776826940204223, + -0.17186292856664187, + -0.027519305534479503 + ] + }, + { + "marker_id": 53, + "link": "Board", + "error_m": [ + -3.082762285167018e-05, + 5.734226533921083e-05, + -8.574129649907211e-05 + ], + "error_norm_m": 0.00010765708360465219, + "predicted_m": [ + 0.4862645960763571, + 0.2122538174797039, + -0.02732025447617755 + ], + "observed_m": [ + 0.48629542369920875, + 0.2121964752143647, + -0.02723451317967848 + ] + }, + { + "marker_id": 54, + "link": "Board", + "error_m": [ + -8.689741467815537e-05, + 2.084652103728768e-05, + -0.00013996332264986158 + ], + "error_norm_m": 0.00016605863363370973, + "predicted_m": [ + 0.34229414984560724, + -0.33057871548186146, + -0.027352975263719628 + ], + "observed_m": [ + 0.3423810472602854, + -0.33059956200289875, + -0.027213011941069766 + ] + }, + { + "marker_id": 55, + "link": "Board", + "error_m": [ + -3.283680479632123e-05, + 8.93325736997519e-05, + -4.533787401645936e-05 + ], + "error_norm_m": 0.00010542337166580117, + "predicted_m": [ + 0.2837429555077737, + -0.2625697479925105, + -0.027328837209804554 + ], + "observed_m": [ + 0.28377579231257, + -0.26265908056621023, + -0.027283499335788094 + ] + }, + { + "marker_id": 56, + "link": "Board", + "error_m": [ + 5.6683143949021186e-05, + -4.187347286849219e-05, + -1.0361057953760244e-05 + ], + "error_norm_m": 7.123003622022796e-05, + "predicted_m": [ + 0.4986953620805339, + 0.16868403692824455, + -0.027329156559124112 + ], + "observed_m": [ + 0.49863867893658487, + 0.16872591040111304, + -0.02731879550117035 + ] + }, + { + "marker_id": 58, + "link": "Board", + "error_m": [ + 0.00010898286639899474, + -0.00013531298462457486, + 2.4156409186272543e-05 + ], + "error_norm_m": 0.00017541493973241332, + "predicted_m": [ + 0.05011218127725505, + -0.21810386604044124, + -0.027261944212492607 + ], + "observed_m": [ + 0.050003198410856056, + -0.21796855305581667, + -0.02728610062167888 + ] + }, + { + "marker_id": 60, + "link": "Board", + "error_m": [ + 1.692622537791122e-05, + 4.309980570010863e-05, + 1.0628662820987705e-05 + ], + "error_norm_m": 4.750851324018894e-05, + "predicted_m": [ + 0.43437333888625645, + 0.2838229023193166, + -0.02729739728563066 + ], + "observed_m": [ + 0.43435641266087854, + 0.2837798025136165, + -0.027308025948451647 + ] + }, + { + "marker_id": 61, + "link": "Board", + "error_m": [ + 2.1550213066802437e-05, + -0.00039134191686995834, + 0.0003126923269400131 + ], + "error_norm_m": 0.0005013874738262195, + "predicted_m": [ + -0.0224075604824385, + 0.3358348512468195, + -0.0271711408437482 + ], + "observed_m": [ + -0.0224291106955053, + 0.33622619316368946, + -0.027483833170688213 + ] + }, + { + "marker_id": 62, + "link": "Board", + "error_m": [ + 4.5764718946572636e-05, + 3.2876613692278678e-06, + 6.080875086055329e-05 + ], + "error_norm_m": 7.617691513023049e-05, + "predicted_m": [ + 0.4047214125042162, + -0.1750876165009518, + -0.027349146162272766 + ], + "observed_m": [ + 0.40467564778526965, + -0.17509090416232104, + -0.02740995491313332 + ] + }, + { + "marker_id": 63, + "link": "Board", + "error_m": [ + 5.723858885597899e-05, + 9.356691776807313e-05, + 0.00018386234045146901 + ], + "error_norm_m": 0.0002140943352616623, + "predicted_m": [ + 0.7774224736087888, + -0.2361310472389689, + -0.02745457508924221 + ], + "observed_m": [ + 0.7773652350199328, + -0.23622461415673698, + -0.02763843742969368 + ] + }, + { + "marker_id": 64, + "link": "Board", + "error_m": [ + 4.1423947968247804e-05, + -0.00014205404642433916, + -0.00011512492785336476 + ], + "error_norm_m": 0.0001874807845728379, + "predicted_m": [ + -0.021248341882591285, + -0.18822512399747535, + -0.027239399081236515 + ], + "observed_m": [ + -0.021289765830559533, + -0.188083069951051, + -0.02712427415338315 + ] + }, + { + "marker_id": 66, + "link": "Board", + "error_m": [ + -0.00012599533402873897, + 0.00010588321984128513, + 1.9222121424126992e-05 + ], + "error_norm_m": 0.00016569722506130062, + "predicted_m": [ + 0.2097747285659698, + -0.3632210508324448, + -0.027322535651109706 + ], + "observed_m": [ + 0.20990072389999853, + -0.3633269340522861, + -0.027341757772533833 + ] + }, + { + "marker_id": 68, + "link": "Board", + "error_m": [ + 7.825327892119205e-06, + 0.00015493004001096433, + -6.2036268805194805e-06 + ], + "error_norm_m": 0.00015525153152510572, + "predicted_m": [ + 0.5737453248462413, + 0.1706553596478406, + -0.027348536991536634 + ], + "observed_m": [ + 0.5737374995183492, + 0.17050042960782963, + -0.027342333364656114 + ] + }, + { + "marker_id": 69, + "link": "Board", + "error_m": [ + -5.922502571516393e-05, + -0.00038388839300179667, + 0.0002968696214815658 + ], + "error_norm_m": 0.0004888859520492196, + "predicted_m": [ + 0.007633292717869882, + -0.28120461419894877, + -0.027259012330330554 + ], + "observed_m": [ + 0.007692517743585046, + -0.28082072580594697, + -0.02755588195181212 + ] + }, + { + "marker_id": 72, + "link": "Board", + "error_m": [ + 0.00038155310689075295, + 0.0003161964191133182, + -0.00039087258499147584 + ], + "error_norm_m": 0.0006311452499512217, + "predicted_m": [ + 0.4410049128598024, + 0.1943330199375759, + -0.027310736536235895 + ], + "observed_m": [ + 0.44062335975291167, + 0.19401682351846258, + -0.02691986395124442 + ] + }, + { + "marker_id": 73, + "link": "Board", + "error_m": [ + -1.0809524911947754e-05, + 0.0005209083581688145, + -0.00047217776510506335 + ], + "error_norm_m": 0.0007031459345673303, + "predicted_m": [ + 0.2217424789700998, + 0.3331191543494928, + -0.027235372345979156 + ], + "observed_m": [ + 0.22175328849501175, + 0.332598245991324, + -0.026763194580874092 + ] + }, + { + "marker_id": 75, + "link": "Board", + "error_m": [ + 2.089296773622948e-05, + 5.2785255821891086e-05, + 0.00012760099364308997 + ], + "error_norm_m": 0.00013965963236280373, + "predicted_m": [ + -0.02568507566788694, + 0.1945847946471359, + -0.02718859923262906 + ], + "observed_m": [ + -0.025705968635623168, + 0.19453200939131401, + -0.02731620022627215 + ] + }, + { + "marker_id": 79, + "link": "Board", + "error_m": [ + -8.855756673514792e-05, + -0.00040320196247570217, + 0.00020058987954125682 + ], + "error_norm_m": 0.00045896684514753745, + "predicted_m": [ + 0.31232113440411313, + -0.15909924516350613, + -0.027322897361177708 + ], + "observed_m": [ + 0.3124096919708483, + -0.15869604320103042, + -0.027523487240718965 + ] + }, + { + "marker_id": 82, + "link": "Board", + "error_m": [ + -6.158694231089834e-05, + -8.580082970072178e-05, + 8.957893097094605e-05 + ], + "error_norm_m": 0.00013848869525862282, + "predicted_m": [ + 0.21917311004078294, + 0.2972491093610568, + -0.027239351371315373 + ], + "observed_m": [ + 0.21923469698309384, + 0.29733491019075753, + -0.02732893030228632 + ] + }, + { + "marker_id": 83, + "link": "Board", + "error_m": [ + -5.426234104181915e-05, + -0.00011111020260934357, + 0.00016511898797014202 + ], + "error_norm_m": 0.00020628659425060074, + "predicted_m": [ + 0.04417237759553884, + 0.3392260246727398, + -0.027188121068680585 + ], + "observed_m": [ + 0.04422663993658066, + 0.33933713487534917, + -0.027353240056650727 + ] + }, + { + "marker_id": 84, + "link": "Board", + "error_m": [ + 0.00014352441574932984, + 6.221915725929117e-05, + -3.7946691859542386e-05 + ], + "error_norm_m": 0.00016096717947869355, + "predicted_m": [ + 0.40750378644075314, + 0.25843242896005214, + -0.02729365952910834 + ], + "observed_m": [ + 0.4073602620250038, + 0.25837020980279285, + -0.027255712837248796 + ] + }, + { + "marker_id": 85, + "link": "Board", + "error_m": [ + 0.00018448005383175925, + -0.0001929986884540713, + 0.00010304636704261058 + ], + "error_norm_m": 0.0002861816516959829, + "predicted_m": [ + 0.5046038304449671, + -0.3127358549636571, + -0.027393128242827122 + ], + "observed_m": [ + 0.5044193503911354, + -0.312542856275203, + -0.027496174609869733 + ] + }, + { + "marker_id": 86, + "link": "Board", + "error_m": [ + -0.00041302127011444423, + -0.00022729111282671077, + 0.00012288976179672742 + ], + "error_norm_m": 0.00048718550172537946, + "predicted_m": [ + 0.36290319709893226, + 0.2920216426091962, + -0.027277634723037018 + ], + "observed_m": [ + 0.3633162183690467, + 0.29224893372202293, + -0.027400524484833745 + ] + }, + { + "marker_id": 92, + "link": "Board", + "error_m": [ + -0.0002249958117158668, + 0.0002764089032140371, + -0.0002382375432670586 + ], + "error_norm_m": 0.0004286981736462057, + "predicted_m": [ + 0.645111575573512, + -0.1848233796071786, + -0.027413304224449212 + ], + "observed_m": [ + 0.6453365713852278, + -0.18509978851039263, + -0.027175066681182154 + ] + }, + { + "marker_id": 95, + "link": "Board", + "error_m": [ + 0.00016437102236044332, + 0.00011049113339506311, + -1.4708207874688378e-05 + ], + "error_norm_m": 0.00019860124604248594, + "predicted_m": [ + 0.18606316098464215, + -0.27406146947837556, + -0.02730477042528646 + ], + "observed_m": [ + 0.1858987899622817, + -0.2741719606117706, + -0.027290062217411773 + ] + }, + { + "marker_id": 96, + "link": "Board", + "error_m": [ + 7.649016640010053e-05, + 9.828472211886874e-05, + -9.089716310750964e-05 + ], + "error_norm_m": 0.00015418471525703036, + "predicted_m": [ + 0.36979161406450833, + -0.18647823203546626, + -0.027341484161157538 + ], + "observed_m": [ + 0.36971512389810823, + -0.18657651675758513, + -0.02725058699805003 + ] + }, + { + "marker_id": 97, + "link": "Board", + "error_m": [ + 0.00020382614999203685, + 7.179636906051723e-05, + -0.0002027098903542475 + ], + "error_norm_m": 0.00029629565922956305, + "predicted_m": [ + 0.3043746626901148, + -0.35965938356286725, + -0.027346824913079992 + ], + "observed_m": [ + 0.3041708365401228, + -0.35973117993192777, + -0.027144115022725745 + ] + }, + { + "marker_id": 102, + "link": "Board", + "error_m": [ + -0.00013600903849941837, + -0.000190094809003033, + 0.00038261680713974275 + ], + "error_norm_m": 0.000448363821097607, + "predicted_m": [ + 0.649712246680626, + -0.22298329820664672, + -0.027419456145602768 + ], + "observed_m": [ + 0.6498482557191254, + -0.2227932033976437, + -0.02780207295274251 + ] + }, + { + "marker_id": 103, + "link": "Board", + "error_m": [ + -4.772273536859939e-06, + 0.0001558927351641426, + -3.216445323070416e-07 + ], + "error_norm_m": 0.0001559660954402375, + "predicted_m": [ + 0.1057316446043112, + -0.18770288601290436, + -0.027272554375566267 + ], + "observed_m": [ + 0.10573641687784806, + -0.1878587787480685, + -0.02727223273103396 + ] + }, + { + "marker_id": 105, + "link": "Board", + "error_m": [ + 0.0002116687607344181, + 0.00022434563679629704, + -0.00030475494066066824 + ], + "error_norm_m": 0.0004336014332050435, + "predicted_m": [ + 0.5248630117757593, + -0.2662354982846541, + -0.02739239914154039 + ], + "observed_m": [ + 0.5246513430150249, + -0.2664598439214504, + -0.02708764420087972 + ] + }, + { + "marker_id": 114, + "link": "Arm2", + "error_m": [ + 0.0004426882820167677, + -0.013135350401750456, + -0.01419056708012073 + ], + "error_norm_m": 0.019341809562375672, + "predicted_m": [ + 0.28235664658584575, + -0.16043102785254823, + 0.22019824124126552 + ], + "observed_m": [ + 0.281913958303829, + -0.14729567745079777, + 0.23438880832138625 + ] + }, + { + "marker_id": 115, + "link": "Arm2", + "error_m": [ + 0.024290096060715444, + -0.03978013774507971, + -0.022220646041312964 + ], + "error_norm_m": 0.0516355036399338, + "predicted_m": [ + 0.2596289812677296, + -0.20380890097270207, + 0.21298274730461253 + ], + "observed_m": [ + 0.23533888520701415, + -0.16402876322762236, + 0.2352033933459255 + ] + }, + { + "marker_id": 120, + "link": "Arm2", + "error_m": [ + 0.0003026062433769128, + 0.002114620961314123, + -0.013561351376687125 + ], + "error_norm_m": 0.013728563053376473, + "predicted_m": [ + 0.2823383780020887, + -0.14893570418043747, + 0.15114856926585468 + ], + "observed_m": [ + 0.2820357717587118, + -0.1510503251417516, + 0.1647099206425418 + ] + }, + { + "marker_id": 198, + "link": "Arm1", + "error_m": [ + -0.000999369811793216, + -0.0013782216845906886, + -0.008645370589097603 + ], + "error_norm_m": 0.008811394194759048, + "predicted_m": [ + 0.15896805046728424, + -0.054470606469258095, + 0.08177400289634576 + ], + "observed_m": [ + 0.15996742027907745, + -0.05309238478466741, + 0.09041937348544336 + ] + }, + { + "marker_id": 205, + "link": "Board", + "error_m": [ + -5.006671163554355e-05, + 2.1165048207510972e-06, + -0.0002114886335585359 + ], + "error_norm_m": 0.00021734442097994972, + "predicted_m": [ + 0.7500271249111544, + -0.08998511030436256, + 0.0001715445666394677 + ], + "observed_m": [ + 0.75007719162279, + -0.08998722680918331, + 0.0003830332001980036 + ] + }, + { + "marker_id": 206, + "link": "Board", + "error_m": [ + -0.00010244785427382386, + -0.0004777894848594748, + 0.00017382965480367723 + ], + "error_norm_m": 0.0005186473788391864, + "predicted_m": [ + 0.6500257210846707, + -0.009986873462998147, + 0.0002080822938108538 + ], + "observed_m": [ + 0.6501281689389445, + -0.009509083978138672, + 3.4252639007176556e-05 + ] + }, + { + "marker_id": 207, + "link": "Board", + "error_m": [ + -0.0006581080226497615, + -0.000433861471745239, + 0.0005291329254721933 + ], + "error_norm_m": 0.0009493806396591862, + "predicted_m": [ + 0.750025717646431, + -0.009985110989361739, + 0.0001819185473904473 + ], + "observed_m": [ + 0.7506838256690808, + -0.0095512495176165, + -0.00034721437808174607 + ] + }, + { + "marker_id": 208, + "link": "Board", + "error_m": [ + 3.670025145363631e-05, + 2.9199448923003524e-05, + -5.1625268070184236e-05 + ], + "error_norm_m": 6.974729082541923e-05, + "predicted_m": [ + 0.3500271386641134, + -0.08999216019890818, + 0.0002761995523210937 + ], + "observed_m": [ + 0.34999043841265975, + -0.09002135964783119, + 0.0003278248203912779 + ] + }, + { + "marker_id": 210, + "link": "Board", + "error_m": [ + -4.198331445853104e-05, + 0.0003066847233939157, + -9.23607503197693e-05 + ], + "error_norm_m": 0.000323030380081746, + "predicted_m": [ + 0.020025918653671454, + -0.019997976961282627, + 0.0003716171486655422 + ], + "observed_m": [ + 0.020067901968129985, + -0.020304661684676543, + 0.0004639778989853115 + ] + }, + { + "marker_id": 211, + "link": "Board", + "error_m": [ + 0.00010807411786095678, + 0.00027529169532617206, + 6.0644706240166064e-05 + ], + "error_norm_m": 0.0003018995078862136, + "predicted_m": [ + 0.25002573483762963, + -0.009993923357543783, + 0.0003127372794924798 + ], + "observed_m": [ + 0.24991766071976868, + -0.010269215052869955, + 0.0002520925732523137 + ] + }, + { + "marker_id": 214, + "link": "Board", + "error_m": [ + 7.23100831970247e-05, + 0.00027996229800264505, + -0.0002693511552954145 + ], + "error_norm_m": 0.00039516791531430913, + "predicted_m": [ + 0.35002573139938997, + -0.009992160883907374, + 0.00028657353307207323 + ], + "observed_m": [ + 0.34995342131619295, + -0.01027212318191002, + 0.0005559246883674878 + ] + }, + { + "marker_id": 215, + "link": "Board", + "error_m": [ + 0.00020047129502520633, + 8.830003371299022e-05, + -0.0001365160957813505 + ], + "error_norm_m": 0.0002581129219744362, + "predicted_m": [ + 0.25002714210235305, + -0.0899939226725446, + 0.00030236329874150017 + ], + "observed_m": [ + 0.24982667080732784, + -0.09008222270625758, + 0.0004388793945228507 + ] + }, + { + "marker_id": 217, + "link": "Board", + "error_m": [ + -0.00011520168245726659, + -0.00029924750252879884, + 6.039451249597691e-05 + ], + "error_norm_m": 0.0003262943342295956, + "predicted_m": [ + 0.6500271283493941, + -0.08998687277799897, + 0.0001977083130598742 + ], + "observed_m": [ + 0.6501423300318514, + -0.08968762527547017, + 0.00013731380056389728 + ] + }, + { + "marker_id": 219, + "link": "Arm2", + "error_m": [ + -0.018652836994818844, + -0.02766746779631049, + -0.00993397340211738 + ], + "error_norm_m": 0.03481523990681575, + "predicted_m": [ + 0.2650855912204819, + -0.14631622623436363, + 0.2600618590128257 + ], + "observed_m": [ + 0.28373842821530076, + -0.11864875843805314, + 0.26999583241494307 + ] + }, + { + "marker_id": 229, + "link": "Arm1", + "error_m": [ + -0.0010056707133092868, + -0.0009698078539764343, + -0.013483313474287897 + ], + "error_norm_m": 0.013555502318363416, + "predicted_m": [ + 0.15896754935495447, + -0.14411841633551006, + 0.0738197470585503 + ], + "observed_m": [ + 0.15997322006826376, + -0.14314860848153363, + 0.08730306053283819 + ] + }, + { + "marker_id": 232, + "link": "Ellbow", + "error_m": [ + -0.001065997120317963, + 0.0071288086066639, + -0.01807859630913358 + ], + "error_norm_m": 0.019462577078064192, + "predicted_m": [ + 0.24895127790163096, + -0.1613730824505952, + 0.010454754569169694 + ], + "observed_m": [ + 0.2500172750219489, + -0.1685018910572591, + 0.028533350878303273 + ] + }, + { + "marker_id": 243, + "link": "Arm1", + "error_m": [ + -0.0008127361790504495, + 0.0013972159987953314, + -0.015006075635644746 + ], + "error_norm_m": 0.015092881057860292, + "predicted_m": [ + 0.158958178482318, + -0.17588813184638963, + 0.035863389375752425 + ], + "observed_m": [ + 0.15977091466136845, + -0.17728534784518496, + 0.05086946501139717 + ] + }, + { + "marker_id": 244, + "link": "Ellbow", + "error_m": [ + -0.001973554643621589, + 0.0015233484262741348, + -0.01325559566870875 + ], + "error_norm_m": 0.01348800670564344, + "predicted_m": [ + 0.28395836906130356, + -0.141022891584135, + 0.038924006407425216 + ], + "observed_m": [ + 0.28593192370492515, + -0.14254624001040914, + 0.052179602076133966 + ] + }, + { + "marker_id": 245, + "link": "Ellbow", + "error_m": [ + -0.0012805024433661383, + 0.0016066887646762062, + -0.020438270770100707 + ], + "error_norm_m": 0.020541276673224484, + "predicted_m": [ + 0.24895747495221682, + -0.17554834564047686, + 0.033185501919239656 + ], + "observed_m": [ + 0.25023797739558296, + -0.17715503440515307, + 0.05362377268934036 + ] + }, + { + "marker_id": 248, + "link": "Ellbow", + "error_m": [ + -0.001059707647064534, + 0.0016012381543593912, + -0.02058822440031774 + ], + "error_norm_m": 0.02067757064749295, + "predicted_m": [ + 0.21145747624162628, + -0.17554900656809053, + 0.03319531332414729 + ], + "observed_m": [ + 0.2125171838886908, + -0.17715024472244992, + 0.05378353772446503 + ] + } + ], + "stage_idx": 2, + "num_active_links": 5 + } + ], + "markers": [ + { + "marker_id": 41, + "link": "FingerA", + "observed_position_m": [ + 0.2604696179258959, + -0.14289826359306226, + 0.3443845376382856 + ], + "predicted_position_m": [ + 0.2286388949568464, + -0.17168328421704407, + 0.32498705212568807 + ], + "error_m": [ + -0.03183072296904951, + -0.028785020623981805, + -0.019397485512597512 + ], + "error_norm_m": 0.04709601661782942 + }, + { + "marker_id": 42, + "link": "FingerA", + "observed_position_m": [ + 0.29142894521099333, + -0.17910742174815197, + 0.3448106425382629 + ], + "predicted_position_m": [ + 0.25726187978417253, + -0.17870851409363908, + 0.36213016568318845 + ], + "error_m": [ + -0.0341670654268208, + 0.00039890765451289223, + 0.017319523144925575 + ], + "error_norm_m": 0.03830813711426196 + }, + { + "marker_id": 43, + "link": "FingerB", + "observed_position_m": [ + 0.24505913693461728, + -0.17536757426841992, + 0.3450428980062189 + ], + "predicted_position_m": [ + 0.2265017165309545, + -0.19804414862632422, + 0.3426991185203111 + ], + "error_m": [ + -0.01855742040366279, + -0.022676574357904294, + -0.0023437794859078043 + ], + "error_norm_m": 0.029395546923410096 + }, + { + "marker_id": 44, + "link": "FingerB", + "observed_position_m": [ + 0.26172112022130845, + -0.173659507226198, + 0.2992789317400768 + ], + "predicted_position_m": [ + 0.26942775235137323, + -0.20469107435792025, + 0.31948115506417085 + ], + "error_m": [ + 0.007706632130064783, + -0.031031567131722254, + 0.02020222332409405 + ], + "error_norm_m": 0.03782168907750289 + }, + { + "marker_id": 46, + "link": "Board", + "observed_position_m": [ + 0.536493873905045, + 0.18529088908596522, + -0.02723229997913794 + ], + "predicted_position_m": [ + 0.5367250657751038, + 0.18545470705337558, + -0.027336931986172867 + ], + "error_m": [ + 0.00023119187005882225, + 0.0001638179674103568, + -0.00010463200703492853 + ], + "error_norm_m": 0.0003020494398669089 + }, + { + "marker_id": 47, + "link": "Board", + "observed_position_m": [ + 0.34440081776354087, + -0.28665042108629346, + -0.02721289168213231 + ], + "predicted_position_m": [ + 0.3442533749030795, + -0.2865286813145559, + -0.02734777589999846 + ], + "error_m": [ + -0.00014744286046136645, + 0.00012173977173757233, + -0.0001348842178661505 + ], + "error_norm_m": 0.0002339951310457321 + }, + { + "marker_id": 51, + "link": "Board", + "observed_position_m": [ + 0.16776826940204223, + -0.17186292856664187, + -0.027519305534479503 + ], + "predicted_position_m": [ + 0.16782136752516283, + -0.1720717918268552, + -0.027286772629229475 + ], + "error_m": [ + 5.309812312059847e-05, + -0.00020886326021332668, + 0.0002325329052500283 + ], + "error_norm_m": 0.00031704072951261117 + }, + { + "marker_id": 53, + "link": "Board", + "observed_position_m": [ + 0.48629542369920875, + 0.2121964752143647, + -0.02723451317967848 + ], + "predicted_position_m": [ + 0.4862645960763571, + 0.2122538174797039, + -0.02732025447617755 + ], + "error_m": [ + -3.082762285167018e-05, + 5.734226533921083e-05, + -8.574129649907211e-05 + ], + "error_norm_m": 0.00010765708360465219 + }, + { + "marker_id": 54, + "link": "Board", + "observed_position_m": [ + 0.3423810472602854, + -0.33059956200289875, + -0.027213011941069766 + ], + "predicted_position_m": [ + 0.34229414984560724, + -0.33057871548186146, + -0.027352975263719628 + ], + "error_m": [ + -8.689741467815537e-05, + 2.084652103728768e-05, + -0.00013996332264986158 + ], + "error_norm_m": 0.00016605863363370973 + }, + { + "marker_id": 55, + "link": "Board", + "observed_position_m": [ + 0.28377579231257, + -0.26265908056621023, + -0.027283499335788094 + ], + "predicted_position_m": [ + 0.2837429555077737, + -0.2625697479925105, + -0.027328837209804554 + ], + "error_m": [ + -3.283680479632123e-05, + 8.93325736997519e-05, + -4.533787401645936e-05 + ], + "error_norm_m": 0.00010542337166580117 + }, + { + "marker_id": 56, + "link": "Board", + "observed_position_m": [ + 0.49863867893658487, + 0.16872591040111304, + -0.02731879550117035 + ], + "predicted_position_m": [ + 0.4986953620805339, + 0.16868403692824455, + -0.027329156559124112 + ], + "error_m": [ + 5.6683143949021186e-05, + -4.187347286849219e-05, + -1.0361057953760244e-05 + ], + "error_norm_m": 7.123003622022796e-05 + }, + { + "marker_id": 58, + "link": "Board", + "observed_position_m": [ + 0.050003198410856056, + -0.21796855305581667, + -0.02728610062167888 + ], + "predicted_position_m": [ + 0.05011218127725505, + -0.21810386604044124, + -0.027261944212492607 + ], + "error_m": [ + 0.00010898286639899474, + -0.00013531298462457486, + 2.4156409186272543e-05 + ], + "error_norm_m": 0.00017541493973241332 + }, + { + "marker_id": 60, + "link": "Board", + "observed_position_m": [ + 0.43435641266087854, + 0.2837798025136165, + -0.027308025948451647 + ], + "predicted_position_m": [ + 0.43437333888625645, + 0.2838229023193166, + -0.02729739728563066 + ], + "error_m": [ + 1.692622537791122e-05, + 4.309980570010863e-05, + 1.0628662820987705e-05 + ], + "error_norm_m": 4.750851324018894e-05 + }, + { + "marker_id": 61, + "link": "Board", + "observed_position_m": [ + -0.0224291106955053, + 0.33622619316368946, + -0.027483833170688213 + ], + "predicted_position_m": [ + -0.0224075604824385, + 0.3358348512468195, + -0.0271711408437482 + ], + "error_m": [ + 2.1550213066802437e-05, + -0.00039134191686995834, + 0.0003126923269400131 + ], + "error_norm_m": 0.0005013874738262195 + }, + { + "marker_id": 62, + "link": "Board", + "observed_position_m": [ + 0.40467564778526965, + -0.17509090416232104, + -0.02740995491313332 + ], + "predicted_position_m": [ + 0.4047214125042162, + -0.1750876165009518, + -0.027349146162272766 + ], + "error_m": [ + 4.5764718946572636e-05, + 3.2876613692278678e-06, + 6.080875086055329e-05 + ], + "error_norm_m": 7.617691513023049e-05 + }, + { + "marker_id": 63, + "link": "Board", + "observed_position_m": [ + 0.7773652350199328, + -0.23622461415673698, + -0.02763843742969368 + ], + "predicted_position_m": [ + 0.7774224736087888, + -0.2361310472389689, + -0.02745457508924221 + ], + "error_m": [ + 5.723858885597899e-05, + 9.356691776807313e-05, + 0.00018386234045146901 + ], + "error_norm_m": 0.0002140943352616623 + }, + { + "marker_id": 64, + "link": "Board", + "observed_position_m": [ + -0.021289765830559533, + -0.188083069951051, + -0.02712427415338315 + ], + "predicted_position_m": [ + -0.021248341882591285, + -0.18822512399747535, + -0.027239399081236515 + ], + "error_m": [ + 4.1423947968247804e-05, + -0.00014205404642433916, + -0.00011512492785336476 + ], + "error_norm_m": 0.0001874807845728379 + }, + { + "marker_id": 66, + "link": "Board", + "observed_position_m": [ + 0.20990072389999853, + -0.3633269340522861, + -0.027341757772533833 + ], + "predicted_position_m": [ + 0.2097747285659698, + -0.3632210508324448, + -0.027322535651109706 + ], + "error_m": [ + -0.00012599533402873897, + 0.00010588321984128513, + 1.9222121424126992e-05 + ], + "error_norm_m": 0.00016569722506130062 + }, + { + "marker_id": 68, + "link": "Board", + "observed_position_m": [ + 0.5737374995183492, + 0.17050042960782963, + -0.027342333364656114 + ], + "predicted_position_m": [ + 0.5737453248462413, + 0.1706553596478406, + -0.027348536991536634 + ], + "error_m": [ + 7.825327892119205e-06, + 0.00015493004001096433, + -6.2036268805194805e-06 + ], + "error_norm_m": 0.00015525153152510572 + }, + { + "marker_id": 69, + "link": "Board", + "observed_position_m": [ + 0.007692517743585046, + -0.28082072580594697, + -0.02755588195181212 + ], + "predicted_position_m": [ + 0.007633292717869882, + -0.28120461419894877, + -0.027259012330330554 + ], + "error_m": [ + -5.922502571516393e-05, + -0.00038388839300179667, + 0.0002968696214815658 + ], + "error_norm_m": 0.0004888859520492196 + }, + { + "marker_id": 72, + "link": "Board", + "observed_position_m": [ + 0.44062335975291167, + 0.19401682351846258, + -0.02691986395124442 + ], + "predicted_position_m": [ + 0.4410049128598024, + 0.1943330199375759, + -0.027310736536235895 + ], + "error_m": [ + 0.00038155310689075295, + 0.0003161964191133182, + -0.00039087258499147584 + ], + "error_norm_m": 0.0006311452499512217 + }, + { + "marker_id": 73, + "link": "Board", + "observed_position_m": [ + 0.22175328849501175, + 0.332598245991324, + -0.026763194580874092 + ], + "predicted_position_m": [ + 0.2217424789700998, + 0.3331191543494928, + -0.027235372345979156 + ], + "error_m": [ + -1.0809524911947754e-05, + 0.0005209083581688145, + -0.00047217776510506335 + ], + "error_norm_m": 0.0007031459345673303 + }, + { + "marker_id": 75, + "link": "Board", + "observed_position_m": [ + -0.025705968635623168, + 0.19453200939131401, + -0.02731620022627215 + ], + "predicted_position_m": [ + -0.02568507566788694, + 0.1945847946471359, + -0.02718859923262906 + ], + "error_m": [ + 2.089296773622948e-05, + 5.2785255821891086e-05, + 0.00012760099364308997 + ], + "error_norm_m": 0.00013965963236280373 + }, + { + "marker_id": 79, + "link": "Board", + "observed_position_m": [ + 0.3124096919708483, + -0.15869604320103042, + -0.027523487240718965 + ], + "predicted_position_m": [ + 0.31232113440411313, + -0.15909924516350613, + -0.027322897361177708 + ], + "error_m": [ + -8.855756673514792e-05, + -0.00040320196247570217, + 0.00020058987954125682 + ], + "error_norm_m": 0.00045896684514753745 + }, + { + "marker_id": 82, + "link": "Board", + "observed_position_m": [ + 0.21923469698309384, + 0.29733491019075753, + -0.02732893030228632 + ], + "predicted_position_m": [ + 0.21917311004078294, + 0.2972491093610568, + -0.027239351371315373 + ], + "error_m": [ + -6.158694231089834e-05, + -8.580082970072178e-05, + 8.957893097094605e-05 + ], + "error_norm_m": 0.00013848869525862282 + }, + { + "marker_id": 83, + "link": "Board", + "observed_position_m": [ + 0.04422663993658066, + 0.33933713487534917, + -0.027353240056650727 + ], + "predicted_position_m": [ + 0.04417237759553884, + 0.3392260246727398, + -0.027188121068680585 + ], + "error_m": [ + -5.426234104181915e-05, + -0.00011111020260934357, + 0.00016511898797014202 + ], + "error_norm_m": 0.00020628659425060074 + }, + { + "marker_id": 84, + "link": "Board", + "observed_position_m": [ + 0.4073602620250038, + 0.25837020980279285, + -0.027255712837248796 + ], + "predicted_position_m": [ + 0.40750378644075314, + 0.25843242896005214, + -0.02729365952910834 + ], + "error_m": [ + 0.00014352441574932984, + 6.221915725929117e-05, + -3.7946691859542386e-05 + ], + "error_norm_m": 0.00016096717947869355 + }, + { + "marker_id": 85, + "link": "Board", + "observed_position_m": [ + 0.5044193503911354, + -0.312542856275203, + -0.027496174609869733 + ], + "predicted_position_m": [ + 0.5046038304449671, + -0.3127358549636571, + -0.027393128242827122 + ], + "error_m": [ + 0.00018448005383175925, + -0.0001929986884540713, + 0.00010304636704261058 + ], + "error_norm_m": 0.0002861816516959829 + }, + { + "marker_id": 86, + "link": "Board", + "observed_position_m": [ + 0.3633162183690467, + 0.29224893372202293, + -0.027400524484833745 + ], + "predicted_position_m": [ + 0.36290319709893226, + 0.2920216426091962, + -0.027277634723037018 + ], + "error_m": [ + -0.00041302127011444423, + -0.00022729111282671077, + 0.00012288976179672742 + ], + "error_norm_m": 0.00048718550172537946 + }, + { + "marker_id": 92, + "link": "Board", + "observed_position_m": [ + 0.6453365713852278, + -0.18509978851039263, + -0.027175066681182154 + ], + "predicted_position_m": [ + 0.645111575573512, + -0.1848233796071786, + -0.027413304224449212 + ], + "error_m": [ + -0.0002249958117158668, + 0.0002764089032140371, + -0.0002382375432670586 + ], + "error_norm_m": 0.0004286981736462057 + }, + { + "marker_id": 95, + "link": "Board", + "observed_position_m": [ + 0.1858987899622817, + -0.2741719606117706, + -0.027290062217411773 + ], + "predicted_position_m": [ + 0.18606316098464215, + -0.27406146947837556, + -0.02730477042528646 + ], + "error_m": [ + 0.00016437102236044332, + 0.00011049113339506311, + -1.4708207874688378e-05 + ], + "error_norm_m": 0.00019860124604248594 + }, + { + "marker_id": 96, + "link": "Board", + "observed_position_m": [ + 0.36971512389810823, + -0.18657651675758513, + -0.02725058699805003 + ], + "predicted_position_m": [ + 0.36979161406450833, + -0.18647823203546626, + -0.027341484161157538 + ], + "error_m": [ + 7.649016640010053e-05, + 9.828472211886874e-05, + -9.089716310750964e-05 + ], + "error_norm_m": 0.00015418471525703036 + }, + { + "marker_id": 97, + "link": "Board", + "observed_position_m": [ + 0.3041708365401228, + -0.35973117993192777, + -0.027144115022725745 + ], + "predicted_position_m": [ + 0.3043746626901148, + -0.35965938356286725, + -0.027346824913079992 + ], + "error_m": [ + 0.00020382614999203685, + 7.179636906051723e-05, + -0.0002027098903542475 + ], + "error_norm_m": 0.00029629565922956305 + }, + { + "marker_id": 102, + "link": "Board", + "observed_position_m": [ + 0.6498482557191254, + -0.2227932033976437, + -0.02780207295274251 + ], + "predicted_position_m": [ + 0.649712246680626, + -0.22298329820664672, + -0.027419456145602768 + ], + "error_m": [ + -0.00013600903849941837, + -0.000190094809003033, + 0.00038261680713974275 + ], + "error_norm_m": 0.000448363821097607 + }, + { + "marker_id": 103, + "link": "Board", + "observed_position_m": [ + 0.10573641687784806, + -0.1878587787480685, + -0.02727223273103396 + ], + "predicted_position_m": [ + 0.1057316446043112, + -0.18770288601290436, + -0.027272554375566267 + ], + "error_m": [ + -4.772273536859939e-06, + 0.0001558927351641426, + -3.216445323070416e-07 + ], + "error_norm_m": 0.0001559660954402375 + }, + { + "marker_id": 105, + "link": "Board", + "observed_position_m": [ + 0.5246513430150249, + -0.2664598439214504, + -0.02708764420087972 + ], + "predicted_position_m": [ + 0.5248630117757593, + -0.2662354982846541, + -0.02739239914154039 + ], + "error_m": [ + 0.0002116687607344181, + 0.00022434563679629704, + -0.00030475494066066824 + ], + "error_norm_m": 0.0004336014332050435 + }, + { + "marker_id": 114, + "link": "Arm2", + "observed_position_m": [ + 0.281913958303829, + -0.14729567745079777, + 0.23438880832138625 + ], + "predicted_position_m": [ + 0.28235664658584575, + -0.16043102785254823, + 0.22019824124126552 + ], + "error_m": [ + 0.0004426882820167677, + -0.013135350401750456, + -0.01419056708012073 + ], + "error_norm_m": 0.019341809562375672 + }, + { + "marker_id": 115, + "link": "Arm2", + "observed_position_m": [ + 0.23533888520701415, + -0.16402876322762236, + 0.2352033933459255 + ], + "predicted_position_m": [ + 0.2596289812677296, + -0.20380890097270207, + 0.21298274730461253 + ], + "error_m": [ + 0.024290096060715444, + -0.03978013774507971, + -0.022220646041312964 + ], + "error_norm_m": 0.0516355036399338 + }, + { + "marker_id": 120, + "link": "Arm2", + "observed_position_m": [ + 0.2820357717587118, + -0.1510503251417516, + 0.1647099206425418 + ], + "predicted_position_m": [ + 0.2823383780020887, + -0.14893570418043747, + 0.15114856926585468 + ], + "error_m": [ + 0.0003026062433769128, + 0.002114620961314123, + -0.013561351376687125 + ], + "error_norm_m": 0.013728563053376473 + }, + { + "marker_id": 198, + "link": "Arm1", + "observed_position_m": [ + 0.15996742027907745, + -0.05309238478466741, + 0.09041937348544336 + ], + "predicted_position_m": [ + 0.15896805046728424, + -0.054470606469258095, + 0.08177400289634576 + ], + "error_m": [ + -0.000999369811793216, + -0.0013782216845906886, + -0.008645370589097603 + ], + "error_norm_m": 0.008811394194759048 + }, + { + "marker_id": 205, + "link": "Board", + "observed_position_m": [ + 0.75007719162279, + -0.08998722680918331, + 0.0003830332001980036 + ], + "predicted_position_m": [ + 0.7500271249111544, + -0.08998511030436256, + 0.0001715445666394677 + ], + "error_m": [ + -5.006671163554355e-05, + 2.1165048207510972e-06, + -0.0002114886335585359 + ], + "error_norm_m": 0.00021734442097994972 + }, + { + "marker_id": 206, + "link": "Board", + "observed_position_m": [ + 0.6501281689389445, + -0.009509083978138672, + 3.4252639007176556e-05 + ], + "predicted_position_m": [ + 0.6500257210846707, + -0.009986873462998147, + 0.0002080822938108538 + ], + "error_m": [ + -0.00010244785427382386, + -0.0004777894848594748, + 0.00017382965480367723 + ], + "error_norm_m": 0.0005186473788391864 + }, + { + "marker_id": 207, + "link": "Board", + "observed_position_m": [ + 0.7506838256690808, + -0.0095512495176165, + -0.00034721437808174607 + ], + "predicted_position_m": [ + 0.750025717646431, + -0.009985110989361739, + 0.0001819185473904473 + ], + "error_m": [ + -0.0006581080226497615, + -0.000433861471745239, + 0.0005291329254721933 + ], + "error_norm_m": 0.0009493806396591862 + }, + { + "marker_id": 208, + "link": "Board", + "observed_position_m": [ + 0.34999043841265975, + -0.09002135964783119, + 0.0003278248203912779 + ], + "predicted_position_m": [ + 0.3500271386641134, + -0.08999216019890818, + 0.0002761995523210937 + ], + "error_m": [ + 3.670025145363631e-05, + 2.9199448923003524e-05, + -5.1625268070184236e-05 + ], + "error_norm_m": 6.974729082541923e-05 + }, + { + "marker_id": 210, + "link": "Board", + "observed_position_m": [ + 0.020067901968129985, + -0.020304661684676543, + 0.0004639778989853115 + ], + "predicted_position_m": [ + 0.020025918653671454, + -0.019997976961282627, + 0.0003716171486655422 + ], + "error_m": [ + -4.198331445853104e-05, + 0.0003066847233939157, + -9.23607503197693e-05 + ], + "error_norm_m": 0.000323030380081746 + }, + { + "marker_id": 211, + "link": "Board", + "observed_position_m": [ + 0.24991766071976868, + -0.010269215052869955, + 0.0002520925732523137 + ], + "predicted_position_m": [ + 0.25002573483762963, + -0.009993923357543783, + 0.0003127372794924798 + ], + "error_m": [ + 0.00010807411786095678, + 0.00027529169532617206, + 6.0644706240166064e-05 + ], + "error_norm_m": 0.0003018995078862136 + }, + { + "marker_id": 214, + "link": "Board", + "observed_position_m": [ + 0.34995342131619295, + -0.01027212318191002, + 0.0005559246883674878 + ], + "predicted_position_m": [ + 0.35002573139938997, + -0.009992160883907374, + 0.00028657353307207323 + ], + "error_m": [ + 7.23100831970247e-05, + 0.00027996229800264505, + -0.0002693511552954145 + ], + "error_norm_m": 0.00039516791531430913 + }, + { + "marker_id": 215, + "link": "Board", + "observed_position_m": [ + 0.24982667080732784, + -0.09008222270625758, + 0.0004388793945228507 + ], + "predicted_position_m": [ + 0.25002714210235305, + -0.0899939226725446, + 0.00030236329874150017 + ], + "error_m": [ + 0.00020047129502520633, + 8.830003371299022e-05, + -0.0001365160957813505 + ], + "error_norm_m": 0.0002581129219744362 + }, + { + "marker_id": 217, + "link": "Board", + "observed_position_m": [ + 0.6501423300318514, + -0.08968762527547017, + 0.00013731380056389728 + ], + "predicted_position_m": [ + 0.6500271283493941, + -0.08998687277799897, + 0.0001977083130598742 + ], + "error_m": [ + -0.00011520168245726659, + -0.00029924750252879884, + 6.039451249597691e-05 + ], + "error_norm_m": 0.0003262943342295956 + }, + { + "marker_id": 219, + "link": "Arm2", + "observed_position_m": [ + 0.28373842821530076, + -0.11864875843805314, + 0.26999583241494307 + ], + "predicted_position_m": [ + 0.2650855912204819, + -0.14631622623436363, + 0.2600618590128257 + ], + "error_m": [ + -0.018652836994818844, + -0.02766746779631049, + -0.00993397340211738 + ], + "error_norm_m": 0.03481523990681575 + }, + { + "marker_id": 229, + "link": "Arm1", + "observed_position_m": [ + 0.15997322006826376, + -0.14314860848153363, + 0.08730306053283819 + ], + "predicted_position_m": [ + 0.15896754935495447, + -0.14411841633551006, + 0.0738197470585503 + ], + "error_m": [ + -0.0010056707133092868, + -0.0009698078539764343, + -0.013483313474287897 + ], + "error_norm_m": 0.013555502318363416 + }, + { + "marker_id": 232, + "link": "Ellbow", + "observed_position_m": [ + 0.2500172750219489, + -0.1685018910572591, + 0.028533350878303273 + ], + "predicted_position_m": [ + 0.24895127790163096, + -0.1613730824505952, + 0.010454754569169694 + ], + "error_m": [ + -0.001065997120317963, + 0.0071288086066639, + -0.01807859630913358 + ], + "error_norm_m": 0.019462577078064192 + }, + { + "marker_id": 243, + "link": "Arm1", + "observed_position_m": [ + 0.15977091466136845, + -0.17728534784518496, + 0.05086946501139717 + ], + "predicted_position_m": [ + 0.158958178482318, + -0.17588813184638963, + 0.035863389375752425 + ], + "error_m": [ + -0.0008127361790504495, + 0.0013972159987953314, + -0.015006075635644746 + ], + "error_norm_m": 0.015092881057860292 + }, + { + "marker_id": 244, + "link": "Ellbow", + "observed_position_m": [ + 0.28593192370492515, + -0.14254624001040914, + 0.052179602076133966 + ], + "predicted_position_m": [ + 0.28395836906130356, + -0.141022891584135, + 0.038924006407425216 + ], + "error_m": [ + -0.001973554643621589, + 0.0015233484262741348, + -0.01325559566870875 + ], + "error_norm_m": 0.01348800670564344 + }, + { + "marker_id": 245, + "link": "Ellbow", + "observed_position_m": [ + 0.25023797739558296, + -0.17715503440515307, + 0.05362377268934036 + ], + "predicted_position_m": [ + 0.24895747495221682, + -0.17554834564047686, + 0.033185501919239656 + ], + "error_m": [ + -0.0012805024433661383, + 0.0016066887646762062, + -0.020438270770100707 + ], + "error_norm_m": 0.020541276673224484 + }, + { + "marker_id": 248, + "link": "Ellbow", + "observed_position_m": [ + 0.2125171838886908, + -0.17715024472244992, + 0.05378353772446503 + ], + "predicted_position_m": [ + 0.21145747624162628, + -0.17554900656809053, + 0.03319531332414729 + ], + "error_m": [ + -0.001059707647064534, + 0.0016012381543593912, + -0.02058822440031774 + ], + "error_norm_m": 0.02067757064749295 + } + ] +} \ No newline at end of file diff --git a/data/evaluations/Scene8/v8/aruco_positions_initial.json b/data/evaluations/Scene8/v8/aruco_positions_initial.json new file mode 100644 index 0000000..4a9677b --- /dev/null +++ b/data/evaluations/Scene8/v8/aruco_positions_initial.json @@ -0,0 +1,1076 @@ +{ + "schema_version": "1.2", + "stage": "initial_triangulation", + "created_utc": "2026-06-01T18:37:02Z", + "summary": { + "num_cameras": 7, + "num_markers": 56, + "num_constraints": 163 + }, + "markers": [ + { + "marker_id": 41, + "position_m": [ + 0.2604696331379058, + -0.1428982567036554, + 0.3555364903751272 + ], + "position_mm": [ + 260.46963313790576, + -142.89825670365542, + 355.5364903751272 + ], + "link": "FingerA", + "normal": [ + 0.0, + -0.9375276894468237, + 0.34791066600565723 + ] + }, + { + "marker_id": 42, + "position_m": [ + 0.2914289580570548, + -0.17910741480182577, + 0.3559626008137063 + ], + "position_mm": [ + 291.42895805705484, + -179.10741480182577, + 355.9626008137063 + ], + "link": "FingerA", + "normal": [ + 0.8830215713766957, + -0.3090575499818435, + 0.3532086285506783 + ] + }, + { + "marker_id": 43, + "position_m": [ + 0.24505913568293175, + -0.17536755144915103, + 0.35619491413343585 + ], + "position_mm": [ + 245.05913568293175, + -175.36755144915102, + 356.1949141334359 + ], + "link": "FingerB", + "normal": [ + 0.4224220616915755, + 0.0, + 0.9063992507699015 + ] + }, + { + "marker_id": 44, + "position_m": [ + 0.26172112587805485, + -0.17365947720894198, + 0.31043086363797684 + ], + "position_mm": [ + 261.72112587805486, + -173.65947720894198, + 310.4308636379768 + ], + "link": "FingerB", + "normal": [ + 0.0, + -0.9375276894468237, + -0.34791066600565723 + ] + }, + { + "marker_id": 46, + "position_m": [ + 0.53671, + 0.18544, + -0.0273 + ], + "position_mm": [ + 536.71, + 185.44, + -27.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 47, + "position_m": [ + 0.34423000000000004, + -0.28654, + -0.0273 + ], + "position_mm": [ + 344.23, + -286.54, + -27.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 51, + "position_m": [ + 0.1678, + -0.17208, + -0.0273 + ], + "position_mm": [ + 167.8, + -172.08, + -27.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 53, + "position_m": [ + 0.48625, + 0.21224, + -0.0273 + ], + "position_mm": [ + 486.25, + 212.24, + -27.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 54, + "position_m": [ + 0.34226999999999996, + -0.33059, + -0.0273 + ], + "position_mm": [ + 342.27, + -330.59, + -27.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 55, + "position_m": [ + 0.28372, + -0.26258, + -0.0273 + ], + "position_mm": [ + 283.72, + -262.58, + -27.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 56, + "position_m": [ + 0.49868, + 0.16867, + -0.0273 + ], + "position_mm": [ + 498.68, + 168.67, + -27.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 58, + "position_m": [ + 0.05009, + -0.21811000000000003, + -0.0273 + ], + "position_mm": [ + 50.09, + -218.11, + -27.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 60, + "position_m": [ + 0.43436, + 0.28381, + -0.0273 + ], + "position_mm": [ + 434.36, + 283.81, + -27.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 61, + "position_m": [ + -0.022420000000000002, + 0.33583, + -0.0273 + ], + "position_mm": [ + -22.42, + 335.83000000000004, + -27.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 62, + "position_m": [ + 0.4047, + -0.1751, + -0.0273 + ], + "position_mm": [ + 404.7, + -175.1, + -27.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 63, + "position_m": [ + 0.7774, + -0.23615, + -0.0273 + ], + "position_mm": [ + 777.4, + -236.15, + -27.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 64, + "position_m": [ + -0.02127, + -0.18822999999999998, + -0.0273 + ], + "position_mm": [ + -21.27, + -188.23, + -27.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 66, + "position_m": [ + 0.20975, + -0.36323000000000005, + -0.0273 + ], + "position_mm": [ + 209.75, + -363.2300000000001, + -27.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 68, + "position_m": [ + 0.5737300000000001, + 0.17064, + -0.0273 + ], + "position_mm": [ + 573.73, + 170.64, + -27.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 69, + "position_m": [ + 0.0076100000000000004, + -0.28120999999999996, + -0.0273 + ], + "position_mm": [ + 7.61, + -281.21, + -27.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 72, + "position_m": [ + 0.44099, + 0.19432, + -0.0273 + ], + "position_mm": [ + 440.99, + 194.32, + -27.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 73, + "position_m": [ + 0.22172999999999998, + 0.33311, + -0.0273 + ], + "position_mm": [ + 221.73, + 333.11, + -27.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 75, + "position_m": [ + -0.0257, + 0.19458, + -0.0273 + ], + "position_mm": [ + -25.7, + 194.58, + -27.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 79, + "position_m": [ + 0.3123, + -0.15911000000000003, + -0.0273 + ], + "position_mm": [ + 312.3, + -159.11000000000004, + -27.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 82, + "position_m": [ + 0.21916, + 0.29724, + -0.0273 + ], + "position_mm": [ + 219.16, + 297.24, + -27.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 83, + "position_m": [ + 0.04416, + 0.33922, + -0.0273 + ], + "position_mm": [ + 44.16, + 339.22, + -27.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 84, + "position_m": [ + 0.40749, + 0.25842000000000004, + -0.0273 + ], + "position_mm": [ + 407.49, + 258.42, + -27.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 85, + "position_m": [ + 0.50458, + -0.31275000000000003, + -0.0273 + ], + "position_mm": [ + 504.58000000000004, + -312.75, + -27.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 86, + "position_m": [ + 0.36289, + 0.29201, + -0.0273 + ], + "position_mm": [ + 362.89, + 292.01, + -27.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 92, + "position_m": [ + 0.64509, + -0.18484, + -0.0273 + ], + "position_mm": [ + 645.09, + -184.84, + -27.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 95, + "position_m": [ + 0.18603999999999998, + -0.27407, + -0.0273 + ], + "position_mm": [ + 186.04, + -274.07, + -27.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 96, + "position_m": [ + 0.36977, + -0.18649000000000002, + -0.0273 + ], + "position_mm": [ + 369.77, + -186.49, + -27.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 97, + "position_m": [ + 0.30435, + -0.35967000000000005, + -0.0273 + ], + "position_mm": [ + 304.35, + -359.6700000000001, + -27.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 102, + "position_m": [ + 0.6496900000000001, + -0.223, + -0.0273 + ], + "position_mm": [ + 649.69, + -223.0, + -27.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 103, + "position_m": [ + 0.10571, + -0.18771000000000002, + -0.0273 + ], + "position_mm": [ + 105.71, + -187.71, + -27.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 105, + "position_m": [ + 0.5248400000000001, + -0.26625, + -0.0273 + ], + "position_mm": [ + 524.84, + -266.25, + -27.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 114, + "position_m": [ + 0.281913965275182, + -0.14729565101373798, + 0.24554075101272985 + ], + "position_mm": [ + 281.91396527518197, + -147.295651013738, + 245.54075101272986 + ], + "link": "Arm2", + "normal": [ + 0.7071067811865475, + 0.0, + -0.7071067811865475 + ] + }, + { + "marker_id": 115, + "position_m": [ + 0.2353388634888448, + -0.16402873626316594, + 0.24635534008118515 + ], + "position_mm": [ + 235.3388634888448, + -164.02873626316594, + 246.35534008118515 + ], + "link": "Arm2", + "normal": [ + -0.7071067811865475, + 0.0, + -0.7071067811865475 + ] + }, + { + "marker_id": 120, + "position_m": [ + 0.2820357775859653, + -0.15105029562021835, + 0.17586186244180554 + ], + "position_mm": [ + 282.0357775859653, + -151.05029562021835, + 175.86186244180556 + ], + "link": "Arm2", + "normal": [ + 0.7071067811865475, + 0.0, + -0.7071067811865475 + ] + }, + { + "marker_id": 198, + "position_m": [ + 0.1599674351354196, + -0.05309237740484513, + 0.1015712890479761 + ], + "position_mm": [ + 159.9674351354196, + -53.09237740484513, + 101.57128904797611 + ], + "link": "Arm1", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 205, + "position_m": [ + 0.75, + -0.09, + 0.0003 + ], + "position_mm": [ + 750.0, + -90.0, + 0.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 206, + "position_m": [ + 0.65, + -0.01, + 0.0003 + ], + "position_mm": [ + 650.0, + -10.0, + 0.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 207, + "position_m": [ + 0.75, + -0.01, + 0.0003 + ], + "position_mm": [ + 750.0, + -10.0, + 0.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 208, + "position_m": [ + 0.35000000000000003, + -0.09, + 0.0003 + ], + "position_mm": [ + 350.00000000000006, + -90.0, + 0.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 210, + "position_m": [ + 0.02, + -0.02, + 0.0003 + ], + "position_mm": [ + 20.0, + -20.0, + 0.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 211, + "position_m": [ + 0.25, + -0.01, + 0.0003 + ], + "position_mm": [ + 250.0, + -10.0, + 0.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 214, + "position_m": [ + 0.35000000000000003, + -0.01, + 0.0003 + ], + "position_mm": [ + 350.00000000000006, + -10.0, + 0.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 215, + "position_m": [ + 0.25, + -0.09, + 0.0003 + ], + "position_mm": [ + 250.0, + -90.0, + 0.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 217, + "position_m": [ + 0.65, + -0.09, + 0.0003 + ], + "position_mm": [ + 650.0, + -90.0, + 0.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 219, + "position_m": [ + 0.28373835531922553, + -0.11864865758751712, + 0.28114776105708067 + ], + "position_mm": [ + 283.73835531922555, + -118.64865758751712, + 281.1477610570807 + ], + "link": "Arm2", + "normal": [ + 1.0, + 0.0, + 0.0 + ] + }, + { + "marker_id": 229, + "position_m": [ + 0.15997323512329575, + -0.14314860711654143, + 0.09845497714818809 + ], + "position_mm": [ + 159.97323512329575, + -143.14860711654143, + 98.45497714818809 + ], + "link": "Arm1", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 232, + "position_m": [ + 0.2500172832543262, + -0.16850192293113503, + 0.039685297428964 + ], + "position_mm": [ + 250.0172832543262, + -168.50192293113503, + 39.685297428964 + ], + "link": "Ellbow", + "normal": [ + 0.0, + 0.7071067811865475, + -0.7071067811865475 + ] + }, + { + "marker_id": 243, + "position_m": [ + 0.15977091024108556, + -0.1772853044569966, + 0.06202140604697119 + ], + "position_mm": [ + 159.77091024108555, + -177.2853044569966, + 62.021406046971194 + ], + "link": "Arm1", + "normal": [ + 0.0, + -1.0, + 0.0 + ] + }, + { + "marker_id": 244, + "position_m": [ + 0.28593185843561325, + -0.14254615078240807, + 0.06333150733339929 + ], + "position_mm": [ + 285.93185843561326, + -142.54615078240806, + 63.33150733339929 + ], + "link": "Ellbow", + "normal": [ + 1.0, + 0.0, + 0.0 + ] + }, + { + "marker_id": 245, + "position_m": [ + 0.2502379729789465, + -0.1771549883529487, + 0.06477571174964866 + ], + "position_mm": [ + 250.23797297894652, + -177.15498835294872, + 64.77571174964866 + ], + "link": "Ellbow", + "normal": [ + 0.0, + 0.0, + -1.0 + ] + }, + { + "marker_id": 248, + "position_m": [ + 0.21251717931014621, + -0.17715020011452606, + 0.06493547846457974 + ], + "position_mm": [ + 212.51717931014622, + -177.15020011452606, + 64.93547846457975 + ], + "link": "Ellbow", + "normal": [ + 0.0, + 0.0, + -1.0 + ] + } + ] +} \ No newline at end of file diff --git a/data/evaluations/Scene8/v8/aruco_positions_optimized.json b/data/evaluations/Scene8/v8/aruco_positions_optimized.json new file mode 100644 index 0000000..fbe0613 --- /dev/null +++ b/data/evaluations/Scene8/v8/aruco_positions_optimized.json @@ -0,0 +1,1075 @@ +{ + "schema_version": "1.2", + "created_utc": "2026-06-01T18:37:13Z", + "summary": { + "num_cameras": 7, + "num_markers": 56, + "num_constraints": 163 + }, + "markers": [ + { + "marker_id": 41, + "position_m": [ + 0.26049994994694153, + -0.14324310886235672, + 0.35571921201351653 + ], + "position_mm": [ + 260.4999499469415, + -143.24310886235673, + 355.71921201351654 + ], + "link": "FingerA", + "normal": [ + 0.0, + -0.9375276894468237, + 0.34791066600565723 + ] + }, + { + "marker_id": 42, + "position_m": [ + 0.2914570734278023, + -0.1791573770727779, + 0.3559675345931372 + ], + "position_mm": [ + 291.4570734278023, + -179.1573770727779, + 355.9675345931372 + ], + "link": "FingerA", + "normal": [ + 0.8830215713766957, + -0.3090575499818435, + 0.3532086285506783 + ] + }, + { + "marker_id": 43, + "position_m": [ + 0.24503062780924573, + -0.175407589501069, + 0.35619521772355545 + ], + "position_mm": [ + 245.03062780924571, + -175.407589501069, + 356.19521772355546 + ], + "link": "FingerB", + "normal": [ + 0.4224220616915755, + 0.0, + 0.9063992507699015 + ] + }, + { + "marker_id": 44, + "position_m": [ + 0.2617374343976593, + -0.17309017509552857, + 0.3103807151154557 + ], + "position_mm": [ + 261.7374343976593, + -173.09017509552856, + 310.3807151154557 + ], + "link": "FingerB", + "normal": [ + 0.0, + -0.9375276894468237, + -0.34791066600565723 + ] + }, + { + "marker_id": 46, + "position_m": [ + 0.5367100000077968, + 0.1854400000109313, + -0.027299999989832686 + ], + "position_mm": [ + 536.7100000077968, + 185.4400000109313, + -27.299999989832685 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 47, + "position_m": [ + 0.3442300000011493, + -0.28653999998574475, + -0.027299999963683094 + ], + "position_mm": [ + 344.2300000011493, + -286.53999998574477, + -27.299999963683092 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 51, + "position_m": [ + 0.16779999999426295, + -0.1720799999888764, + -0.027299999978748827 + ], + "position_mm": [ + 167.79999999426295, + -172.0799999888764, + -27.299999978748826 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 53, + "position_m": [ + 0.48625000000889707, + 0.2122400000204753, + -0.027299999967823094 + ], + "position_mm": [ + 486.2500000088971, + 212.2400000204753, + -27.299999967823094 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 54, + "position_m": [ + 0.34227000000223023, + -0.3305900000040731, + -0.027299999996952862 + ], + "position_mm": [ + 342.27000000223023, + -330.59000000407315, + -27.299999996952863 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 55, + "position_m": [ + 0.2837199999946981, + -0.26257999999854587, + -0.027299999976443227 + ], + "position_mm": [ + 283.7199999946981, + -262.5799999985459, + -27.299999976443228 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 56, + "position_m": [ + 0.49868000000598145, + 0.16867000000524218, + -0.027299999995499077 + ], + "position_mm": [ + 498.68000000598147, + 168.67000000524217, + -27.29999999549908 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 58, + "position_m": [ + 0.05008999998499602, + -0.2181099999837509, + -0.027299999960969684 + ], + "position_mm": [ + 50.08999998499602, + -218.10999998375092, + -27.299999960969686 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 60, + "position_m": [ + 0.4343599999979886, + 0.28381000000970086, + -0.027299999979012283 + ], + "position_mm": [ + 434.35999999798855, + 283.81000000970084, + -27.299999979012284 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 61, + "position_m": [ + -0.022419999999864822, + 0.3358300000140044, + -0.027299999982052677 + ], + "position_mm": [ + -22.41999999986482, + 335.83000001400444, + -27.29999998205268 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 62, + "position_m": [ + 0.40470000000127465, + -0.17509999997748896, + -0.027299999961274517 + ], + "position_mm": [ + 404.70000000127465, + -175.09999997748895, + -27.299999961274516 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 63, + "position_m": [ + 0.7774000000097505, + -0.2361499999958269, + -0.027299999990713718 + ], + "position_mm": [ + 777.4000000097506, + -236.1499999958269, + -27.29999999071372 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 64, + "position_m": [ + -0.021270000019686323, + -0.18822999998364243, + -0.02729999994746291 + ], + "position_mm": [ + -21.27000001968632, + -188.22999998364241, + -27.299999947462908 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 66, + "position_m": [ + 0.20974999999316585, + -0.3632300000004067, + -0.02729999997598414 + ], + "position_mm": [ + 209.74999999316586, + -363.23000000040673, + -27.29999997598414 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 68, + "position_m": [ + 0.5737300000077055, + 0.17064000000583948, + -0.027299999991248318 + ], + "position_mm": [ + 573.7300000077055, + 170.64000000583948, + -27.299999991248317 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 69, + "position_m": [ + 0.007609999993045591, + -0.2812100000002623, + -0.02729999998125731 + ], + "position_mm": [ + 7.609999993045591, + -281.2100000002623, + -27.29999998125731 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 72, + "position_m": [ + 0.4409899999978852, + 0.19432000002561808, + -0.02729999994704442 + ], + "position_mm": [ + 440.9899999978852, + 194.32000002561807, + -27.29999994704442 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 73, + "position_m": [ + 0.2217299999972606, + 0.3331100000111645, + -0.027299999991464166 + ], + "position_mm": [ + 221.7299999972606, + 333.11000001116446, + -27.299999991464166 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 75, + "position_m": [ + -0.025699999999079754, + 0.1945800000155921, + -0.027299999981853076 + ], + "position_mm": [ + -25.699999999079754, + 194.58000001559208, + -27.299999981853077 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 79, + "position_m": [ + 0.3123000000020295, + -0.1591099999749345, + -0.027299999960932117 + ], + "position_mm": [ + 312.3000000020295, + -159.1099999749345, + -27.299999960932116 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 82, + "position_m": [ + 0.21915999999751554, + 0.2972400000114772, + -0.027299999991588088 + ], + "position_mm": [ + 219.15999999751554, + 297.2400000114772, + -27.299999991588088 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 83, + "position_m": [ + 0.044159999997531015, + 0.33922000001872427, + -0.027299999979277755 + ], + "position_mm": [ + 44.15999999753102, + 339.22000001872425, + -27.299999979277754 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 84, + "position_m": [ + 0.4074900000023701, + 0.25842000002458154, + -0.027299999946568548 + ], + "position_mm": [ + 407.4900000023701, + 258.42000002458155, + -27.299999946568548 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 85, + "position_m": [ + 0.5045800000037424, + -0.31274999998733155, + -0.027299999955291598 + ], + "position_mm": [ + 504.5800000037424, + -312.74999998733153, + -27.299999955291597 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 86, + "position_m": [ + 0.3628900000001209, + 0.2920100000230956, + -0.027299999948381934 + ], + "position_mm": [ + 362.8900000001209, + 292.0100000230956, + -27.299999948381934 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 92, + "position_m": [ + 0.645090000006357, + -0.1848399999801669, + -0.02729999994923816 + ], + "position_mm": [ + 645.090000006357, + -184.8399999801669, + -27.29999994923816 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 95, + "position_m": [ + 0.1860399999938431, + -0.2740700000001042, + -0.027299999978252887 + ], + "position_mm": [ + 186.0399999938431, + -274.0700000001042, + -27.299999978252888 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 96, + "position_m": [ + 0.36977000000137356, + -0.18648999997712773, + -0.0272999999606587 + ], + "position_mm": [ + 369.77000000137355, + -186.48999997712772, + -27.2999999606587 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 97, + "position_m": [ + 0.3043499999926279, + -0.35966999999972743, + -0.02729999997312092 + ], + "position_mm": [ + 304.3499999926279, + -359.66999999972745, + -27.29999997312092 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 102, + "position_m": [ + 0.6496900000162692, + -0.2229999999903977, + -0.02729999997953186 + ], + "position_mm": [ + 649.6900000162692, + -222.99999999039773, + -27.29999997953186 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 103, + "position_m": [ + 0.10570999998245968, + -0.18770999997948598, + -0.027299999944835573 + ], + "position_mm": [ + 105.70999998245968, + -187.70999997948599, + -27.299999944835573 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 105, + "position_m": [ + 0.5248400000026658, + -0.26624999998881177, + -0.027299999954586658 + ], + "position_mm": [ + 524.8400000026659, + -266.2499999888118, + -27.299999954586657 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 114, + "position_m": [ + 0.2901128864444567, + -0.17587018228071055, + 0.24710906047951745 + ], + "position_mm": [ + 290.1128864444567, + -175.87018228071057, + 247.10906047951744 + ], + "link": "Arm2", + "normal": [ + 0.7071067811865475, + 0.0, + -0.7071067811865475 + ] + }, + { + "marker_id": 115, + "position_m": [ + 0.2410958473346028, + -0.16897449865488434, + 0.24752469427328197 + ], + "position_mm": [ + 241.09584733460278, + -168.97449865488434, + 247.52469427328197 + ], + "link": "Arm2", + "normal": [ + -0.7071067811865475, + 0.0, + -0.7071067811865475 + ] + }, + { + "marker_id": 120, + "position_m": [ + 0.3101174437771042, + -0.22947158053268651, + 0.20677185166496367 + ], + "position_mm": [ + 310.1174437771042, + -229.47158053268652, + 206.77185166496366 + ], + "link": "Arm2", + "normal": [ + 0.7071067811865475, + 0.0, + -0.7071067811865475 + ] + }, + { + "marker_id": 198, + "position_m": [ + 0.1521530638858233, + -0.05352303701389467, + 0.10225869934804113 + ], + "position_mm": [ + 152.15306388582331, + -53.52303701389467, + 102.25869934804113 + ], + "link": "Arm1", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 205, + "position_m": [ + 0.7500000000100834, + -0.0899999999947394, + 0.00030000001038413515 + ], + "position_mm": [ + 750.0000000100833, + -89.9999999947394, + 0.30000001038413515 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 206, + "position_m": [ + 0.6500000000033211, + -0.009999999979634524, + 0.00030000004279697904 + ], + "position_mm": [ + 650.0000000033211, + -9.999999979634524, + 0.30000004279697906 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 207, + "position_m": [ + 0.7500000000096227, + -0.009999999989938299, + 0.0003000000170064098 + ], + "position_mm": [ + 750.0000000096228, + -9.9999999899383, + 0.3000000170064098 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 208, + "position_m": [ + 0.3499999999938247, + -0.08999999995814495, + 0.00030000008000605476 + ], + "position_mm": [ + 349.9999999938247, + -89.99999995814495, + 0.30000008000605477 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 210, + "position_m": [ + 0.019999999995218138, + -0.01999999996631041, + 0.0003000000504195409 + ], + "position_mm": [ + 19.99999999521814, + -19.999999966310412, + 0.3000000504195409 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 211, + "position_m": [ + 0.24999999998851813, + -0.009999999985897085, + 0.0003000000454248722 + ], + "position_mm": [ + 249.99999998851814, + -9.999999985897086, + 0.30000004542487224 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 214, + "position_m": [ + 0.34999999998804016, + -0.009999999961277501, + 0.00030000008638886506 + ], + "position_mm": [ + 349.99999998804014, + -9.999999961277501, + 0.30000008638886505 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 215, + "position_m": [ + 0.24999999999927783, + -0.08999999999936918, + 0.0003000000197643875 + ], + "position_mm": [ + 249.99999999927783, + -89.99999999936918, + 0.30000001976438745 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 217, + "position_m": [ + 0.650000000008564, + -0.08999999997965384, + 0.00030000004920660524 + ], + "position_mm": [ + 650.0000000085639, + -89.99999997965384, + 0.3000000492066052 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 219, + "position_m": [ + 0.30359098664820383, + -0.15023055724050538, + 0.2824306011180299 + ], + "position_mm": [ + 303.59098664820385, + -150.2305572405054, + 282.4306011180299 + ], + "link": "Arm2", + "normal": [ + 1.0, + 0.0, + 0.0 + ] + }, + { + "marker_id": 229, + "position_m": [ + 0.16001671264344228, + -0.14308126101249394, + 0.09807671666083417 + ], + "position_mm": [ + 160.01671264344228, + -143.08126101249394, + 98.07671666083418 + ], + "link": "Arm1", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 232, + "position_m": [ + 0.2302931496524019, + -0.09276299953359425, + 0.025104790285516664 + ], + "position_mm": [ + 230.29314965240192, + -92.76299953359425, + 25.104790285516664 + ], + "link": "Ellbow", + "normal": [ + 0.0, + 0.7071067811865475, + -0.7071067811865475 + ] + }, + { + "marker_id": 243, + "position_m": [ + 0.1600256909055359, + -0.17674403797569505, + 0.061788683667017646 + ], + "position_mm": [ + 160.0256909055359, + -176.74403797569505, + 61.788683667017644 + ], + "link": "Arm1", + "normal": [ + 0.0, + -1.0, + 0.0 + ] + }, + { + "marker_id": 244, + "position_m": [ + 0.27714634853068326, + -0.1174745149273092, + 0.05127329168637121 + ], + "position_mm": [ + 277.14634853068327, + -117.4745149273092, + 51.27329168637121 + ], + "link": "Ellbow", + "normal": [ + 1.0, + 0.0, + 0.0 + ] + }, + { + "marker_id": 245, + "position_m": [ + 0.23079172204816714, + -0.11805719285839464, + 0.03392556703431675 + ], + "position_mm": [ + 230.79172204816714, + -118.05719285839464, + 33.92556703431675 + ], + "link": "Ellbow", + "normal": [ + 0.0, + 0.0, + -1.0 + ] + }, + { + "marker_id": 248, + "position_m": [ + 0.20911576790502873, + -0.14567682011083427, + 0.04710607056346628 + ], + "position_mm": [ + 209.11576790502872, + -145.67682011083429, + 47.10607056346628 + ], + "link": "Ellbow", + "normal": [ + 0.0, + 0.0, + -1.0 + ] + } + ] +} \ No newline at end of file diff --git a/data/evaluations/Scene8/v8/robot_state_v8.json b/data/evaluations/Scene8/v8/robot_state_v8.json new file mode 100644 index 0000000..a8fa033 --- /dev/null +++ b/data/evaluations/Scene8/v8/robot_state_v8.json @@ -0,0 +1,5426 @@ +{ + "schema_version": "1.0", + "method": "deterministic_geometric_sequential_prefix", + "created_utc": "2026-06-01T18:37:14Z", + "root_pose": { + "translation_m": [ + -2.952638133990604e-13, + 1.5981820034038918e-11, + 3.3847754460358814e-11 + ], + "rotation_matrix": [ + [ + 0.9999999999999998, + 4.1597461974314254e-12, + 6.289665562104465e-12 + ], + [ + -4.159994960811153e-12, + 0.9999999999999999, + 1.2302126032636808e-11 + ], + [ + -6.289661479704083e-12, + -1.2302144258370985e-11, + 1.0000000000000002 + ] + ], + "euler_xyz_deg": [ + -7.048609449657554e-10, + 3.6037105735305237e-10, + -2.383501540501694e-10 + ] + }, + "movements": { + "x": { + "value_m": 0.06486190254557143, + "value_mm": 64.86190254557144, + "joint_type": "linear", + "link": "Base" + }, + "y": { + "value_rad": -0.03441461692845893, + "value_deg": -1.9718123035601733, + "joint_type": "revolute", + "link": "Arm1" + }, + "z": { + "value_rad": 1.6373501899522545, + "value_deg": 93.81325546920783, + "joint_type": "revolute", + "link": "Ellbow" + }, + "a": { + "value_rad": -0.233503919420174, + "value_deg": -13.378789082538832, + "joint_type": "revolute", + "link": "Arm2" + }, + "b": { + "value_rad": 0.0, + "value_deg": 0.0, + "joint_type": "revolute", + "link": "Hand" + }, + "c": { + "value_rad": 0.0, + "value_deg": 0.0, + "joint_type": "revolute", + "link": "Palm" + }, + "e": { + "value_m": 0.0, + "value_mm": 0.0, + "joint_type": "linear", + "link": "FingerB" + } + }, + "link_poses": { + "Board": { + "translation_m": [ + -2.952638133990604e-13, + 1.5981820034038918e-11, + 3.3847754460358814e-11 + ], + "rotation_matrix": [ + [ + 0.9999999999999998, + 4.1597461974314254e-12, + 6.289665562104465e-12 + ], + [ + -4.159994960811153e-12, + 0.9999999999999999, + 1.2302126032636808e-11 + ], + [ + -6.289661479704083e-12, + -1.2302144258370985e-11, + 1.0000000000000002 + ] + ] + }, + "Base": { + "translation_m": [ + 0.06486190254531192, + 1.5908828862823174e-11, + 0.0160000000334398 + ], + "rotation_matrix": [ + [ + 0.9999999999999998, + 4.1597461974314254e-12, + 6.289665562104465e-12 + ], + [ + -4.159994960811153e-12, + 0.9999999999999999, + 1.2302126032636808e-11 + ], + [ + -6.289661479704083e-12, + -1.2302144258370985e-11, + 1.0000000000000002 + ] + ] + }, + "Arm1": { + "translation_m": [ + 0.17486190254604417, + 0.10800000001600482, + 0.06100000003141932 + ], + "rotation_matrix": [ + [ + 0.9999999999999986, + 4.3736968160479e-12, + 6.1428134817411154e-12 + ], + [ + -4.159994960811148e-12, + 0.9994078755157199, + -0.034407824068850026 + ], + [ + -6.289661479704075e-12, + 0.03440782406885002, + 0.9994078755157202 + ] + ] + }, + "Ellbow": { + "translation_m": [ + 0.17486190254495074, + -0.14185196886292514, + 0.052398044014206814 + ], + "rotation_matrix": [ + [ + 0.9999999999978657, + -6.420085538827087e-12, + 3.9554877049736904e-12 + ], + [ + -4.1599949608022756e-12, + -0.03213371358892881, + 0.9994835788791085 + ], + [ + -6.28966147969066e-12, + -0.9994835788791089, + -0.03213371358892884 + ] + ] + }, + "Arm2": { + "translation_m": [ + 0.26486190254475867, + -0.14185196886329954, + 0.052398044013640746 + ], + "rotation_matrix": [ + [ + 0.9728616047001127, + -6.420085538826739e-12, + 0.23138776565744767 + ], + [ + -0.23126827212884082, + -0.03213371358892707, + 0.9723591984217688 + ], + [ + 0.007435348183391852, + -0.9994835788790546, + -0.03126165616865061 + ] + ] + }, + "Hand": { + "translation_m": [ + 0.26486190254636366, + -0.13381854046606778, + 0.3022689387334044 + ], + "rotation_matrix": [ + [ + 0.9728616047001127, + -6.420085538826739e-12, + 0.23138776565744767 + ], + [ + -0.23126827212884082, + -0.03213371358892707, + 0.9723591984217688 + ], + [ + 0.007435348183391852, + -0.9994835788790546, + -0.03126165616865061 + ] + ] + }, + "Palm": { + "translation_m": [ + 0.26486190254636366, + -0.13381854046606778, + 0.3022689387334044 + ], + "rotation_matrix": [ + [ + 0.9728616047001127, + -6.420085538826739e-12, + 0.23138776565744767 + ], + [ + -0.23126827212884082, + -0.03213371358892707, + 0.9723591984217688 + ], + [ + 0.007435348183391852, + -0.9994835788790546, + -0.03126165616865061 + ] + ] + }, + "FingerA": { + "translation_m": [ + 0.2687533489653888, + -0.1336189335789707, + 0.33728060538690485 + ], + "rotation_matrix": [ + [ + 0.9728616047001127, + -6.420085538826739e-12, + 0.23138776565744767 + ], + [ + -0.23126827212884082, + -0.03213371358892707, + 0.9723591984217688 + ], + [ + 0.007435348183391852, + -0.9994835788790546, + -0.03126165616865061 + ] + ] + }, + "FingerB": { + "translation_m": [ + 0.2609704561277879, + -0.13176878740193998, + 0.3372211226014377 + ], + "rotation_matrix": [ + [ + 0.9728616047001127, + -6.420085538826739e-12, + 0.23138776565744767 + ], + [ + -0.23126827212884082, + -0.03213371358892707, + 0.9723591984217688 + ], + [ + 0.007435348183391852, + -0.9994835788790546, + -0.03126165616865061 + ] + ] + } + }, + "stage_reports": [ + { + "method": "deterministic_geometric_prefix", + "active_links": [ + "Board", + "Base", + "Arm1" + ], + "active_observations": 44, + "joint_updates": [ + { + "pass": 0, + "updates": [ + { + "link": "Base", + "joint_variable": "x", + "joint_type": "linear", + "old": 0.0, + "new": 0.047398489145149846, + "info": { + "reason": "weighted_projection", + "used_markers": 3, + "axis_world": [ + 0.999999999999, + -4.159994960806995e-12, + -6.2896614796977955e-12 + ], + "per_marker": [ + { + "marker_id": 198, + "q_i": 0.04215306388565592, + "weight": 1.0 + }, + { + "marker_id": 229, + "q_i": 0.05001671264366586, + "weight": 1.0 + }, + { + "marker_id": 243, + "q_i": 0.05002569090612775, + "weight": 1.0 + } + ] + } + }, + { + "link": "Arm1", + "joint_variable": "y", + "joint_type": "revolute", + "old": 0.0, + "new": -0.009588811821572563, + "info": { + "reason": "2d_alignment+normal_tiebreak", + "used_markers": 3, + "axis_world": [ + -0.999999999999, + 4.159994960806995e-12, + 6.2896614796977955e-12 + ], + "axis_id": 0, + "theta_rad": -0.009588811821572542, + "theta_alt_rad": 3.1320038417682206, + "score_theta": 0.0001411135875379974, + "score_theta_alt": 0.8900679169717585, + "best_score": 0.0001411135875379974, + "per_marker": [ + { + "marker_id": 198, + "weight": 1.0 + }, + { + "marker_id": 229, + "weight": 1.0 + }, + { + "marker_id": 243, + "weight": 1.0 + } + ] + } + } + ] + }, + { + "pass": 1, + "updates": [ + { + "link": "Base", + "joint_variable": "x", + "joint_type": "linear", + "old": 0.047398489145149846, + "new": 0.047398489145149846, + "info": { + "reason": "weighted_projection", + "used_markers": 3, + "axis_world": [ + 0.999999999999, + -4.159994960806995e-12, + -6.2896614796977955e-12 + ], + "per_marker": [ + { + "marker_id": 198, + "q_i": 0.04215306388565593, + "weight": 1.0 + }, + { + "marker_id": 229, + "q_i": 0.05001671264366587, + "weight": 1.0 + }, + { + "marker_id": 243, + "q_i": 0.05002569090612775, + "weight": 1.0 + } + ] + } + }, + { + "link": "Arm1", + "joint_variable": "y", + "joint_type": "revolute", + "old": -0.009588811821572563, + "new": -0.009588811821572563, + "info": { + "reason": "2d_alignment+normal_tiebreak", + "used_markers": 3, + "axis_world": [ + -0.999999999999, + 4.159994960806995e-12, + 6.2896614796977955e-12 + ], + "axis_id": 0, + "theta_rad": -0.009588811821572542, + "theta_alt_rad": 3.1320038417682206, + "score_theta": 0.0001411135875379974, + "score_theta_alt": 0.8900679169717585, + "best_score": 0.0001411135875379974, + "per_marker": [ + { + "marker_id": 198, + "weight": 1.0 + }, + { + "marker_id": 229, + "weight": 1.0 + }, + { + "marker_id": 243, + "weight": 1.0 + } + ] + } + } + ] + } + ], + "root_link": "Board", + "root_pose": { + "reason": "kabsch", + "used_markers": [ + 210, + 211, + 215, + 214, + 208, + 206, + 205, + 207, + 217, + 46, + 47, + 51, + 53, + 54, + 55, + 56, + 58, + 60, + 61, + 62, + 63, + 64, + 66, + 68, + 69, + 72, + 73, + 75, + 79, + 82, + 83, + 84, + 85, + 86, + 92, + 95, + 96, + 97, + 102, + 103, + 105 + ] + }, + "marker_stats": { + "num_markers_used": 44, + "mean_error_m": 0.00043434289393589373, + "rms_error_m": 0.0017614325075900744, + "median_error_m": 2.0734623442122414e-11, + "worst_error_m": 0.009470805442326632 + }, + "marker_reports": [ + { + "marker_id": 46, + "link": "Board", + "error_m": [ + -7.492451103985331e-12, + 2.481931327125153e-12, + 1.8023398745681263e-11 + ], + "error_norm_m": 1.9675866156385624e-11, + "predicted_m": [ + 0.5367100000003043, + 0.18544000001341324, + -0.027299999971809288 + ], + "observed_m": [ + 0.5367100000077968, + 0.1854400000109313, + -0.027299999989832686 + ] + }, + { + "marker_id": 47, + "link": "Board", + "error_m": [ + -2.808198118486871e-12, + -4.1244785364824565e-14, + -1.1091960683273783e-12 + ], + "error_norm_m": 3.01960158348513e-12, + "predicted_m": [ + 0.3442299999983411, + -0.286539999985786, + -0.02729999996479229 + ], + "observed_m": [ + 0.3442300000011493, + -0.28653999998574475, + -0.027299999963683094 + ] + }, + { + "marker_id": 51, + "link": "Board", + "error_m": [ + 4.554245869314855e-12, + 3.824357497350661e-12, + 1.3658119774051514e-11 + ], + "error_norm_m": 1.4896680887635694e-11, + "predicted_m": [ + 0.1677999999988172, + -0.17207999998505205, + -0.027299999965090707 + ], + "observed_m": [ + 0.16779999999426295, + -0.1720799999888764, + -0.027299999978748827 + ] + }, + { + "marker_id": 53, + "link": "Board", + "error_m": [ + -8.481271240867727e-12, + -6.852129974532772e-12, + -3.998516795444829e-12 + ], + "error_norm_m": 1.1613431173107923e-11, + "predicted_m": [ + 0.4862500000004158, + 0.21224000001362317, + -0.02729999997182161 + ], + "observed_m": [ + 0.48625000000889707, + 0.2122400000204753, + -0.027299999967823094 + ] + }, + { + "marker_id": 54, + "link": "Board", + "error_m": [ + -4.072464587778768e-12, + 1.8295309711646723e-11, + 3.2714810027645314e-11 + ], + "error_norm_m": 3.770360885125865e-11, + "predicted_m": [ + 0.34226999999815777, + -0.3305899999857778, + -0.027299999964238052 + ], + "observed_m": [ + 0.34227000000223023, + -0.3305900000040731, + -0.027299999996952862 + ] + }, + { + "marker_id": 55, + "link": "Board", + "error_m": [ + 3.742617327162634e-12, + 1.3011647315153141e-11, + 1.1736767807635218e-11 + ], + "error_norm_m": 1.7918199376105074e-11, + "predicted_m": [ + 0.2837199999984407, + -0.2625799999855342, + -0.02729999996470646 + ], + "observed_m": [ + 0.2837199999946981, + -0.26257999999854587, + -0.027299999976443227 + ] + }, + { + "marker_id": 56, + "link": "Board", + "error_m": [ + -5.746902953518429e-12, + 8.329253953220928e-12, + 2.4135290987992164e-11 + ], + "error_norm_m": 2.617089291654874e-11, + "predicted_m": [ + 0.49868000000023455, + 0.16867000001357144, + -0.027299999971363786 + ], + "observed_m": [ + 0.49868000000598145, + 0.16867000000524218, + -0.027299999995499077 + ] + }, + { + "marker_id": 58, + "link": "Board", + "error_m": [ + 1.362971541185587e-11, + -8.114897642741425e-13, + -2.814398020190012e-12 + ], + "error_norm_m": 1.3940892871755114e-11, + "predicted_m": [ + 0.050089999998625734, + -0.2181099999845624, + -0.027299999963784082 + ], + "observed_m": [ + 0.05008999998499602, + -0.2181099999837509, + -0.027299999960969684 + ] + }, + { + "marker_id": 60, + "link": "Board", + "error_m": [ + 2.7249313916399842e-12, + 4.138134279685346e-12, + 6.636580174301798e-12 + ], + "error_norm_m": 8.282125501088937e-12, + "predicted_m": [ + 0.4343600000007135, + 0.283810000013839, + -0.027299999972375703 + ], + "observed_m": [ + 0.4343599999979886, + 0.28381000000970086, + -0.027299999979012283 + ] + }, + { + "marker_id": 61, + "link": "Board", + "error_m": [ + 7.948190716700054e-13, + 1.7347789871280384e-12, + 1.191001117173407e-11 + ], + "error_norm_m": 1.2061905388523891e-11, + "predicted_m": [ + -0.022419999999070003, + 0.3358300000157392, + -0.027299999970142666 + ], + "observed_m": [ + -0.022419999999864822, + 0.3358300000140044, + -0.027299999982052677 + ] + }, + { + "marker_id": 62, + "link": "Board", + "error_m": [ + -2.4700796963372795e-12, + -8.548578511735627e-12, + -5.269056024825858e-12 + ], + "error_norm_m": 1.034129777495646e-11, + "predicted_m": [ + 0.40469999999880457, + -0.17509999998603754, + -0.027299999966543573 + ], + "observed_m": [ + 0.40470000000127465, + -0.17509999997748896, + -0.027299999961274517 + ] + }, + { + "marker_id": 63, + "link": "Board", + "error_m": [ + -1.1200040894721042e-11, + 8.238909554592055e-12, + 2.2577033992332574e-11 + ], + "error_norm_m": 2.6514958242152908e-11, + "predicted_m": [ + 0.7773999999985505, + -0.23614999998758798, + -0.027299999968136684 + ], + "observed_m": [ + 0.7774000000097505, + -0.2361499999958269, + -0.027299999990713718 + ] + }, + { + "marker_id": 64, + "link": "Board", + "error_m": [ + 1.84363670163723e-11, + -6.230571614196379e-13, + -1.6239929540029507e-11 + ], + "error_norm_m": 2.4576882236237772e-11, + "predicted_m": [ + -0.021270000001249956, + -0.18822999998426548, + -0.027299999963702838 + ], + "observed_m": [ + -0.021270000019686323, + -0.18822999998364243, + -0.02729999994746291 + ] + }, + { + "marker_id": 66, + "link": "Board", + "error_m": [ + 4.856171020861666e-12, + 1.5180134926850997e-11, + 1.298113699865766e-11 + ], + "error_norm_m": 2.0555505616724123e-11, + "predicted_m": [ + 0.20974999999802202, + -0.3632299999852266, + -0.027299999963003002 + ], + "observed_m": [ + 0.20974999999316585, + -0.3632300000004067, + -0.02729999997598414 + ] + }, + { + "marker_id": 68, + "link": "Board", + "error_m": [ + -7.462697126925377e-12, + 7.419731495872384e-12, + 1.9388258359898103e-11 + ], + "error_norm_m": 2.206011845184018e-11, + "predicted_m": [ + 0.5737300000002428, + 0.1706400000132592, + -0.02729999997186006 + ], + "observed_m": [ + 0.5737300000077055, + 0.17064000000583948, + -0.027299999991248318 + ] + }, + { + "marker_id": 69, + "link": "Board", + "error_m": [ + 5.317673384963584e-12, + 1.587674436365205e-11, + 1.8516677774416124e-11 + ], + "error_norm_m": 2.496429485524202e-11, + "predicted_m": [ + 0.0076099999983632646, + -0.28120999998438556, + -0.027299999962740632 + ], + "observed_m": [ + 0.007609999993045591, + -0.2812100000002623, + -0.02729999998125731 + ] + }, + { + "marker_id": 72, + "link": "Board", + "error_m": [ + 2.4560353750757713e-12, + -1.1806666755376227e-11, + -2.427206352573208e-11 + ], + "error_norm_m": 2.7102814566633174e-11, + "predicted_m": [ + 0.4409900000003412, + 0.19432000001381142, + -0.027299999971316484 + ], + "observed_m": [ + 0.4409899999978852, + 0.19432000002561808, + -0.02729999994704442 + ] + }, + { + "marker_id": 73, + "link": "Board", + "error_m": [ + 3.658018332686197e-12, + 3.5590419500408643e-12, + 1.981933714367834e-11 + ], + "error_norm_m": 2.0465922958401042e-11, + "predicted_m": [ + 0.2217300000009186, + 0.3331100000147235, + -0.02729999997164483 + ], + "observed_m": [ + 0.2217299999972606, + 0.3331100000111645, + -0.027299999991464166 + ] + }, + { + "marker_id": 75, + "link": "Board", + "error_m": [ + -5.778051648253069e-13, + 1.607880495413383e-13, + 1.3468715726050462e-11 + ], + "error_norm_m": 1.3482062709931783e-11, + "predicted_m": [ + -0.02569999999965756, + 0.19458000001575287, + -0.02729999996838436 + ], + "observed_m": [ + -0.025699999999079754, + 0.1945800000155921, + -0.027299999981853076 + ] + }, + { + "marker_id": 79, + "link": "Board", + "error_m": [ + -3.1583624604536453e-12, + -1.0718703702394805e-11, + -5.22700632776818e-12 + ], + "error_norm_m": 1.2336428074684484e-11, + "predicted_m": [ + 0.31229999999887115, + -0.1591099999856532, + -0.027299999966159123 + ], + "observed_m": [ + 0.3123000000020295, + -0.1591099999749345, + -0.027299999960932117 + ] + }, + { + "marker_id": 82, + "link": "Board", + "error_m": [ + 3.25389715172264e-12, + 3.2570057761915905e-12, + 2.040070196107635e-11 + ], + "error_norm_m": 2.0913741267520705e-11, + "predicted_m": [ + 0.21916000000076943, + 0.2972400000147342, + -0.027299999971187386 + ], + "observed_m": [ + 0.21915999999751554, + 0.2972400000114772, + -0.027299999991588088 + ] + }, + { + "marker_id": 83, + "link": "Board", + "error_m": [ + 3.413068438984368e-12, + -3.2620017798024037e-12, + 8.674616580606198e-12 + ], + "error_norm_m": 9.876166493187182e-12, + "predicted_m": [ + 0.04416000000094408, + 0.33922000001546226, + -0.027299999970603138 + ], + "observed_m": [ + 0.044159999997531015, + 0.33922000001872427, + -0.027299999979277755 + ] + }, + { + "marker_id": 84, + "link": "Board", + "error_m": [ + -1.7622014958362797e-12, + -1.0630718527693261e-11, + -2.532580048453248e-11 + ], + "error_norm_m": 2.7522966786109995e-11, + "predicted_m": [ + 0.4074900000006079, + 0.2584200000139508, + -0.027299999971894348 + ], + "observed_m": [ + 0.4074900000023701, + 0.25842000002458154, + -0.027299999946568548 + ] + }, + { + "marker_id": 85, + "link": "Board", + "error_m": [ + -5.510480960424502e-12, + 8.785194793858864e-13, + -1.0186799320743845e-11 + ], + "error_norm_m": 1.1614993641494972e-11, + "predicted_m": [ + 0.5045799999982319, + -0.31274999998645303, + -0.027299999965478397 + ], + "observed_m": [ + 0.5045800000037424, + -0.31274999998733155, + -0.027299999955291598 + ] + }, + { + "marker_id": 86, + "link": "Board", + "error_m": [ + 6.267764085521321e-13, + -8.959277764120088e-12, + -2.3645124053173205e-11 + ], + "error_norm_m": 2.529334691595646e-11, + "predicted_m": [ + 0.36289000000074767, + 0.2920100000141363, + -0.027299999972027058 + ], + "observed_m": [ + 0.3628900000001209, + 0.2920100000230956, + -0.027299999948381934 + ] + }, + { + "marker_id": 92, + "link": "Board", + "error_m": [ + -7.592926287713908e-12, + -6.8706706990440125e-12, + -1.869756433015013e-11 + ], + "error_norm_m": 2.1318010163837087e-11, + "predicted_m": [ + 0.645089999998764, + -0.18483999998703757, + -0.027299999967935723 + ], + "observed_m": [ + 0.645090000006357, + -0.1848399999801669, + -0.02729999994923816 + ] + }, + { + "marker_id": 95, + "link": "Board", + "error_m": [ + 4.54983273279197e-12, + 1.4976297979529818e-11, + 1.4302153211742663e-11 + ], + "error_norm_m": 2.120240706995824e-11, + "predicted_m": [ + 0.18603999999839294, + -0.2740699999851279, + -0.027299999963950734 + ], + "observed_m": [ + 0.1860399999938431, + -0.2740700000001042, + -0.027299999978252887 + ] + }, + { + "marker_id": 96, + "link": "Board", + "error_m": [ + -2.616351579831644e-12, + -8.76451689002522e-12, + -5.525052637622707e-12 + ], + "error_norm_m": 1.0685890629859849e-11, + "predicted_m": [ + 0.3697699999987572, + -0.18648999998589225, + -0.027299999966183753 + ], + "observed_m": [ + 0.36977000000137356, + -0.18648999997712773, + -0.0272999999606587 + ] + }, + { + "marker_id": 97, + "link": "Board", + "error_m": [ + 5.4089510648225314e-12, + 1.4107326418155708e-11, + 9.479118878719106e-12 + ], + "error_norm_m": 1.7836117991506104e-11, + "predicted_m": [ + 0.30434999999803686, + -0.3596699999856201, + -0.0272999999636418 + ], + "observed_m": [ + 0.3043499999926279, + -0.35966999999972743, + -0.02729999997312092 + ] + }, + { + "marker_id": 102, + "link": "Board", + "error_m": [ + -1.7663870366391166e-11, + 3.3410219035800992e-12, + 1.2036656393821232e-11 + ], + "error_norm_m": 2.1634598235784078e-11, + "predicted_m": [ + 0.6496899999986053, + -0.2229999999870567, + -0.027299999967495204 + ], + "observed_m": [ + 0.6496900000162692, + -0.2229999999903977, + -0.02729999997953186 + ] + }, + { + "marker_id": 103, + "link": "Board", + "error_m": [ + 1.6292495130798557e-11, + -5.307781991703564e-12, + -1.967232626798321e-11 + ], + "error_norm_m": 2.608866359268963e-11, + "predicted_m": [ + 0.10570999999875218, + -0.18770999998479376, + -0.0272999999645079 + ], + "observed_m": [ + 0.10570999998245968, + -0.18770999997948598, + -0.027299999944835573 + ] + }, + { + "marker_id": 105, + "link": "Board", + "error_m": [ + -4.240385820253323e-12, + 2.274458399398327e-12, + -1.1591214099659908e-11 + ], + "error_norm_m": 1.2550309845551769e-11, + "predicted_m": [ + 0.5248399999984255, + -0.2662499999865373, + -0.027299999966177872 + ], + "observed_m": [ + 0.5248400000026658, + -0.26624999998881177, + -0.027299999954586658 + ] + }, + { + "marker_id": 198, + "link": "Arm1", + "error_m": [ + 0.005245425259360309, + 0.001194789328154762, + -0.00779449472616385 + ], + "error_norm_m": 0.009470805442326632, + "predicted_m": [ + 0.15739848914518362, + -0.05232824768573991, + 0.09446420462187728 + ], + "observed_m": [ + 0.1521530638858233, + -0.05352303701389467, + 0.10225869934804113 + ] + }, + { + "marker_id": 205, + "link": "Board", + "error_m": [ + -1.0751399770470016e-11, + 7.604930574167668e-12, + 1.9853566219415336e-11 + ], + "error_norm_m": 2.3824182204035516e-11, + "predicted_m": [ + 0.749999999999332, + -0.08999999998713447, + 0.00030000003023770137 + ], + "observed_m": [ + 0.7500000000100834, + -0.0899999999947394, + 0.00030000001038413515 + ] + }, + { + "marker_id": 206, + "link": "Board", + "error_m": [ + -3.6561864646955655e-12, + -7.083960154585789e-12, + -1.29144830680189e-11 + ], + "error_norm_m": 1.5176760650762372e-11, + "predicted_m": [ + 0.649999999999665, + -0.009999999986718484, + 0.000300000029882496 + ], + "observed_m": [ + 0.6500000000033211, + -0.009999999979634524, + 0.00030000004279697904 + ] + }, + { + "marker_id": 207, + "link": "Board", + "error_m": [ + -9.957923374770417e-12, + 2.8038144722630776e-12, + 1.2247119984820642e-11 + ], + "error_norm_m": 1.6031642506470262e-11, + "predicted_m": [ + 0.7499999999996648, + -0.009999999987134484, + 0.0003000000292535298 + ], + "observed_m": [ + 0.7500000000096227, + -0.009999999989938299, + 0.0003000000170064098 + ] + }, + { + "marker_id": 208, + "link": "Board", + "error_m": [ + 5.507538869409245e-12, + -2.732553072704036e-11, + -4.7252488759915584e-11 + ], + "error_norm_m": 5.4861783674233825e-11, + "predicted_m": [ + 0.34999999999933223, + -0.08999999998547048, + 0.000300000032753566 + ], + "observed_m": [ + 0.3499999999938247, + -0.08999999995814495, + 0.00030000008000605476 + ] + }, + { + "marker_id": 210, + "link": "Board", + "error_m": [ + 4.405288633879678e-12, + -1.7787275125025204e-11, + -1.6451536801690564e-11 + ], + "error_norm_m": 2.462614032808448e-11, + "predicted_m": [ + 0.019999999999623427, + -0.019999999984097686, + 0.0003000000339680041 + ], + "observed_m": [ + 0.019999999995218138, + -0.01999999996631041, + 0.0003000000504195409 + ] + }, + { + "marker_id": 211, + "link": "Board", + "error_m": [ + 1.1146833456265881e-11, + 8.425985603688346e-13, + -1.3026511672727809e-11 + ], + "error_norm_m": 1.7165426729195456e-11, + "predicted_m": [ + 0.24999999999966496, + -0.009999999985054487, + 0.00030000003239836055 + ], + "observed_m": [ + 0.24999999998851813, + -0.009999999985897085, + 0.0003000000454248722 + ] + }, + { + "marker_id": 214, + "link": "Board", + "error_m": [ + 1.1624867735093858e-11, + -2.41929844213562e-11, + -5.461947062170014e-11 + ], + "error_norm_m": 6.085823375735755e-11, + "predicted_m": [ + 0.349999999999665, + -0.009999999985470485, + 0.00030000003176939443 + ], + "observed_m": [ + 0.34999999998804016, + -0.009999999961277501, + 0.00030000008638886506 + ] + }, + { + "marker_id": 215, + "link": "Board", + "error_m": [ + 5.437317263101704e-14, + 1.431470220136788e-11, + 1.3618144643640778e-11 + ], + "error_norm_m": 1.9757720493287436e-11, + "predicted_m": [ + 0.2499999999993322, + -0.08999999998505448, + 0.0003000000333825321 + ], + "observed_m": [ + 0.24999999999927783, + -0.08999999999936918, + 0.0003000000197643875 + ] + }, + { + "marker_id": 217, + "link": "Board", + "error_m": [ + -9.231837516665564e-12, + -7.064640539233835e-12, + -1.833993769568068e-11 + ], + "error_norm_m": 2.171380400952696e-11, + "predicted_m": [ + 0.6499999999993321, + -0.08999999998671848, + 0.00030000003086666754 + ], + "observed_m": [ + 0.650000000008564, + -0.08999999997965384, + 0.00030000004920660524 + ] + }, + { + "marker_id": 229, + "link": "Arm1", + "error_m": [ + -0.002618223498638439, + 0.0007571508340879496, + -0.004475491877156762 + ], + "error_norm_m": 0.0052400762605976205, + "predicted_m": [ + 0.15739848914480384, + -0.142324110178406, + 0.09360122478367741 + ], + "observed_m": [ + 0.16001671264344228, + -0.14308126101249394, + 0.09807671666083417 + ] + }, + { + "marker_id": 243, + "link": "Arm1", + "error_m": [ + -0.0026272017610984855, + -0.0002428599016700561, + -0.0035214531231214513 + ], + "error_norm_m": 0.004400204782018673, + "predicted_m": [ + 0.1573984891444374, + -0.1769868978773651, + 0.058267230543896195 + ], + "observed_m": [ + 0.1600256909055359, + -0.17674403797569505, + 0.061788683667017646 + ] + } + ], + "stage_idx": 0, + "num_active_links": 3 + }, + { + "method": "deterministic_geometric_prefix", + "active_links": [ + "Board", + "Base", + "Arm1", + "Ellbow" + ], + "active_observations": 48, + "joint_updates": [ + { + "pass": 0, + "updates": [ + { + "link": "Base", + "joint_variable": "x", + "joint_type": "linear", + "old": 0.047398489145149846, + "new": 0.04172035079624908, + "info": { + "reason": "weighted_projection", + "used_markers": 7, + "axis_world": [ + 0.999999999999, + -4.159994960806995e-12, + -6.2896614796977955e-12 + ], + "per_marker": [ + { + "marker_id": 198, + "q_i": 0.04215306388565593, + "weight": 1.0 + }, + { + "marker_id": 229, + "q_i": 0.05001671264366587, + "weight": 1.0 + }, + { + "marker_id": 243, + "q_i": 0.05002569090612775, + "weight": 1.0 + }, + { + "marker_id": 244, + "q_i": 0.04214634853110261, + "weight": 1.0 + }, + { + "marker_id": 245, + "q_i": 0.03079172204870937, + "weight": 1.0 + }, + { + "marker_id": 248, + "q_i": 0.04661576790558713, + "weight": 1.0 + }, + { + "marker_id": 232, + "q_i": 0.030293149652894896, + "weight": 1.0 + } + ] + } + }, + { + "link": "Arm1", + "joint_variable": "y", + "joint_type": "revolute", + "old": -0.009588811821572563, + "new": -0.006697462773790797, + "info": { + "reason": "2d_alignment+normal_tiebreak", + "used_markers": 7, + "axis_world": [ + -0.999999999999, + 4.159994960806995e-12, + 6.2896614796977955e-12 + ], + "axis_id": 0, + "theta_rad": -0.006697462773790576, + "theta_alt_rad": 3.1348951908160023, + "score_theta": 0.003030392930799487, + "score_theta_alt": 1.7883355870943247, + "best_score": 0.003030392930799487, + "per_marker": [ + { + "marker_id": 198, + "weight": 1.0 + }, + { + "marker_id": 229, + "weight": 1.0 + }, + { + "marker_id": 243, + "weight": 1.0 + }, + { + "marker_id": 244, + "weight": 1.0 + }, + { + "marker_id": 245, + "weight": 1.0 + }, + { + "marker_id": 248, + "weight": 1.0 + }, + { + "marker_id": 232, + "weight": 1.0 + } + ] + } + }, + { + "link": "Ellbow", + "joint_variable": "z", + "joint_type": "revolute", + "old": 0.0, + "new": 0.3025081132866849, + "info": { + "reason": "2d_alignment+normal_tiebreak", + "used_markers": 3, + "axis_world": [ + -0.999999999999, + 4.159994960806995e-12, + 6.2896614796977955e-12 + ], + "axis_id": 0, + "theta_rad": 0.3025081132866848, + "theta_alt_rad": -2.8390845403031086, + "score_theta": 0.01396768024065478, + "score_theta_alt": 0.30521468241429345, + "best_score": 0.01396768024065478, + "per_marker": [ + { + "marker_id": 245, + "weight": 1.0 + }, + { + "marker_id": 248, + "weight": 1.0 + }, + { + "marker_id": 232, + "weight": 1.0 + } + ] + } + } + ] + }, + { + "pass": 1, + "updates": [ + { + "link": "Base", + "joint_variable": "x", + "joint_type": "linear", + "old": 0.04172035079624908, + "new": 0.04172035079625371, + "info": { + "reason": "weighted_projection", + "used_markers": 7, + "axis_world": [ + 0.999999999999, + -4.159994960806995e-12, + -6.2896614796977955e-12 + ], + "per_marker": [ + { + "marker_id": 198, + "q_i": 0.04215306388565592, + "weight": 1.0 + }, + { + "marker_id": 229, + "q_i": 0.05001671264366586, + "weight": 1.0 + }, + { + "marker_id": 243, + "q_i": 0.05002569090612774, + "weight": 1.0 + }, + { + "marker_id": 244, + "q_i": 0.042146348531113965, + "weight": 1.0 + }, + { + "marker_id": 245, + "q_i": 0.030791722048717544, + "weight": 1.0 + }, + { + "marker_id": 248, + "q_i": 0.046615767905591896, + "weight": 1.0 + }, + { + "marker_id": 232, + "q_i": 0.030293149652903074, + "weight": 1.0 + } + ] + } + }, + { + "link": "Arm1", + "joint_variable": "y", + "joint_type": "revolute", + "old": -0.006697462773790797, + "new": -0.005988379220400297, + "info": { + "reason": "2d_alignment+normal_tiebreak", + "used_markers": 7, + "axis_world": [ + -0.999999999999, + 4.159994960806995e-12, + 6.2896614796977955e-12 + ], + "axis_id": 0, + "theta_rad": -0.005988379220400515, + "theta_alt_rad": 3.135604274369393, + "score_theta": 0.003960932887039133, + "score_theta_alt": 1.8167563690400308, + "best_score": 0.003960932887039133, + "per_marker": [ + { + "marker_id": 198, + "weight": 1.0 + }, + { + "marker_id": 229, + "weight": 1.0 + }, + { + "marker_id": 243, + "weight": 1.0 + }, + { + "marker_id": 244, + "weight": 1.0 + }, + { + "marker_id": 245, + "weight": 1.0 + }, + { + "marker_id": 248, + "weight": 1.0 + }, + { + "marker_id": 232, + "weight": 1.0 + } + ] + } + }, + { + "link": "Ellbow", + "joint_variable": "z", + "joint_type": "revolute", + "old": 0.3025081132866849, + "new": 0.300637467901522, + "info": { + "reason": "2d_alignment+normal_tiebreak", + "used_markers": 3, + "axis_world": [ + -0.999999999999, + 4.159994960806995e-12, + 6.2896614796977955e-12 + ], + "axis_id": 0, + "theta_rad": 0.30063746790152207, + "theta_alt_rad": -2.840955185688271, + "score_theta": 0.013950515481967615, + "score_theta_alt": 0.3052891709550329, + "best_score": 0.013950515481967615, + "per_marker": [ + { + "marker_id": 245, + "weight": 1.0 + }, + { + "marker_id": 248, + "weight": 1.0 + }, + { + "marker_id": 232, + "weight": 1.0 + } + ] + } + } + ] + } + ], + "root_link": "Board", + "root_pose": { + "reason": "kabsch", + "used_markers": [ + 210, + 211, + 215, + 214, + 208, + 206, + 205, + 207, + 217, + 46, + 47, + 51, + 53, + 54, + 55, + 56, + 58, + 60, + 61, + 62, + 63, + 64, + 66, + 68, + 69, + 72, + 73, + 75, + 79, + 82, + 83, + 84, + 85, + 86, + 92, + 95, + 96, + 97, + 102, + 103, + 105 + ] + }, + "marker_stats": { + "num_markers_used": 48, + "mean_error_m": 0.003022962592595662, + "rms_error_m": 0.009073294134932073, + "median_error_m": 2.1260208616897662e-11, + "worst_error_m": 0.036674913710651756 + }, + "marker_reports": [ + { + "marker_id": 46, + "link": "Board", + "error_m": [ + -7.492451103985331e-12, + 2.481931327125153e-12, + 1.8023398745681263e-11 + ], + "error_norm_m": 1.9675866156385624e-11, + "predicted_m": [ + 0.5367100000003043, + 0.18544000001341324, + -0.027299999971809288 + ], + "observed_m": [ + 0.5367100000077968, + 0.1854400000109313, + -0.027299999989832686 + ] + }, + { + "marker_id": 47, + "link": "Board", + "error_m": [ + -2.808198118486871e-12, + -4.1244785364824565e-14, + -1.1091960683273783e-12 + ], + "error_norm_m": 3.01960158348513e-12, + "predicted_m": [ + 0.3442299999983411, + -0.286539999985786, + -0.02729999996479229 + ], + "observed_m": [ + 0.3442300000011493, + -0.28653999998574475, + -0.027299999963683094 + ] + }, + { + "marker_id": 51, + "link": "Board", + "error_m": [ + 4.554245869314855e-12, + 3.824357497350661e-12, + 1.3658119774051514e-11 + ], + "error_norm_m": 1.4896680887635694e-11, + "predicted_m": [ + 0.1677999999988172, + -0.17207999998505205, + -0.027299999965090707 + ], + "observed_m": [ + 0.16779999999426295, + -0.1720799999888764, + -0.027299999978748827 + ] + }, + { + "marker_id": 53, + "link": "Board", + "error_m": [ + -8.481271240867727e-12, + -6.852129974532772e-12, + -3.998516795444829e-12 + ], + "error_norm_m": 1.1613431173107923e-11, + "predicted_m": [ + 0.4862500000004158, + 0.21224000001362317, + -0.02729999997182161 + ], + "observed_m": [ + 0.48625000000889707, + 0.2122400000204753, + -0.027299999967823094 + ] + }, + { + "marker_id": 54, + "link": "Board", + "error_m": [ + -4.072464587778768e-12, + 1.8295309711646723e-11, + 3.2714810027645314e-11 + ], + "error_norm_m": 3.770360885125865e-11, + "predicted_m": [ + 0.34226999999815777, + -0.3305899999857778, + -0.027299999964238052 + ], + "observed_m": [ + 0.34227000000223023, + -0.3305900000040731, + -0.027299999996952862 + ] + }, + { + "marker_id": 55, + "link": "Board", + "error_m": [ + 3.742617327162634e-12, + 1.3011647315153141e-11, + 1.1736767807635218e-11 + ], + "error_norm_m": 1.7918199376105074e-11, + "predicted_m": [ + 0.2837199999984407, + -0.2625799999855342, + -0.02729999996470646 + ], + "observed_m": [ + 0.2837199999946981, + -0.26257999999854587, + -0.027299999976443227 + ] + }, + { + "marker_id": 56, + "link": "Board", + "error_m": [ + -5.746902953518429e-12, + 8.329253953220928e-12, + 2.4135290987992164e-11 + ], + "error_norm_m": 2.617089291654874e-11, + "predicted_m": [ + 0.49868000000023455, + 0.16867000001357144, + -0.027299999971363786 + ], + "observed_m": [ + 0.49868000000598145, + 0.16867000000524218, + -0.027299999995499077 + ] + }, + { + "marker_id": 58, + "link": "Board", + "error_m": [ + 1.362971541185587e-11, + -8.114897642741425e-13, + -2.814398020190012e-12 + ], + "error_norm_m": 1.3940892871755114e-11, + "predicted_m": [ + 0.050089999998625734, + -0.2181099999845624, + -0.027299999963784082 + ], + "observed_m": [ + 0.05008999998499602, + -0.2181099999837509, + -0.027299999960969684 + ] + }, + { + "marker_id": 60, + "link": "Board", + "error_m": [ + 2.7249313916399842e-12, + 4.138134279685346e-12, + 6.636580174301798e-12 + ], + "error_norm_m": 8.282125501088937e-12, + "predicted_m": [ + 0.4343600000007135, + 0.283810000013839, + -0.027299999972375703 + ], + "observed_m": [ + 0.4343599999979886, + 0.28381000000970086, + -0.027299999979012283 + ] + }, + { + "marker_id": 61, + "link": "Board", + "error_m": [ + 7.948190716700054e-13, + 1.7347789871280384e-12, + 1.191001117173407e-11 + ], + "error_norm_m": 1.2061905388523891e-11, + "predicted_m": [ + -0.022419999999070003, + 0.3358300000157392, + -0.027299999970142666 + ], + "observed_m": [ + -0.022419999999864822, + 0.3358300000140044, + -0.027299999982052677 + ] + }, + { + "marker_id": 62, + "link": "Board", + "error_m": [ + -2.4700796963372795e-12, + -8.548578511735627e-12, + -5.269056024825858e-12 + ], + "error_norm_m": 1.034129777495646e-11, + "predicted_m": [ + 0.40469999999880457, + -0.17509999998603754, + -0.027299999966543573 + ], + "observed_m": [ + 0.40470000000127465, + -0.17509999997748896, + -0.027299999961274517 + ] + }, + { + "marker_id": 63, + "link": "Board", + "error_m": [ + -1.1200040894721042e-11, + 8.238909554592055e-12, + 2.2577033992332574e-11 + ], + "error_norm_m": 2.6514958242152908e-11, + "predicted_m": [ + 0.7773999999985505, + -0.23614999998758798, + -0.027299999968136684 + ], + "observed_m": [ + 0.7774000000097505, + -0.2361499999958269, + -0.027299999990713718 + ] + }, + { + "marker_id": 64, + "link": "Board", + "error_m": [ + 1.84363670163723e-11, + -6.230571614196379e-13, + -1.6239929540029507e-11 + ], + "error_norm_m": 2.4576882236237772e-11, + "predicted_m": [ + -0.021270000001249956, + -0.18822999998426548, + -0.027299999963702838 + ], + "observed_m": [ + -0.021270000019686323, + -0.18822999998364243, + -0.02729999994746291 + ] + }, + { + "marker_id": 66, + "link": "Board", + "error_m": [ + 4.856171020861666e-12, + 1.5180134926850997e-11, + 1.298113699865766e-11 + ], + "error_norm_m": 2.0555505616724123e-11, + "predicted_m": [ + 0.20974999999802202, + -0.3632299999852266, + -0.027299999963003002 + ], + "observed_m": [ + 0.20974999999316585, + -0.3632300000004067, + -0.02729999997598414 + ] + }, + { + "marker_id": 68, + "link": "Board", + "error_m": [ + -7.462697126925377e-12, + 7.419731495872384e-12, + 1.9388258359898103e-11 + ], + "error_norm_m": 2.206011845184018e-11, + "predicted_m": [ + 0.5737300000002428, + 0.1706400000132592, + -0.02729999997186006 + ], + "observed_m": [ + 0.5737300000077055, + 0.17064000000583948, + -0.027299999991248318 + ] + }, + { + "marker_id": 69, + "link": "Board", + "error_m": [ + 5.317673384963584e-12, + 1.587674436365205e-11, + 1.8516677774416124e-11 + ], + "error_norm_m": 2.496429485524202e-11, + "predicted_m": [ + 0.0076099999983632646, + -0.28120999998438556, + -0.027299999962740632 + ], + "observed_m": [ + 0.007609999993045591, + -0.2812100000002623, + -0.02729999998125731 + ] + }, + { + "marker_id": 72, + "link": "Board", + "error_m": [ + 2.4560353750757713e-12, + -1.1806666755376227e-11, + -2.427206352573208e-11 + ], + "error_norm_m": 2.7102814566633174e-11, + "predicted_m": [ + 0.4409900000003412, + 0.19432000001381142, + -0.027299999971316484 + ], + "observed_m": [ + 0.4409899999978852, + 0.19432000002561808, + -0.02729999994704442 + ] + }, + { + "marker_id": 73, + "link": "Board", + "error_m": [ + 3.658018332686197e-12, + 3.5590419500408643e-12, + 1.981933714367834e-11 + ], + "error_norm_m": 2.0465922958401042e-11, + "predicted_m": [ + 0.2217300000009186, + 0.3331100000147235, + -0.02729999997164483 + ], + "observed_m": [ + 0.2217299999972606, + 0.3331100000111645, + -0.027299999991464166 + ] + }, + { + "marker_id": 75, + "link": "Board", + "error_m": [ + -5.778051648253069e-13, + 1.607880495413383e-13, + 1.3468715726050462e-11 + ], + "error_norm_m": 1.3482062709931783e-11, + "predicted_m": [ + -0.02569999999965756, + 0.19458000001575287, + -0.02729999996838436 + ], + "observed_m": [ + -0.025699999999079754, + 0.1945800000155921, + -0.027299999981853076 + ] + }, + { + "marker_id": 79, + "link": "Board", + "error_m": [ + -3.1583624604536453e-12, + -1.0718703702394805e-11, + -5.22700632776818e-12 + ], + "error_norm_m": 1.2336428074684484e-11, + "predicted_m": [ + 0.31229999999887115, + -0.1591099999856532, + -0.027299999966159123 + ], + "observed_m": [ + 0.3123000000020295, + -0.1591099999749345, + -0.027299999960932117 + ] + }, + { + "marker_id": 82, + "link": "Board", + "error_m": [ + 3.25389715172264e-12, + 3.2570057761915905e-12, + 2.040070196107635e-11 + ], + "error_norm_m": 2.0913741267520705e-11, + "predicted_m": [ + 0.21916000000076943, + 0.2972400000147342, + -0.027299999971187386 + ], + "observed_m": [ + 0.21915999999751554, + 0.2972400000114772, + -0.027299999991588088 + ] + }, + { + "marker_id": 83, + "link": "Board", + "error_m": [ + 3.413068438984368e-12, + -3.2620017798024037e-12, + 8.674616580606198e-12 + ], + "error_norm_m": 9.876166493187182e-12, + "predicted_m": [ + 0.04416000000094408, + 0.33922000001546226, + -0.027299999970603138 + ], + "observed_m": [ + 0.044159999997531015, + 0.33922000001872427, + -0.027299999979277755 + ] + }, + { + "marker_id": 84, + "link": "Board", + "error_m": [ + -1.7622014958362797e-12, + -1.0630718527693261e-11, + -2.532580048453248e-11 + ], + "error_norm_m": 2.7522966786109995e-11, + "predicted_m": [ + 0.4074900000006079, + 0.2584200000139508, + -0.027299999971894348 + ], + "observed_m": [ + 0.4074900000023701, + 0.25842000002458154, + -0.027299999946568548 + ] + }, + { + "marker_id": 85, + "link": "Board", + "error_m": [ + -5.510480960424502e-12, + 8.785194793858864e-13, + -1.0186799320743845e-11 + ], + "error_norm_m": 1.1614993641494972e-11, + "predicted_m": [ + 0.5045799999982319, + -0.31274999998645303, + -0.027299999965478397 + ], + "observed_m": [ + 0.5045800000037424, + -0.31274999998733155, + -0.027299999955291598 + ] + }, + { + "marker_id": 86, + "link": "Board", + "error_m": [ + 6.267764085521321e-13, + -8.959277764120088e-12, + -2.3645124053173205e-11 + ], + "error_norm_m": 2.529334691595646e-11, + "predicted_m": [ + 0.36289000000074767, + 0.2920100000141363, + -0.027299999972027058 + ], + "observed_m": [ + 0.3628900000001209, + 0.2920100000230956, + -0.027299999948381934 + ] + }, + { + "marker_id": 92, + "link": "Board", + "error_m": [ + -7.592926287713908e-12, + -6.8706706990440125e-12, + -1.869756433015013e-11 + ], + "error_norm_m": 2.1318010163837087e-11, + "predicted_m": [ + 0.645089999998764, + -0.18483999998703757, + -0.027299999967935723 + ], + "observed_m": [ + 0.645090000006357, + -0.1848399999801669, + -0.02729999994923816 + ] + }, + { + "marker_id": 95, + "link": "Board", + "error_m": [ + 4.54983273279197e-12, + 1.4976297979529818e-11, + 1.4302153211742663e-11 + ], + "error_norm_m": 2.120240706995824e-11, + "predicted_m": [ + 0.18603999999839294, + -0.2740699999851279, + -0.027299999963950734 + ], + "observed_m": [ + 0.1860399999938431, + -0.2740700000001042, + -0.027299999978252887 + ] + }, + { + "marker_id": 96, + "link": "Board", + "error_m": [ + -2.616351579831644e-12, + -8.76451689002522e-12, + -5.525052637622707e-12 + ], + "error_norm_m": 1.0685890629859849e-11, + "predicted_m": [ + 0.3697699999987572, + -0.18648999998589225, + -0.027299999966183753 + ], + "observed_m": [ + 0.36977000000137356, + -0.18648999997712773, + -0.0272999999606587 + ] + }, + { + "marker_id": 97, + "link": "Board", + "error_m": [ + 5.4089510648225314e-12, + 1.4107326418155708e-11, + 9.479118878719106e-12 + ], + "error_norm_m": 1.7836117991506104e-11, + "predicted_m": [ + 0.30434999999803686, + -0.3596699999856201, + -0.0272999999636418 + ], + "observed_m": [ + 0.3043499999926279, + -0.35966999999972743, + -0.02729999997312092 + ] + }, + { + "marker_id": 102, + "link": "Board", + "error_m": [ + -1.7663870366391166e-11, + 3.3410219035800992e-12, + 1.2036656393821232e-11 + ], + "error_norm_m": 2.1634598235784078e-11, + "predicted_m": [ + 0.6496899999986053, + -0.2229999999870567, + -0.027299999967495204 + ], + "observed_m": [ + 0.6496900000162692, + -0.2229999999903977, + -0.02729999997953186 + ] + }, + { + "marker_id": 103, + "link": "Board", + "error_m": [ + 1.6292495130798557e-11, + -5.307781991703564e-12, + -1.967232626798321e-11 + ], + "error_norm_m": 2.608866359268963e-11, + "predicted_m": [ + 0.10570999999875218, + -0.18770999998479376, + -0.0272999999645079 + ], + "observed_m": [ + 0.10570999998245968, + -0.18770999997948598, + -0.027299999944835573 + ] + }, + { + "marker_id": 105, + "link": "Board", + "error_m": [ + -4.240385820253323e-12, + 2.274458399398327e-12, + -1.1591214099659908e-11 + ], + "error_norm_m": 1.2550309845551769e-11, + "predicted_m": [ + 0.5248399999984255, + -0.2662499999865373, + -0.027299999966177872 + ], + "observed_m": [ + 0.5248400000026658, + -0.26624999998881177, + -0.027299999954586658 + ] + }, + { + "marker_id": 198, + "link": "Arm1", + "error_m": [ + -0.00043271308952599896, + 0.001316313856673322, + -0.007217461823305918 + ], + "error_norm_m": 0.007349263769793252, + "predicted_m": [ + 0.1517203507962973, + -0.05220672315722135, + 0.09504123752473521 + ], + "observed_m": [ + 0.1521530638858233, + -0.05352303701389467, + 0.10225869934804113 + ] + }, + { + "marker_id": 205, + "link": "Board", + "error_m": [ + -1.0751399770470016e-11, + 7.604930574167668e-12, + 1.9853566219415336e-11 + ], + "error_norm_m": 2.3824182204035516e-11, + "predicted_m": [ + 0.749999999999332, + -0.08999999998713447, + 0.00030000003023770137 + ], + "observed_m": [ + 0.7500000000100834, + -0.0899999999947394, + 0.00030000001038413515 + ] + }, + { + "marker_id": 206, + "link": "Board", + "error_m": [ + -3.6561864646955655e-12, + -7.083960154585789e-12, + -1.29144830680189e-11 + ], + "error_norm_m": 1.5176760650762372e-11, + "predicted_m": [ + 0.649999999999665, + -0.009999999986718484, + 0.000300000029882496 + ], + "observed_m": [ + 0.6500000000033211, + -0.009999999979634524, + 0.00030000004279697904 + ] + }, + { + "marker_id": 207, + "link": "Board", + "error_m": [ + -9.957923374770417e-12, + 2.8038144722630776e-12, + 1.2247119984820642e-11 + ], + "error_norm_m": 1.6031642506470262e-11, + "predicted_m": [ + 0.7499999999996648, + -0.009999999987134484, + 0.0003000000292535298 + ], + "observed_m": [ + 0.7500000000096227, + -0.009999999989938299, + 0.0003000000170064098 + ] + }, + { + "marker_id": 208, + "link": "Board", + "error_m": [ + 5.507538869409245e-12, + -2.732553072704036e-11, + -4.7252488759915584e-11 + ], + "error_norm_m": 5.4861783674233825e-11, + "predicted_m": [ + 0.34999999999933223, + -0.08999999998547048, + 0.000300000032753566 + ], + "observed_m": [ + 0.3499999999938247, + -0.08999999995814495, + 0.00030000008000605476 + ] + }, + { + "marker_id": 210, + "link": "Board", + "error_m": [ + 4.405288633879678e-12, + -1.7787275125025204e-11, + -1.6451536801690564e-11 + ], + "error_norm_m": 2.462614032808448e-11, + "predicted_m": [ + 0.019999999999623427, + -0.019999999984097686, + 0.0003000000339680041 + ], + "observed_m": [ + 0.019999999995218138, + -0.01999999996631041, + 0.0003000000504195409 + ] + }, + { + "marker_id": 211, + "link": "Board", + "error_m": [ + 1.1146833456265881e-11, + 8.425985603688346e-13, + -1.3026511672727809e-11 + ], + "error_norm_m": 1.7165426729195456e-11, + "predicted_m": [ + 0.24999999999966496, + -0.009999999985054487, + 0.00030000003239836055 + ], + "observed_m": [ + 0.24999999998851813, + -0.009999999985897085, + 0.0003000000454248722 + ] + }, + { + "marker_id": 214, + "link": "Board", + "error_m": [ + 1.1624867735093858e-11, + -2.41929844213562e-11, + -5.461947062170014e-11 + ], + "error_norm_m": 6.085823375735755e-11, + "predicted_m": [ + 0.349999999999665, + -0.009999999985470485, + 0.00030000003176939443 + ], + "observed_m": [ + 0.34999999998804016, + -0.009999999961277501, + 0.00030000008638886506 + ] + }, + { + "marker_id": 215, + "link": "Board", + "error_m": [ + 5.437317263101704e-14, + 1.431470220136788e-11, + 1.3618144643640778e-11 + ], + "error_norm_m": 1.9757720493287436e-11, + "predicted_m": [ + 0.2499999999993322, + -0.08999999998505448, + 0.0003000000333825321 + ], + "observed_m": [ + 0.24999999999927783, + -0.08999999999936918, + 0.0003000000197643875 + ] + }, + { + "marker_id": 217, + "link": "Board", + "error_m": [ + -9.231837516665564e-12, + -7.064640539233835e-12, + -1.833993769568068e-11 + ], + "error_norm_m": 2.171380400952696e-11, + "predicted_m": [ + 0.6499999999993321, + -0.08999999998671848, + 0.00030000003086666754 + ], + "observed_m": [ + 0.650000000008564, + -0.08999999997965384, + 0.00030000004920660524 + ] + }, + { + "marker_id": 229, + "link": "Arm1", + "error_m": [ + -0.00829636184752272, + 0.0008761515812994447, + -0.003574430043622276 + ], + "error_norm_m": 0.009076001963155014, + "predicted_m": [ + 0.15172035079591956, + -0.1422051094311945, + 0.0945022866172119 + ], + "observed_m": [ + 0.16001671264344228, + -0.14308126101249394, + 0.09807671666083417 + ] + }, + { + "marker_id": 232, + "link": "Ellbow", + "error_m": [ + 0.011427201143164728, + -0.03273664219106946, + 0.003527246266723922 + ], + "error_norm_m": 0.03485269192097753, + "predicted_m": [ + 0.24172035079556664, + -0.1254996417246637, + 0.028632036552240586 + ], + "observed_m": [ + 0.2302931496524019, + -0.09276299953359425, + 0.025104790285516664 + ] + }, + { + "marker_id": 243, + "link": "Arm1", + "error_m": [ + -0.008305340109982517, + -0.00025085187578549606, + -0.0024953615092766085 + ], + "error_norm_m": 0.008675738012875259, + "predicted_m": [ + 0.15172035079555338, + -0.17699488985148054, + 0.05929332215774104 + ], + "observed_m": [ + 0.1600256909055359, + -0.17674403797569505, + 0.061788683667017646 + ] + }, + { + "marker_id": 244, + "link": "Ellbow", + "error_m": [ + -0.0004259977349942434, + -0.024521002484812898, + 0.008229622490176024 + ], + "error_norm_m": 0.02586866295851472, + "predicted_m": [ + 0.276720350795689, + -0.1419955174121221, + 0.05950291417654723 + ], + "observed_m": [ + 0.27714634853068326, + -0.1174745149273092, + 0.05127329168637121 + ] + }, + { + "marker_id": 245, + "link": "Ellbow", + "error_m": [ + 0.010928628747272101, + -0.03410246733747055, + -0.00791429661339555 + ], + "error_norm_m": 0.036674913710651756, + "predicted_m": [ + 0.24172035079543924, + -0.1521596601958652, + 0.026011270420921197 + ], + "observed_m": [ + 0.23079172204816714, + -0.11805719285839464, + 0.03392556703431675 + ] + }, + { + "marker_id": 248, + "link": "Ellbow", + "error_m": [ + -0.0048954171095860755, + -0.006482840084874902, + -0.021094800142309224 + ], + "error_norm_m": 0.022604931260387814, + "predicted_m": [ + 0.20422035079544265, + -0.15215966019570917, + 0.026011270421157057 + ], + "observed_m": [ + 0.20911576790502873, + -0.14567682011083427, + 0.04710607056346628 + ] + } + ], + "stage_idx": 1, + "num_active_links": 4 + }, + { + "method": "deterministic_geometric_prefix", + "active_links": [ + "Board", + "Base", + "Arm1", + "Ellbow", + "Arm2" + ], + "active_observations": 52, + "joint_updates": [ + { + "pass": 0, + "updates": [ + { + "link": "Base", + "joint_variable": "x", + "joint_type": "linear", + "old": 0.04172035079625371, + "new": 0.05247360179780933, + "info": { + "reason": "weighted_projection", + "used_markers": 11, + "axis_world": [ + 0.999999999999, + -4.159994960806995e-12, + -6.2896614796977955e-12 + ], + "per_marker": [ + { + "marker_id": 198, + "q_i": 0.042153063885655914, + "weight": 1.0 + }, + { + "marker_id": 229, + "q_i": 0.050016712643665855, + "weight": 1.0 + }, + { + "marker_id": 243, + "q_i": 0.05002569090612775, + "weight": 1.0 + }, + { + "marker_id": 244, + "q_i": 0.0421463485311138, + "weight": 1.0 + }, + { + "marker_id": 245, + "q_i": 0.030791722048717437, + "weight": 1.0 + }, + { + "marker_id": 248, + "q_i": 0.04661576790559181, + "weight": 1.0 + }, + { + "marker_id": 232, + "q_i": 0.030293149652902984, + "weight": 1.0 + }, + { + "marker_id": 120, + "q_i": 0.08536744377697847, + "weight": 1.0 + }, + { + "marker_id": 114, + "q_i": 0.06536288644387427, + "weight": 1.0 + }, + { + "marker_id": 115, + "q_i": 0.06584584733398412, + "weight": 1.0 + }, + { + "marker_id": 219, + "q_i": 0.06859098664729026, + "weight": 1.0 + } + ] + } + }, + { + "link": "Arm1", + "joint_variable": "y", + "joint_type": "revolute", + "old": -0.005988379220400297, + "new": -0.29835134583617284, + "info": { + "reason": "2d_alignment+normal_tiebreak", + "used_markers": 11, + "axis_world": [ + -0.999999999999, + 4.159994960806995e-12, + 6.2896614796977955e-12 + ], + "axis_id": 0, + "theta_rad": -0.29835134583617295, + "theta_alt_rad": 2.8432413077536207, + "score_theta": 0.43506047999989095, + "score_theta_alt": 3.7886153508197684, + "best_score": 0.43506047999989095, + "per_marker": [ + { + "marker_id": 198, + "weight": 1.0 + }, + { + "marker_id": 229, + "weight": 1.0 + }, + { + "marker_id": 243, + "weight": 1.0 + }, + { + "marker_id": 244, + "weight": 1.0 + }, + { + "marker_id": 245, + "weight": 1.0 + }, + { + "marker_id": 248, + "weight": 1.0 + }, + { + "marker_id": 232, + "weight": 1.0 + }, + { + "marker_id": 120, + "weight": 1.0 + }, + { + "marker_id": 114, + "weight": 1.0 + }, + { + "marker_id": 115, + "weight": 1.0 + }, + { + "marker_id": 219, + "weight": 1.0 + } + ] + } + }, + { + "link": "Ellbow", + "joint_variable": "z", + "joint_type": "revolute", + "old": 0.300637467901522, + "new": 1.3173030739583105, + "info": { + "reason": "2d_alignment+normal_tiebreak", + "used_markers": 7, + "axis_world": [ + -0.999999999999, + 4.159994960806995e-12, + 6.2896614796977955e-12 + ], + "axis_id": 0, + "theta_rad": -1.8242895796314826, + "theta_alt_rad": 1.3173030739583105, + "score_theta": 1.0091347498396188, + "score_theta_alt": 0.15456079382866375, + "best_score": 0.15456079382866375, + "per_marker": [ + { + "marker_id": 245, + "weight": 1.0 + }, + { + "marker_id": 248, + "weight": 1.0 + }, + { + "marker_id": 232, + "weight": 1.0 + }, + { + "marker_id": 120, + "weight": 1.0 + }, + { + "marker_id": 114, + "weight": 1.0 + }, + { + "marker_id": 115, + "weight": 1.0 + }, + { + "marker_id": 219, + "weight": 1.0 + } + ] + } + }, + { + "link": "Arm2", + "joint_variable": "a", + "joint_type": "revolute", + "old": 0.0, + "new": -1.6097630385299437, + "info": { + "reason": "2d_alignment+normal_tiebreak", + "used_markers": 4, + "axis_world": [ + 3.175236854690882e-12, + -0.5242589043967605, + 0.8515589240673298 + ], + "axis_id": 2, + "theta_rad": 1.5318296150598492, + "theta_alt_rad": -1.6097630385299437, + "score_theta": 0.2294231965569743, + "score_theta_alt": 0.22660849749875595, + "best_score": 0.22660849749875595, + "per_marker": [ + { + "marker_id": 120, + "weight": 1.0 + }, + { + "marker_id": 114, + "weight": 1.0 + }, + { + "marker_id": 115, + "weight": 1.0 + }, + { + "marker_id": 219, + "weight": 1.0 + } + ] + } + } + ] + }, + { + "pass": 1, + "updates": [ + { + "link": "Base", + "joint_variable": "x", + "joint_type": "linear", + "old": 0.05247360179780933, + "new": 0.06486190254557143, + "info": { + "reason": "weighted_projection", + "used_markers": 11, + "axis_world": [ + 0.999999999999, + -4.159994960806995e-12, + -6.2896614796977955e-12 + ], + "per_marker": [ + { + "marker_id": 198, + "q_i": 0.04215306388565592, + "weight": 1.0 + }, + { + "marker_id": 229, + "q_i": 0.050016712643665875, + "weight": 1.0 + }, + { + "marker_id": 243, + "q_i": 0.05002569090612775, + "weight": 1.0 + }, + { + "marker_id": 244, + "q_i": 0.04214634853130096, + "weight": 1.0 + }, + { + "marker_id": 245, + "q_i": 0.030791722048852166, + "weight": 1.0 + }, + { + "marker_id": 248, + "q_i": 0.046615767905670416, + "weight": 1.0 + }, + { + "marker_id": 232, + "q_i": 0.03029314965303771, + "weight": 1.0 + }, + { + "marker_id": 120, + "q_i": 0.1358128379663865, + "weight": 1.0 + }, + { + "marker_id": 114, + "q_i": 0.11580828063328229, + "weight": 1.0 + }, + { + "marker_id": 115, + "q_i": 0.06486287738519957, + "weight": 1.0 + }, + { + "marker_id": 219, + "q_i": 0.10495447644210663, + "weight": 1.0 + } + ] + } + }, + { + "link": "Arm1", + "joint_variable": "y", + "joint_type": "revolute", + "old": -0.29835134583617284, + "new": -0.03441461692845893, + "info": { + "reason": "2d_alignment+normal_tiebreak", + "used_markers": 11, + "axis_world": [ + -0.999999999999, + 4.159994960806995e-12, + 6.2896614796977955e-12 + ], + "axis_id": 0, + "theta_rad": -0.03441461692845875, + "theta_alt_rad": 3.1071780366613346, + "score_theta": 0.03807196717973041, + "score_theta_alt": 3.833508722389345, + "best_score": 0.03807196717973041, + "per_marker": [ + { + "marker_id": 198, + "weight": 1.0 + }, + { + "marker_id": 229, + "weight": 1.0 + }, + { + "marker_id": 243, + "weight": 1.0 + }, + { + "marker_id": 244, + "weight": 1.0 + }, + { + "marker_id": 245, + "weight": 1.0 + }, + { + "marker_id": 248, + "weight": 1.0 + }, + { + "marker_id": 232, + "weight": 1.0 + }, + { + "marker_id": 120, + "weight": 1.0 + }, + { + "marker_id": 114, + "weight": 1.0 + }, + { + "marker_id": 115, + "weight": 1.0 + }, + { + "marker_id": 219, + "weight": 1.0 + } + ] + } + }, + { + "link": "Ellbow", + "joint_variable": "z", + "joint_type": "revolute", + "old": 1.3173030739583105, + "new": 1.6373501899522545, + "info": { + "reason": "2d_alignment+normal_tiebreak", + "used_markers": 7, + "axis_world": [ + -0.999999999999, + 4.159994960806995e-12, + 6.289661479697795e-12 + ], + "axis_id": 0, + "theta_rad": -1.5042424636375389, + "theta_alt_rad": 1.6373501899522545, + "score_theta": 0.7726212125154331, + "score_theta_alt": 0.1532917446839981, + "best_score": 0.1532917446839981, + "per_marker": [ + { + "marker_id": 245, + "weight": 1.0 + }, + { + "marker_id": 248, + "weight": 1.0 + }, + { + "marker_id": 232, + "weight": 1.0 + }, + { + "marker_id": 120, + "weight": 1.0 + }, + { + "marker_id": 114, + "weight": 1.0 + }, + { + "marker_id": 115, + "weight": 1.0 + }, + { + "marker_id": 219, + "weight": 1.0 + } + ] + } + }, + { + "link": "Arm2", + "joint_variable": "a", + "joint_type": "revolute", + "old": -1.6097630385299437, + "new": -0.233503919420174, + "info": { + "reason": "2d_alignment+normal_tiebreak", + "used_markers": 4, + "axis_world": [ + 6.4200855388270645e-12, + 0.0321337135889287, + 0.9994835788791053 + ], + "axis_id": 2, + "theta_rad": -0.23350391942017407, + "theta_alt_rad": 2.9080887341696187, + "score_theta": 0.16068959559440205, + "score_theta_alt": 0.18560868796633004, + "best_score": 0.16068959559440205, + "per_marker": [ + { + "marker_id": 120, + "weight": 1.0 + }, + { + "marker_id": 114, + "weight": 1.0 + }, + { + "marker_id": 115, + "weight": 1.0 + }, + { + "marker_id": 219, + "weight": 1.0 + } + ] + } + } + ] + } + ], + "root_link": "Board", + "root_pose": { + "reason": "kabsch", + "used_markers": [ + 210, + 211, + 215, + 214, + 208, + 206, + 205, + 207, + 217, + 46, + 47, + 51, + 53, + 54, + 55, + 56, + 58, + 60, + 61, + 62, + 63, + 64, + 66, + 68, + 69, + 72, + 73, + 75, + 79, + 82, + 83, + 84, + 85, + 86, + 92, + 95, + 96, + 97, + 102, + 103, + 105 + ] + }, + "marker_stats": { + "num_markers_used": 52, + "mean_error_m": 0.00798437160585144, + "rms_error_m": 0.02087664895645978, + "median_error_m": 2.167420112265552e-11, + "worst_error_m": 0.08230794645058914 + }, + "marker_reports": [ + { + "marker_id": 46, + "link": "Board", + "error_m": [ + -7.492451103985331e-12, + 2.481931327125153e-12, + 1.8023398745681263e-11 + ], + "error_norm_m": 1.9675866156385624e-11, + "predicted_m": [ + 0.5367100000003043, + 0.18544000001341324, + -0.027299999971809288 + ], + "observed_m": [ + 0.5367100000077968, + 0.1854400000109313, + -0.027299999989832686 + ] + }, + { + "marker_id": 47, + "link": "Board", + "error_m": [ + -2.808198118486871e-12, + -4.1244785364824565e-14, + -1.1091960683273783e-12 + ], + "error_norm_m": 3.01960158348513e-12, + "predicted_m": [ + 0.3442299999983411, + -0.286539999985786, + -0.02729999996479229 + ], + "observed_m": [ + 0.3442300000011493, + -0.28653999998574475, + -0.027299999963683094 + ] + }, + { + "marker_id": 51, + "link": "Board", + "error_m": [ + 4.554245869314855e-12, + 3.824357497350661e-12, + 1.3658119774051514e-11 + ], + "error_norm_m": 1.4896680887635694e-11, + "predicted_m": [ + 0.1677999999988172, + -0.17207999998505205, + -0.027299999965090707 + ], + "observed_m": [ + 0.16779999999426295, + -0.1720799999888764, + -0.027299999978748827 + ] + }, + { + "marker_id": 53, + "link": "Board", + "error_m": [ + -8.481271240867727e-12, + -6.852129974532772e-12, + -3.998516795444829e-12 + ], + "error_norm_m": 1.1613431173107923e-11, + "predicted_m": [ + 0.4862500000004158, + 0.21224000001362317, + -0.02729999997182161 + ], + "observed_m": [ + 0.48625000000889707, + 0.2122400000204753, + -0.027299999967823094 + ] + }, + { + "marker_id": 54, + "link": "Board", + "error_m": [ + -4.072464587778768e-12, + 1.8295309711646723e-11, + 3.2714810027645314e-11 + ], + "error_norm_m": 3.770360885125865e-11, + "predicted_m": [ + 0.34226999999815777, + -0.3305899999857778, + -0.027299999964238052 + ], + "observed_m": [ + 0.34227000000223023, + -0.3305900000040731, + -0.027299999996952862 + ] + }, + { + "marker_id": 55, + "link": "Board", + "error_m": [ + 3.742617327162634e-12, + 1.3011647315153141e-11, + 1.1736767807635218e-11 + ], + "error_norm_m": 1.7918199376105074e-11, + "predicted_m": [ + 0.2837199999984407, + -0.2625799999855342, + -0.02729999996470646 + ], + "observed_m": [ + 0.2837199999946981, + -0.26257999999854587, + -0.027299999976443227 + ] + }, + { + "marker_id": 56, + "link": "Board", + "error_m": [ + -5.746902953518429e-12, + 8.329253953220928e-12, + 2.4135290987992164e-11 + ], + "error_norm_m": 2.617089291654874e-11, + "predicted_m": [ + 0.49868000000023455, + 0.16867000001357144, + -0.027299999971363786 + ], + "observed_m": [ + 0.49868000000598145, + 0.16867000000524218, + -0.027299999995499077 + ] + }, + { + "marker_id": 58, + "link": "Board", + "error_m": [ + 1.362971541185587e-11, + -8.114897642741425e-13, + -2.814398020190012e-12 + ], + "error_norm_m": 1.3940892871755114e-11, + "predicted_m": [ + 0.050089999998625734, + -0.2181099999845624, + -0.027299999963784082 + ], + "observed_m": [ + 0.05008999998499602, + -0.2181099999837509, + -0.027299999960969684 + ] + }, + { + "marker_id": 60, + "link": "Board", + "error_m": [ + 2.7249313916399842e-12, + 4.138134279685346e-12, + 6.636580174301798e-12 + ], + "error_norm_m": 8.282125501088937e-12, + "predicted_m": [ + 0.4343600000007135, + 0.283810000013839, + -0.027299999972375703 + ], + "observed_m": [ + 0.4343599999979886, + 0.28381000000970086, + -0.027299999979012283 + ] + }, + { + "marker_id": 61, + "link": "Board", + "error_m": [ + 7.948190716700054e-13, + 1.7347789871280384e-12, + 1.191001117173407e-11 + ], + "error_norm_m": 1.2061905388523891e-11, + "predicted_m": [ + -0.022419999999070003, + 0.3358300000157392, + -0.027299999970142666 + ], + "observed_m": [ + -0.022419999999864822, + 0.3358300000140044, + -0.027299999982052677 + ] + }, + { + "marker_id": 62, + "link": "Board", + "error_m": [ + -2.4700796963372795e-12, + -8.548578511735627e-12, + -5.269056024825858e-12 + ], + "error_norm_m": 1.034129777495646e-11, + "predicted_m": [ + 0.40469999999880457, + -0.17509999998603754, + -0.027299999966543573 + ], + "observed_m": [ + 0.40470000000127465, + -0.17509999997748896, + -0.027299999961274517 + ] + }, + { + "marker_id": 63, + "link": "Board", + "error_m": [ + -1.1200040894721042e-11, + 8.238909554592055e-12, + 2.2577033992332574e-11 + ], + "error_norm_m": 2.6514958242152908e-11, + "predicted_m": [ + 0.7773999999985505, + -0.23614999998758798, + -0.027299999968136684 + ], + "observed_m": [ + 0.7774000000097505, + -0.2361499999958269, + -0.027299999990713718 + ] + }, + { + "marker_id": 64, + "link": "Board", + "error_m": [ + 1.84363670163723e-11, + -6.230571614196379e-13, + -1.6239929540029507e-11 + ], + "error_norm_m": 2.4576882236237772e-11, + "predicted_m": [ + -0.021270000001249956, + -0.18822999998426548, + -0.027299999963702838 + ], + "observed_m": [ + -0.021270000019686323, + -0.18822999998364243, + -0.02729999994746291 + ] + }, + { + "marker_id": 66, + "link": "Board", + "error_m": [ + 4.856171020861666e-12, + 1.5180134926850997e-11, + 1.298113699865766e-11 + ], + "error_norm_m": 2.0555505616724123e-11, + "predicted_m": [ + 0.20974999999802202, + -0.3632299999852266, + -0.027299999963003002 + ], + "observed_m": [ + 0.20974999999316585, + -0.3632300000004067, + -0.02729999997598414 + ] + }, + { + "marker_id": 68, + "link": "Board", + "error_m": [ + -7.462697126925377e-12, + 7.419731495872384e-12, + 1.9388258359898103e-11 + ], + "error_norm_m": 2.206011845184018e-11, + "predicted_m": [ + 0.5737300000002428, + 0.1706400000132592, + -0.02729999997186006 + ], + "observed_m": [ + 0.5737300000077055, + 0.17064000000583948, + -0.027299999991248318 + ] + }, + { + "marker_id": 69, + "link": "Board", + "error_m": [ + 5.317673384963584e-12, + 1.587674436365205e-11, + 1.8516677774416124e-11 + ], + "error_norm_m": 2.496429485524202e-11, + "predicted_m": [ + 0.0076099999983632646, + -0.28120999998438556, + -0.027299999962740632 + ], + "observed_m": [ + 0.007609999993045591, + -0.2812100000002623, + -0.02729999998125731 + ] + }, + { + "marker_id": 72, + "link": "Board", + "error_m": [ + 2.4560353750757713e-12, + -1.1806666755376227e-11, + -2.427206352573208e-11 + ], + "error_norm_m": 2.7102814566633174e-11, + "predicted_m": [ + 0.4409900000003412, + 0.19432000001381142, + -0.027299999971316484 + ], + "observed_m": [ + 0.4409899999978852, + 0.19432000002561808, + -0.02729999994704442 + ] + }, + { + "marker_id": 73, + "link": "Board", + "error_m": [ + 3.658018332686197e-12, + 3.5590419500408643e-12, + 1.981933714367834e-11 + ], + "error_norm_m": 2.0465922958401042e-11, + "predicted_m": [ + 0.2217300000009186, + 0.3331100000147235, + -0.02729999997164483 + ], + "observed_m": [ + 0.2217299999972606, + 0.3331100000111645, + -0.027299999991464166 + ] + }, + { + "marker_id": 75, + "link": "Board", + "error_m": [ + -5.778051648253069e-13, + 1.607880495413383e-13, + 1.3468715726050462e-11 + ], + "error_norm_m": 1.3482062709931783e-11, + "predicted_m": [ + -0.02569999999965756, + 0.19458000001575287, + -0.02729999996838436 + ], + "observed_m": [ + -0.025699999999079754, + 0.1945800000155921, + -0.027299999981853076 + ] + }, + { + "marker_id": 79, + "link": "Board", + "error_m": [ + -3.1583624604536453e-12, + -1.0718703702394805e-11, + -5.22700632776818e-12 + ], + "error_norm_m": 1.2336428074684484e-11, + "predicted_m": [ + 0.31229999999887115, + -0.1591099999856532, + -0.027299999966159123 + ], + "observed_m": [ + 0.3123000000020295, + -0.1591099999749345, + -0.027299999960932117 + ] + }, + { + "marker_id": 82, + "link": "Board", + "error_m": [ + 3.25389715172264e-12, + 3.2570057761915905e-12, + 2.040070196107635e-11 + ], + "error_norm_m": 2.0913741267520705e-11, + "predicted_m": [ + 0.21916000000076943, + 0.2972400000147342, + -0.027299999971187386 + ], + "observed_m": [ + 0.21915999999751554, + 0.2972400000114772, + -0.027299999991588088 + ] + }, + { + "marker_id": 83, + "link": "Board", + "error_m": [ + 3.413068438984368e-12, + -3.2620017798024037e-12, + 8.674616580606198e-12 + ], + "error_norm_m": 9.876166493187182e-12, + "predicted_m": [ + 0.04416000000094408, + 0.33922000001546226, + -0.027299999970603138 + ], + "observed_m": [ + 0.044159999997531015, + 0.33922000001872427, + -0.027299999979277755 + ] + }, + { + "marker_id": 84, + "link": "Board", + "error_m": [ + -1.7622014958362797e-12, + -1.0630718527693261e-11, + -2.532580048453248e-11 + ], + "error_norm_m": 2.7522966786109995e-11, + "predicted_m": [ + 0.4074900000006079, + 0.2584200000139508, + -0.027299999971894348 + ], + "observed_m": [ + 0.4074900000023701, + 0.25842000002458154, + -0.027299999946568548 + ] + }, + { + "marker_id": 85, + "link": "Board", + "error_m": [ + -5.510480960424502e-12, + 8.785194793858864e-13, + -1.0186799320743845e-11 + ], + "error_norm_m": 1.1614993641494972e-11, + "predicted_m": [ + 0.5045799999982319, + -0.31274999998645303, + -0.027299999965478397 + ], + "observed_m": [ + 0.5045800000037424, + -0.31274999998733155, + -0.027299999955291598 + ] + }, + { + "marker_id": 86, + "link": "Board", + "error_m": [ + 6.267764085521321e-13, + -8.959277764120088e-12, + -2.3645124053173205e-11 + ], + "error_norm_m": 2.529334691595646e-11, + "predicted_m": [ + 0.36289000000074767, + 0.2920100000141363, + -0.027299999972027058 + ], + "observed_m": [ + 0.3628900000001209, + 0.2920100000230956, + -0.027299999948381934 + ] + }, + { + "marker_id": 92, + "link": "Board", + "error_m": [ + -7.592926287713908e-12, + -6.8706706990440125e-12, + -1.869756433015013e-11 + ], + "error_norm_m": 2.1318010163837087e-11, + "predicted_m": [ + 0.645089999998764, + -0.18483999998703757, + -0.027299999967935723 + ], + "observed_m": [ + 0.645090000006357, + -0.1848399999801669, + -0.02729999994923816 + ] + }, + { + "marker_id": 95, + "link": "Board", + "error_m": [ + 4.54983273279197e-12, + 1.4976297979529818e-11, + 1.4302153211742663e-11 + ], + "error_norm_m": 2.120240706995824e-11, + "predicted_m": [ + 0.18603999999839294, + -0.2740699999851279, + -0.027299999963950734 + ], + "observed_m": [ + 0.1860399999938431, + -0.2740700000001042, + -0.027299999978252887 + ] + }, + { + "marker_id": 96, + "link": "Board", + "error_m": [ + -2.616351579831644e-12, + -8.76451689002522e-12, + -5.525052637622707e-12 + ], + "error_norm_m": 1.0685890629859849e-11, + "predicted_m": [ + 0.3697699999987572, + -0.18648999998589225, + -0.027299999966183753 + ], + "observed_m": [ + 0.36977000000137356, + -0.18648999997712773, + -0.0272999999606587 + ] + }, + { + "marker_id": 97, + "link": "Board", + "error_m": [ + 5.4089510648225314e-12, + 1.4107326418155708e-11, + 9.479118878719106e-12 + ], + "error_norm_m": 1.7836117991506104e-11, + "predicted_m": [ + 0.30434999999803686, + -0.3596699999856201, + -0.0272999999636418 + ], + "observed_m": [ + 0.3043499999926279, + -0.35966999999972743, + -0.02729999997312092 + ] + }, + { + "marker_id": 102, + "link": "Board", + "error_m": [ + -1.7663870366391166e-11, + 3.3410219035800992e-12, + 1.2036656393821232e-11 + ], + "error_norm_m": 2.1634598235784078e-11, + "predicted_m": [ + 0.6496899999986053, + -0.2229999999870567, + -0.027299999967495204 + ], + "observed_m": [ + 0.6496900000162692, + -0.2229999999903977, + -0.02729999997953186 + ] + }, + { + "marker_id": 103, + "link": "Board", + "error_m": [ + 1.6292495130798557e-11, + -5.307781991703564e-12, + -1.967232626798321e-11 + ], + "error_norm_m": 2.608866359268963e-11, + "predicted_m": [ + 0.10570999999875218, + -0.18770999998479376, + -0.0272999999645079 + ], + "observed_m": [ + 0.10570999998245968, + -0.18770999997948598, + -0.027299999944835573 + ] + }, + { + "marker_id": 105, + "link": "Board", + "error_m": [ + -4.240385820253323e-12, + 2.274458399398327e-12, + -1.1591214099659908e-11 + ], + "error_norm_m": 1.2550309845551769e-11, + "predicted_m": [ + 0.5248399999984255, + -0.2662499999865373, + -0.027299999966177872 + ], + "observed_m": [ + 0.5248400000026658, + -0.26624999998881177, + -0.027299999954586658 + ] + }, + { + "marker_id": 114, + "link": "Arm2", + "error_m": [ + -0.006899506382223641, + 0.010076769394468166, + -0.011847254252175726 + ], + "error_norm_m": 0.01701475545117622, + "predicted_m": [ + 0.28321338006223307, + -0.1657934128862424, + 0.23526180622734172 + ], + "observed_m": [ + 0.2901128864444567, + -0.17587018228071055, + 0.24710906047951745 + ] + }, + { + "marker_id": 115, + "link": "Arm2", + "error_m": [ + -0.006039116705025299, + 0.014628865239019573, + -0.012630937781018148 + ], + "error_norm_m": 0.0202488325092155, + "predicted_m": [ + 0.2350567306295775, + -0.15434563341586477, + 0.23489375649226382 + ], + "observed_m": [ + 0.2410958473346028, + -0.16897449865488434, + 0.24752469427328197 + ] + }, + { + "marker_id": 120, + "link": "Arm2", + "error_m": [ + -0.02690406371532056, + 0.06142880769521919, + -0.041473895959155765 + ], + "error_norm_m": 0.07885056185776437, + "predicted_m": [ + 0.28321338006178365, + -0.16804277283746732, + 0.1652979557058079 + ], + "observed_m": [ + 0.3101174437771042, + -0.22947158053268651, + 0.20677185166496367 + ] + }, + { + "marker_id": 198, + "link": "Arm1", + "error_m": [ + 0.022708838659736053, + 0.0004135031049745594, + -0.011784675524587618 + ], + "error_norm_m": 0.02558790564527626, + "predicted_m": [ + 0.17486190254555936, + -0.05310953390892011, + 0.09047402382345351 + ], + "observed_m": [ + 0.1521530638858233, + -0.05352303701389467, + 0.10225869934804113 + ] + }, + { + "marker_id": 205, + "link": "Board", + "error_m": [ + -1.0751399770470016e-11, + 7.604930574167668e-12, + 1.9853566219415336e-11 + ], + "error_norm_m": 2.3824182204035516e-11, + "predicted_m": [ + 0.749999999999332, + -0.08999999998713447, + 0.00030000003023770137 + ], + "observed_m": [ + 0.7500000000100834, + -0.0899999999947394, + 0.00030000001038413515 + ] + }, + { + "marker_id": 206, + "link": "Board", + "error_m": [ + -3.6561864646955655e-12, + -7.083960154585789e-12, + -1.29144830680189e-11 + ], + "error_norm_m": 1.5176760650762372e-11, + "predicted_m": [ + 0.649999999999665, + -0.009999999986718484, + 0.000300000029882496 + ], + "observed_m": [ + 0.6500000000033211, + -0.009999999979634524, + 0.00030000004279697904 + ] + }, + { + "marker_id": 207, + "link": "Board", + "error_m": [ + -9.957923374770417e-12, + 2.8038144722630776e-12, + 1.2247119984820642e-11 + ], + "error_norm_m": 1.6031642506470262e-11, + "predicted_m": [ + 0.7499999999996648, + -0.009999999987134484, + 0.0003000000292535298 + ], + "observed_m": [ + 0.7500000000096227, + -0.009999999989938299, + 0.0003000000170064098 + ] + }, + { + "marker_id": 208, + "link": "Board", + "error_m": [ + 5.507538869409245e-12, + -2.732553072704036e-11, + -4.7252488759915584e-11 + ], + "error_norm_m": 5.4861783674233825e-11, + "predicted_m": [ + 0.34999999999933223, + -0.08999999998547048, + 0.000300000032753566 + ], + "observed_m": [ + 0.3499999999938247, + -0.08999999995814495, + 0.00030000008000605476 + ] + }, + { + "marker_id": 210, + "link": "Board", + "error_m": [ + 4.405288633879678e-12, + -1.7787275125025204e-11, + -1.6451536801690564e-11 + ], + "error_norm_m": 2.462614032808448e-11, + "predicted_m": [ + 0.019999999999623427, + -0.019999999984097686, + 0.0003000000339680041 + ], + "observed_m": [ + 0.019999999995218138, + -0.01999999996631041, + 0.0003000000504195409 + ] + }, + { + "marker_id": 211, + "link": "Board", + "error_m": [ + 1.1146833456265881e-11, + 8.425985603688346e-13, + -1.3026511672727809e-11 + ], + "error_norm_m": 1.7165426729195456e-11, + "predicted_m": [ + 0.24999999999966496, + -0.009999999985054487, + 0.00030000003239836055 + ], + "observed_m": [ + 0.24999999998851813, + -0.009999999985897085, + 0.0003000000454248722 + ] + }, + { + "marker_id": 214, + "link": "Board", + "error_m": [ + 1.1624867735093858e-11, + -2.41929844213562e-11, + -5.461947062170014e-11 + ], + "error_norm_m": 6.085823375735755e-11, + "predicted_m": [ + 0.349999999999665, + -0.009999999985470485, + 0.00030000003176939443 + ], + "observed_m": [ + 0.34999999998804016, + -0.009999999961277501, + 0.00030000008638886506 + ] + }, + { + "marker_id": 215, + "link": "Board", + "error_m": [ + 5.437317263101704e-14, + 1.431470220136788e-11, + 1.3618144643640778e-11 + ], + "error_norm_m": 1.9757720493287436e-11, + "predicted_m": [ + 0.2499999999993322, + -0.08999999998505448, + 0.0003000000333825321 + ], + "observed_m": [ + 0.24999999999927783, + -0.08999999999936918, + 0.0003000000197643875 + ] + }, + { + "marker_id": 217, + "link": "Board", + "error_m": [ + -9.231837516665564e-12, + -7.064640539233835e-12, + -1.833993769568068e-11 + ], + "error_norm_m": 2.171380400952696e-11, + "predicted_m": [ + 0.6499999999993321, + -0.08999999998671848, + 0.00030000003086666754 + ], + "observed_m": [ + 0.650000000008564, + -0.08999999997965384, + 0.00030000004920660524 + ] + }, + { + "marker_id": 219, + "link": "Arm2", + "error_m": [ + -0.0046789279375352155, + 0.007321482128671453, + -0.010885416143457505 + ], + "error_norm_m": 0.01392798448524941, + "predicted_m": [ + 0.2989120587106686, + -0.14290907511183393, + 0.2715451849745724 + ], + "observed_m": [ + 0.30359098664820383, + -0.15023055724050538, + 0.2824306011180299 + ] + }, + { + "marker_id": 229, + "link": "Arm1", + "error_m": [ + 0.014845189901723455, + 2.501830715903597e-05, + -0.010699397003577152 + ], + "error_norm_m": 0.01829910886830506, + "predicted_m": [ + 0.17486190254516573, + -0.1430562427053349, + 0.08737731965725702 + ], + "observed_m": [ + 0.16001671264344228, + -0.14308126101249394, + 0.09807671666083417 + ] + }, + { + "marker_id": 232, + "link": "Ellbow", + "error_m": [ + 0.03456875289209996, + -0.07462149731828922, + 0.0033513445621921253 + ], + "error_norm_m": 0.08230794645058914, + "predicted_m": [ + 0.26486190254450187, + -0.16738449685188347, + 0.02845613484770879 + ], + "observed_m": [ + 0.2302931496524019, + -0.09276299953359425, + 0.025104790285516664 + ] + }, + { + "marker_id": 243, + "link": "Arm1", + "error_m": [ + 0.01483621163926177, + -8.720653028029823e-05, + -0.010594913495220584 + ], + "error_norm_m": 0.018231099055051433, + "predicted_m": [ + 0.17486190254479766, + -0.17683124450597534, + 0.05119377017179706 + ], + "observed_m": [ + 0.1600256909055359, + -0.17674403797569505, + 0.061788683667017646 + ] + }, + { + "marker_id": 244, + "link": "Ellbow", + "error_m": [ + 0.02271555401400066, + -0.02437745393613594, + 0.0011247523270494011 + ], + "error_norm_m": 0.033339491933270585, + "predicted_m": [ + 0.2998619025446839, + -0.14185196886344514, + 0.05239804401342061 + ], + "observed_m": [ + 0.27714634853068326, + -0.1174745149273092, + 0.05127329168637121 + ] + }, + { + "marker_id": 245, + "link": "Ellbow", + "error_m": [ + 0.03407018049645308, + -0.05877670126567372, + 0.01959715695493651 + ], + "error_norm_m": 0.07070732897975682, + "predicted_m": [ + 0.2648619025446202, + -0.17683389412406836, + 0.05352272398925326 + ], + "observed_m": [ + 0.23079172204816714, + -0.11805719285839464, + 0.03392556703431675 + ] + }, + { + "marker_id": 248, + "link": "Ellbow", + "error_m": [ + 0.018246134639671507, + -0.031157074013078073, + 0.006416653426022836 + ], + "error_norm_m": 0.03667230742038379, + "predicted_m": [ + 0.22736190254470023, + -0.17683389412391234, + 0.05352272398948912 + ], + "observed_m": [ + 0.20911576790502873, + -0.14567682011083427, + 0.04710607056346628 + ] + } + ], + "stage_idx": 2, + "num_active_links": 5 + } + ], + "markers": [ + { + "marker_id": 41, + "link": "FingerA", + "observed_position_m": [ + 0.26049994994694153, + -0.14324310886235672, + 0.35571921201351653 + ], + "predicted_position_m": [ + 0.27618244572641526, + -0.10880827449798669, + 0.33868407155356267 + ], + "error_m": [ + 0.015682495779473726, + 0.03443483436437003, + -0.017035140459953857 + ], + "error_norm_m": 0.04149571667130437 + }, + { + "marker_id": 42, + "link": "FingerA", + "observed_position_m": [ + 0.2914570734278023, + -0.1791573770727779, + 0.3559675345931372 + ], + "predicted_position_m": [ + 0.2822761252709772, + -0.13554821401800451, + 0.37736329988181616 + ], + "error_m": [ + -0.00918094815682513, + 0.04360916305477339, + 0.02139576528867898 + ], + "error_norm_m": 0.04943508555352528 + }, + { + "marker_id": 43, + "link": "FingerB", + "observed_position_m": [ + 0.24503062780924573, + -0.175407589501069, + 0.35619521772355545 + ], + "predicted_position_m": [ + 0.253252847664283, + -0.1115950167172474, + 0.3605849299958504 + ], + "error_m": [ + 0.008222219855037294, + 0.06381257278382159, + 0.004389712272294954 + ], + "error_norm_m": 0.06448968071303063 + }, + { + "marker_id": 44, + "link": "FingerB", + "observed_position_m": [ + 0.2617374343976593, + -0.17309017509552857, + 0.3103807151154557 + ], + "predicted_position_m": [ + 0.2535413593667897, + -0.15643805814313272, + 0.3402153841818477 + ], + "error_m": [ + -0.00819607503086961, + 0.01665211695239585, + 0.02983466906639204 + ], + "error_norm_m": 0.035136535446868455 + }, + { + "marker_id": 46, + "link": "Board", + "observed_position_m": [ + 0.5367100000077968, + 0.1854400000109313, + -0.027299999989832686 + ], + "predicted_position_m": [ + 0.5367100000003043, + 0.18544000001341324, + -0.027299999971809288 + ], + "error_m": [ + -7.492451103985331e-12, + 2.481931327125153e-12, + 1.8023398745681263e-11 + ], + "error_norm_m": 1.9675866156385624e-11 + }, + { + "marker_id": 47, + "link": "Board", + "observed_position_m": [ + 0.3442300000011493, + -0.28653999998574475, + -0.027299999963683094 + ], + "predicted_position_m": [ + 0.3442299999983411, + -0.286539999985786, + -0.02729999996479229 + ], + "error_m": [ + -2.808198118486871e-12, + -4.1244785364824565e-14, + -1.1091960683273783e-12 + ], + "error_norm_m": 3.01960158348513e-12 + }, + { + "marker_id": 51, + "link": "Board", + "observed_position_m": [ + 0.16779999999426295, + -0.1720799999888764, + -0.027299999978748827 + ], + "predicted_position_m": [ + 0.1677999999988172, + -0.17207999998505205, + -0.027299999965090707 + ], + "error_m": [ + 4.554245869314855e-12, + 3.824357497350661e-12, + 1.3658119774051514e-11 + ], + "error_norm_m": 1.4896680887635694e-11 + }, + { + "marker_id": 53, + "link": "Board", + "observed_position_m": [ + 0.48625000000889707, + 0.2122400000204753, + -0.027299999967823094 + ], + "predicted_position_m": [ + 0.4862500000004158, + 0.21224000001362317, + -0.02729999997182161 + ], + "error_m": [ + -8.481271240867727e-12, + -6.852129974532772e-12, + -3.998516795444829e-12 + ], + "error_norm_m": 1.1613431173107923e-11 + }, + { + "marker_id": 54, + "link": "Board", + "observed_position_m": [ + 0.34227000000223023, + -0.3305900000040731, + -0.027299999996952862 + ], + "predicted_position_m": [ + 0.34226999999815777, + -0.3305899999857778, + -0.027299999964238052 + ], + "error_m": [ + -4.072464587778768e-12, + 1.8295309711646723e-11, + 3.2714810027645314e-11 + ], + "error_norm_m": 3.770360885125865e-11 + }, + { + "marker_id": 55, + "link": "Board", + "observed_position_m": [ + 0.2837199999946981, + -0.26257999999854587, + -0.027299999976443227 + ], + "predicted_position_m": [ + 0.2837199999984407, + -0.2625799999855342, + -0.02729999996470646 + ], + "error_m": [ + 3.742617327162634e-12, + 1.3011647315153141e-11, + 1.1736767807635218e-11 + ], + "error_norm_m": 1.7918199376105074e-11 + }, + { + "marker_id": 56, + "link": "Board", + "observed_position_m": [ + 0.49868000000598145, + 0.16867000000524218, + -0.027299999995499077 + ], + "predicted_position_m": [ + 0.49868000000023455, + 0.16867000001357144, + -0.027299999971363786 + ], + "error_m": [ + -5.746902953518429e-12, + 8.329253953220928e-12, + 2.4135290987992164e-11 + ], + "error_norm_m": 2.617089291654874e-11 + }, + { + "marker_id": 58, + "link": "Board", + "observed_position_m": [ + 0.05008999998499602, + -0.2181099999837509, + -0.027299999960969684 + ], + "predicted_position_m": [ + 0.050089999998625734, + -0.2181099999845624, + -0.027299999963784082 + ], + "error_m": [ + 1.362971541185587e-11, + -8.114897642741425e-13, + -2.814398020190012e-12 + ], + "error_norm_m": 1.3940892871755114e-11 + }, + { + "marker_id": 60, + "link": "Board", + "observed_position_m": [ + 0.4343599999979886, + 0.28381000000970086, + -0.027299999979012283 + ], + "predicted_position_m": [ + 0.4343600000007135, + 0.283810000013839, + -0.027299999972375703 + ], + "error_m": [ + 2.7249313916399842e-12, + 4.138134279685346e-12, + 6.636580174301798e-12 + ], + "error_norm_m": 8.282125501088937e-12 + }, + { + "marker_id": 61, + "link": "Board", + "observed_position_m": [ + -0.022419999999864822, + 0.3358300000140044, + -0.027299999982052677 + ], + "predicted_position_m": [ + -0.022419999999070003, + 0.3358300000157392, + -0.027299999970142666 + ], + "error_m": [ + 7.948190716700054e-13, + 1.7347789871280384e-12, + 1.191001117173407e-11 + ], + "error_norm_m": 1.2061905388523891e-11 + }, + { + "marker_id": 62, + "link": "Board", + "observed_position_m": [ + 0.40470000000127465, + -0.17509999997748896, + -0.027299999961274517 + ], + "predicted_position_m": [ + 0.40469999999880457, + -0.17509999998603754, + -0.027299999966543573 + ], + "error_m": [ + -2.4700796963372795e-12, + -8.548578511735627e-12, + -5.269056024825858e-12 + ], + "error_norm_m": 1.034129777495646e-11 + }, + { + "marker_id": 63, + "link": "Board", + "observed_position_m": [ + 0.7774000000097505, + -0.2361499999958269, + -0.027299999990713718 + ], + "predicted_position_m": [ + 0.7773999999985505, + -0.23614999998758798, + -0.027299999968136684 + ], + "error_m": [ + -1.1200040894721042e-11, + 8.238909554592055e-12, + 2.2577033992332574e-11 + ], + "error_norm_m": 2.6514958242152908e-11 + }, + { + "marker_id": 64, + "link": "Board", + "observed_position_m": [ + -0.021270000019686323, + -0.18822999998364243, + -0.02729999994746291 + ], + "predicted_position_m": [ + -0.021270000001249956, + -0.18822999998426548, + -0.027299999963702838 + ], + "error_m": [ + 1.84363670163723e-11, + -6.230571614196379e-13, + -1.6239929540029507e-11 + ], + "error_norm_m": 2.4576882236237772e-11 + }, + { + "marker_id": 66, + "link": "Board", + "observed_position_m": [ + 0.20974999999316585, + -0.3632300000004067, + -0.02729999997598414 + ], + "predicted_position_m": [ + 0.20974999999802202, + -0.3632299999852266, + -0.027299999963003002 + ], + "error_m": [ + 4.856171020861666e-12, + 1.5180134926850997e-11, + 1.298113699865766e-11 + ], + "error_norm_m": 2.0555505616724123e-11 + }, + { + "marker_id": 68, + "link": "Board", + "observed_position_m": [ + 0.5737300000077055, + 0.17064000000583948, + -0.027299999991248318 + ], + "predicted_position_m": [ + 0.5737300000002428, + 0.1706400000132592, + -0.02729999997186006 + ], + "error_m": [ + -7.462697126925377e-12, + 7.419731495872384e-12, + 1.9388258359898103e-11 + ], + "error_norm_m": 2.206011845184018e-11 + }, + { + "marker_id": 69, + "link": "Board", + "observed_position_m": [ + 0.007609999993045591, + -0.2812100000002623, + -0.02729999998125731 + ], + "predicted_position_m": [ + 0.0076099999983632646, + -0.28120999998438556, + -0.027299999962740632 + ], + "error_m": [ + 5.317673384963584e-12, + 1.587674436365205e-11, + 1.8516677774416124e-11 + ], + "error_norm_m": 2.496429485524202e-11 + }, + { + "marker_id": 72, + "link": "Board", + "observed_position_m": [ + 0.4409899999978852, + 0.19432000002561808, + -0.02729999994704442 + ], + "predicted_position_m": [ + 0.4409900000003412, + 0.19432000001381142, + -0.027299999971316484 + ], + "error_m": [ + 2.4560353750757713e-12, + -1.1806666755376227e-11, + -2.427206352573208e-11 + ], + "error_norm_m": 2.7102814566633174e-11 + }, + { + "marker_id": 73, + "link": "Board", + "observed_position_m": [ + 0.2217299999972606, + 0.3331100000111645, + -0.027299999991464166 + ], + "predicted_position_m": [ + 0.2217300000009186, + 0.3331100000147235, + -0.02729999997164483 + ], + "error_m": [ + 3.658018332686197e-12, + 3.5590419500408643e-12, + 1.981933714367834e-11 + ], + "error_norm_m": 2.0465922958401042e-11 + }, + { + "marker_id": 75, + "link": "Board", + "observed_position_m": [ + -0.025699999999079754, + 0.1945800000155921, + -0.027299999981853076 + ], + "predicted_position_m": [ + -0.02569999999965756, + 0.19458000001575287, + -0.02729999996838436 + ], + "error_m": [ + -5.778051648253069e-13, + 1.607880495413383e-13, + 1.3468715726050462e-11 + ], + "error_norm_m": 1.3482062709931783e-11 + }, + { + "marker_id": 79, + "link": "Board", + "observed_position_m": [ + 0.3123000000020295, + -0.1591099999749345, + -0.027299999960932117 + ], + "predicted_position_m": [ + 0.31229999999887115, + -0.1591099999856532, + -0.027299999966159123 + ], + "error_m": [ + -3.1583624604536453e-12, + -1.0718703702394805e-11, + -5.22700632776818e-12 + ], + "error_norm_m": 1.2336428074684484e-11 + }, + { + "marker_id": 82, + "link": "Board", + "observed_position_m": [ + 0.21915999999751554, + 0.2972400000114772, + -0.027299999991588088 + ], + "predicted_position_m": [ + 0.21916000000076943, + 0.2972400000147342, + -0.027299999971187386 + ], + "error_m": [ + 3.25389715172264e-12, + 3.2570057761915905e-12, + 2.040070196107635e-11 + ], + "error_norm_m": 2.0913741267520705e-11 + }, + { + "marker_id": 83, + "link": "Board", + "observed_position_m": [ + 0.044159999997531015, + 0.33922000001872427, + -0.027299999979277755 + ], + "predicted_position_m": [ + 0.04416000000094408, + 0.33922000001546226, + -0.027299999970603138 + ], + "error_m": [ + 3.413068438984368e-12, + -3.2620017798024037e-12, + 8.674616580606198e-12 + ], + "error_norm_m": 9.876166493187182e-12 + }, + { + "marker_id": 84, + "link": "Board", + "observed_position_m": [ + 0.4074900000023701, + 0.25842000002458154, + -0.027299999946568548 + ], + "predicted_position_m": [ + 0.4074900000006079, + 0.2584200000139508, + -0.027299999971894348 + ], + "error_m": [ + -1.7622014958362797e-12, + -1.0630718527693261e-11, + -2.532580048453248e-11 + ], + "error_norm_m": 2.7522966786109995e-11 + }, + { + "marker_id": 85, + "link": "Board", + "observed_position_m": [ + 0.5045800000037424, + -0.31274999998733155, + -0.027299999955291598 + ], + "predicted_position_m": [ + 0.5045799999982319, + -0.31274999998645303, + -0.027299999965478397 + ], + "error_m": [ + -5.510480960424502e-12, + 8.785194793858864e-13, + -1.0186799320743845e-11 + ], + "error_norm_m": 1.1614993641494972e-11 + }, + { + "marker_id": 86, + "link": "Board", + "observed_position_m": [ + 0.3628900000001209, + 0.2920100000230956, + -0.027299999948381934 + ], + "predicted_position_m": [ + 0.36289000000074767, + 0.2920100000141363, + -0.027299999972027058 + ], + "error_m": [ + 6.267764085521321e-13, + -8.959277764120088e-12, + -2.3645124053173205e-11 + ], + "error_norm_m": 2.529334691595646e-11 + }, + { + "marker_id": 92, + "link": "Board", + "observed_position_m": [ + 0.645090000006357, + -0.1848399999801669, + -0.02729999994923816 + ], + "predicted_position_m": [ + 0.645089999998764, + -0.18483999998703757, + -0.027299999967935723 + ], + "error_m": [ + -7.592926287713908e-12, + -6.8706706990440125e-12, + -1.869756433015013e-11 + ], + "error_norm_m": 2.1318010163837087e-11 + }, + { + "marker_id": 95, + "link": "Board", + "observed_position_m": [ + 0.1860399999938431, + -0.2740700000001042, + -0.027299999978252887 + ], + "predicted_position_m": [ + 0.18603999999839294, + -0.2740699999851279, + -0.027299999963950734 + ], + "error_m": [ + 4.54983273279197e-12, + 1.4976297979529818e-11, + 1.4302153211742663e-11 + ], + "error_norm_m": 2.120240706995824e-11 + }, + { + "marker_id": 96, + "link": "Board", + "observed_position_m": [ + 0.36977000000137356, + -0.18648999997712773, + -0.0272999999606587 + ], + "predicted_position_m": [ + 0.3697699999987572, + -0.18648999998589225, + -0.027299999966183753 + ], + "error_m": [ + -2.616351579831644e-12, + -8.76451689002522e-12, + -5.525052637622707e-12 + ], + "error_norm_m": 1.0685890629859849e-11 + }, + { + "marker_id": 97, + "link": "Board", + "observed_position_m": [ + 0.3043499999926279, + -0.35966999999972743, + -0.02729999997312092 + ], + "predicted_position_m": [ + 0.30434999999803686, + -0.3596699999856201, + -0.0272999999636418 + ], + "error_m": [ + 5.4089510648225314e-12, + 1.4107326418155708e-11, + 9.479118878719106e-12 + ], + "error_norm_m": 1.7836117991506104e-11 + }, + { + "marker_id": 102, + "link": "Board", + "observed_position_m": [ + 0.6496900000162692, + -0.2229999999903977, + -0.02729999997953186 + ], + "predicted_position_m": [ + 0.6496899999986053, + -0.2229999999870567, + -0.027299999967495204 + ], + "error_m": [ + -1.7663870366391166e-11, + 3.3410219035800992e-12, + 1.2036656393821232e-11 + ], + "error_norm_m": 2.1634598235784078e-11 + }, + { + "marker_id": 103, + "link": "Board", + "observed_position_m": [ + 0.10570999998245968, + -0.18770999997948598, + -0.027299999944835573 + ], + "predicted_position_m": [ + 0.10570999999875218, + -0.18770999998479376, + -0.0272999999645079 + ], + "error_m": [ + 1.6292495130798557e-11, + -5.307781991703564e-12, + -1.967232626798321e-11 + ], + "error_norm_m": 2.608866359268963e-11 + }, + { + "marker_id": 105, + "link": "Board", + "observed_position_m": [ + 0.5248400000026658, + -0.26624999998881177, + -0.027299999954586658 + ], + "predicted_position_m": [ + 0.5248399999984255, + -0.2662499999865373, + -0.027299999966177872 + ], + "error_m": [ + -4.240385820253323e-12, + 2.274458399398327e-12, + -1.1591214099659908e-11 + ], + "error_norm_m": 1.2550309845551769e-11 + }, + { + "marker_id": 114, + "link": "Arm2", + "observed_position_m": [ + 0.2901128864444567, + -0.17587018228071055, + 0.24710906047951745 + ], + "predicted_position_m": [ + 0.28321338006223307, + -0.1657934128862424, + 0.23526180622734172 + ], + "error_m": [ + -0.006899506382223641, + 0.010076769394468166, + -0.011847254252175726 + ], + "error_norm_m": 0.01701475545117622 + }, + { + "marker_id": 115, + "link": "Arm2", + "observed_position_m": [ + 0.2410958473346028, + -0.16897449865488434, + 0.24752469427328197 + ], + "predicted_position_m": [ + 0.2350567306295775, + -0.15434563341586477, + 0.23489375649226382 + ], + "error_m": [ + -0.006039116705025299, + 0.014628865239019573, + -0.012630937781018148 + ], + "error_norm_m": 0.0202488325092155 + }, + { + "marker_id": 120, + "link": "Arm2", + "observed_position_m": [ + 0.3101174437771042, + -0.22947158053268651, + 0.20677185166496367 + ], + "predicted_position_m": [ + 0.28321338006178365, + -0.16804277283746732, + 0.1652979557058079 + ], + "error_m": [ + -0.02690406371532056, + 0.06142880769521919, + -0.041473895959155765 + ], + "error_norm_m": 0.07885056185776437 + }, + { + "marker_id": 198, + "link": "Arm1", + "observed_position_m": [ + 0.1521530638858233, + -0.05352303701389467, + 0.10225869934804113 + ], + "predicted_position_m": [ + 0.17486190254555936, + -0.05310953390892011, + 0.09047402382345351 + ], + "error_m": [ + 0.022708838659736053, + 0.0004135031049745594, + -0.011784675524587618 + ], + "error_norm_m": 0.02558790564527626 + }, + { + "marker_id": 205, + "link": "Board", + "observed_position_m": [ + 0.7500000000100834, + -0.0899999999947394, + 0.00030000001038413515 + ], + "predicted_position_m": [ + 0.749999999999332, + -0.08999999998713447, + 0.00030000003023770137 + ], + "error_m": [ + -1.0751399770470016e-11, + 7.604930574167668e-12, + 1.9853566219415336e-11 + ], + "error_norm_m": 2.3824182204035516e-11 + }, + { + "marker_id": 206, + "link": "Board", + "observed_position_m": [ + 0.6500000000033211, + -0.009999999979634524, + 0.00030000004279697904 + ], + "predicted_position_m": [ + 0.649999999999665, + -0.009999999986718484, + 0.000300000029882496 + ], + "error_m": [ + -3.6561864646955655e-12, + -7.083960154585789e-12, + -1.29144830680189e-11 + ], + "error_norm_m": 1.5176760650762372e-11 + }, + { + "marker_id": 207, + "link": "Board", + "observed_position_m": [ + 0.7500000000096227, + -0.009999999989938299, + 0.0003000000170064098 + ], + "predicted_position_m": [ + 0.7499999999996648, + -0.009999999987134484, + 0.0003000000292535298 + ], + "error_m": [ + -9.957923374770417e-12, + 2.8038144722630776e-12, + 1.2247119984820642e-11 + ], + "error_norm_m": 1.6031642506470262e-11 + }, + { + "marker_id": 208, + "link": "Board", + "observed_position_m": [ + 0.3499999999938247, + -0.08999999995814495, + 0.00030000008000605476 + ], + "predicted_position_m": [ + 0.34999999999933223, + -0.08999999998547048, + 0.000300000032753566 + ], + "error_m": [ + 5.507538869409245e-12, + -2.732553072704036e-11, + -4.7252488759915584e-11 + ], + "error_norm_m": 5.4861783674233825e-11 + }, + { + "marker_id": 210, + "link": "Board", + "observed_position_m": [ + 0.019999999995218138, + -0.01999999996631041, + 0.0003000000504195409 + ], + "predicted_position_m": [ + 0.019999999999623427, + -0.019999999984097686, + 0.0003000000339680041 + ], + "error_m": [ + 4.405288633879678e-12, + -1.7787275125025204e-11, + -1.6451536801690564e-11 + ], + "error_norm_m": 2.462614032808448e-11 + }, + { + "marker_id": 211, + "link": "Board", + "observed_position_m": [ + 0.24999999998851813, + -0.009999999985897085, + 0.0003000000454248722 + ], + "predicted_position_m": [ + 0.24999999999966496, + -0.009999999985054487, + 0.00030000003239836055 + ], + "error_m": [ + 1.1146833456265881e-11, + 8.425985603688346e-13, + -1.3026511672727809e-11 + ], + "error_norm_m": 1.7165426729195456e-11 + }, + { + "marker_id": 214, + "link": "Board", + "observed_position_m": [ + 0.34999999998804016, + -0.009999999961277501, + 0.00030000008638886506 + ], + "predicted_position_m": [ + 0.349999999999665, + -0.009999999985470485, + 0.00030000003176939443 + ], + "error_m": [ + 1.1624867735093858e-11, + -2.41929844213562e-11, + -5.461947062170014e-11 + ], + "error_norm_m": 6.085823375735755e-11 + }, + { + "marker_id": 215, + "link": "Board", + "observed_position_m": [ + 0.24999999999927783, + -0.08999999999936918, + 0.0003000000197643875 + ], + "predicted_position_m": [ + 0.2499999999993322, + -0.08999999998505448, + 0.0003000000333825321 + ], + "error_m": [ + 5.437317263101704e-14, + 1.431470220136788e-11, + 1.3618144643640778e-11 + ], + "error_norm_m": 1.9757720493287436e-11 + }, + { + "marker_id": 217, + "link": "Board", + "observed_position_m": [ + 0.650000000008564, + -0.08999999997965384, + 0.00030000004920660524 + ], + "predicted_position_m": [ + 0.6499999999993321, + -0.08999999998671848, + 0.00030000003086666754 + ], + "error_m": [ + -9.231837516665564e-12, + -7.064640539233835e-12, + -1.833993769568068e-11 + ], + "error_norm_m": 2.171380400952696e-11 + }, + { + "marker_id": 219, + "link": "Arm2", + "observed_position_m": [ + 0.30359098664820383, + -0.15023055724050538, + 0.2824306011180299 + ], + "predicted_position_m": [ + 0.2989120587106686, + -0.14290907511183393, + 0.2715451849745724 + ], + "error_m": [ + -0.0046789279375352155, + 0.007321482128671453, + -0.010885416143457505 + ], + "error_norm_m": 0.01392798448524941 + }, + { + "marker_id": 229, + "link": "Arm1", + "observed_position_m": [ + 0.16001671264344228, + -0.14308126101249394, + 0.09807671666083417 + ], + "predicted_position_m": [ + 0.17486190254516573, + -0.1430562427053349, + 0.08737731965725702 + ], + "error_m": [ + 0.014845189901723455, + 2.501830715903597e-05, + -0.010699397003577152 + ], + "error_norm_m": 0.01829910886830506 + }, + { + "marker_id": 232, + "link": "Ellbow", + "observed_position_m": [ + 0.2302931496524019, + -0.09276299953359425, + 0.025104790285516664 + ], + "predicted_position_m": [ + 0.26486190254450187, + -0.16738449685188347, + 0.02845613484770879 + ], + "error_m": [ + 0.03456875289209996, + -0.07462149731828922, + 0.0033513445621921253 + ], + "error_norm_m": 0.08230794645058914 + }, + { + "marker_id": 243, + "link": "Arm1", + "observed_position_m": [ + 0.1600256909055359, + -0.17674403797569505, + 0.061788683667017646 + ], + "predicted_position_m": [ + 0.17486190254479766, + -0.17683124450597534, + 0.05119377017179706 + ], + "error_m": [ + 0.01483621163926177, + -8.720653028029823e-05, + -0.010594913495220584 + ], + "error_norm_m": 0.018231099055051433 + }, + { + "marker_id": 244, + "link": "Ellbow", + "observed_position_m": [ + 0.27714634853068326, + -0.1174745149273092, + 0.05127329168637121 + ], + "predicted_position_m": [ + 0.2998619025446839, + -0.14185196886344514, + 0.05239804401342061 + ], + "error_m": [ + 0.02271555401400066, + -0.02437745393613594, + 0.0011247523270494011 + ], + "error_norm_m": 0.033339491933270585 + }, + { + "marker_id": 245, + "link": "Ellbow", + "observed_position_m": [ + 0.23079172204816714, + -0.11805719285839464, + 0.03392556703431675 + ], + "predicted_position_m": [ + 0.2648619025446202, + -0.17683389412406836, + 0.05352272398925326 + ], + "error_m": [ + 0.03407018049645308, + -0.05877670126567372, + 0.01959715695493651 + ], + "error_norm_m": 0.07070732897975682 + }, + { + "marker_id": 248, + "link": "Ellbow", + "observed_position_m": [ + 0.20911576790502873, + -0.14567682011083427, + 0.04710607056346628 + ], + "predicted_position_m": [ + 0.22736190254470023, + -0.17683389412391234, + 0.05352272398948912 + ], + "error_m": [ + 0.018246134639671507, + -0.031157074013078073, + 0.006416653426022836 + ], + "error_norm_m": 0.03667230742038379 + } + ] +} \ No newline at end of file diff --git a/data/evaluations/Scene8/v8_ellbow_angle.json b/data/evaluations/Scene8/v8_ellbow_angle.json new file mode 100644 index 0000000..b449be2 --- /dev/null +++ b/data/evaluations/Scene8/v8_ellbow_angle.json @@ -0,0 +1,88 @@ +{ + "status": "ok", + "link": "Ellbow", + "joint": "z", + "joint_origin_world_mm": [ + 110.0, + -142.0, + 61.0 + ], + "joint_axis_world": [ + -1.0, + 0.0, + 0.0 + ], + "mean_angle_deg": 35.68062274755076, + "circular_variance": 0.12631502697738917, + "circular_std_deg": 29.775664725717373, + "num_pairs_used": 5, + "num_markers_matched": 4, + "per_pair": [ + { + "marker_ids": [ + 232, + 244 + ], + "skipped": false, + "angle_deg": 1.6402458166779226, + "baseline_model_mm": 35.0017856687341, + "baseline_obs_mm": 35.992344837768215, + "weight": 1259.7963397267313 + }, + { + "marker_ids": [ + 232, + 245 + ], + "skipped": false, + "angle_deg": 41.7215254372508, + "baseline_model_mm": 26.788523662195345, + "baseline_obs_mm": 26.78810031754293, + "weight": 717.6136592217614 + }, + { + "marker_ids": [ + 232, + 248 + ], + "skipped": false, + "angle_deg": 45.073746517393985, + "baseline_model_mm": 26.788523662195345, + "baseline_obs_mm": 57.305573616199595, + "weight": 1535.1317147932402 + }, + { + "marker_ids": [ + 244, + 245 + ], + "skipped": false, + "angle_deg": 1.9237398886581312, + "baseline_model_mm": 35.0, + "baseline_obs_mm": 17.3574992360074, + "weight": 607.512473260259 + }, + { + "marker_ids": [ + 244, + 248 + ], + "skipped": false, + "angle_deg": 81.59471613948939, + "baseline_model_mm": 35.0, + "baseline_obs_mm": 28.50852019511797, + "weight": 997.798206829129 + }, + { + "marker_ids": [ + 245, + 248 + ], + "skipped": true, + "reason": "bl_model=0.0 bl_obs=30.6 < 15.0" + } + ], + "accumulated_state": { + "z": 35.68062274755076 + } +} \ No newline at end of file diff --git a/data/evaluations/Scene8/v8_z_correction.json b/data/evaluations/Scene8/v8_z_correction.json new file mode 100644 index 0000000..90e2720 --- /dev/null +++ b/data/evaluations/Scene8/v8_z_correction.json @@ -0,0 +1,22 @@ +{ + "schema_version": "1.0", + "created_utc": "2026-06-01T18:37:02Z", + "elbow_link": "Ellbow", + "z_correction_mm": 11.151935468550299, + "n_markers_used": 4, + "z_deltas_mm": [ + 12.507338403170822, + 20.87864524060062, + 9.796532533929774, + -3.3839720622625933 + ], + "corrected_pose_files": [ + "C:\\Users\\kech\\SynologyDrive\\2026-AppServer-AppRobot\\appRobotRendering\\data\\evaluations\\Scene8\\render_a_camera_pose_v8.json", + "C:\\Users\\kech\\SynologyDrive\\2026-AppServer-AppRobot\\appRobotRendering\\data\\evaluations\\Scene8\\render_b_camera_pose_v8.json", + "C:\\Users\\kech\\SynologyDrive\\2026-AppServer-AppRobot\\appRobotRendering\\data\\evaluations\\Scene8\\render_c_camera_pose_v8.json", + "C:\\Users\\kech\\SynologyDrive\\2026-AppServer-AppRobot\\appRobotRendering\\data\\evaluations\\Scene8\\render_d_camera_pose_v8.json", + "C:\\Users\\kech\\SynologyDrive\\2026-AppServer-AppRobot\\appRobotRendering\\data\\evaluations\\Scene8\\render_e_camera_pose_v8.json", + "C:\\Users\\kech\\SynologyDrive\\2026-AppServer-AppRobot\\appRobotRendering\\data\\evaluations\\Scene8\\render_f_camera_pose_v8.json", + "C:\\Users\\kech\\SynologyDrive\\2026-AppServer-AppRobot\\appRobotRendering\\data\\evaluations\\Scene8\\render_g_camera_pose_v8.json" + ] +} \ No newline at end of file diff --git a/data/evaluations/Scene9/aruco_positions_initial.json b/data/evaluations/Scene9/aruco_positions_initial.json index b8726c2..bb0ed2d 100644 --- a/data/evaluations/Scene9/aruco_positions_initial.json +++ b/data/evaluations/Scene9/aruco_positions_initial.json @@ -1,11 +1,11 @@ { "schema_version": "1.2", "stage": "initial_triangulation", - "created_utc": "2026-06-01T16:29:16Z", + "created_utc": "2026-06-01T17:39:29Z", "summary": { "num_cameras": 7, "num_markers": 48, - "num_constraints": 94 + "num_constraints": 163 }, "markers": [ { @@ -68,14 +68,14 @@ { "marker_id": 46, "position_m": [ - 0.5361354551260209, - 0.1926725826858719, - -0.031867575928809296 + 0.53671, + 0.18544, + -0.0273 ], "position_mm": [ - 536.1354551260209, - 192.6725826858719, - -31.867575928809295 + 536.71, + 185.44, + -27.3 ], "link": "Board", "normal": [ @@ -87,14 +87,14 @@ { "marker_id": 47, "position_m": [ - 0.3448378273514693, - -0.28565229626840277, - -0.027632705427477814 + 0.34423000000000004, + -0.28654, + -0.0273 ], "position_mm": [ - 344.8378273514693, - -285.6522962684028, - -27.632705427477813 + 344.23, + -286.54, + -27.3 ], "link": "Board", "normal": [ @@ -106,14 +106,14 @@ { "marker_id": 51, "position_m": [ - 0.16643503560912412, - -0.17342825019997318, - -0.02882575772320487 + 0.1678, + -0.17208, + -0.0273 ], "position_mm": [ - 166.43503560912413, - -173.42825019997318, - -28.825757723204873 + 167.8, + -172.08, + -27.3 ], "link": "Board", "normal": [ @@ -125,14 +125,14 @@ { "marker_id": 53, "position_m": [ - 0.48052770292428343, - 0.22270145554624984, - -0.03300614560094162 + 0.48625, + 0.21224, + -0.0273 ], "position_mm": [ - 480.5277029242834, - 222.70145554624983, - -33.006145600941615 + 486.25, + 212.24, + -27.3 ], "link": "Board", "normal": [ @@ -144,14 +144,14 @@ { "marker_id": 54, "position_m": [ - 0.3423520157816711, - -0.32607523043362335, - -0.023629251855373394 + 0.34226999999999996, + -0.33059, + -0.0273 ], "position_mm": [ - 342.3520157816711, - -326.07523043362335, - -23.629251855373393 + 342.27, + -330.59, + -27.3 ], "link": "Board", "normal": [ @@ -163,14 +163,14 @@ { "marker_id": 55, "position_m": [ - 0.28462400971138435, - -0.262251687573985, - -0.02734128898330347 + 0.28372, + -0.26258, + -0.0273 ], "position_mm": [ - 284.62400971138436, - -262.251687573985, - -27.34128898330347 + 283.72, + -262.58, + -27.3 ], "link": "Board", "normal": [ @@ -182,14 +182,14 @@ { "marker_id": 56, "position_m": [ - 0.5340126975575954, - 0.19995513798618522, - -0.09734422209781861 + 0.49868, + 0.16867, + -0.0273 ], "position_mm": [ - 534.0126975575954, - 199.95513798618524, - -97.3442220978186 + 498.68, + 168.67, + -27.3 ], "link": "Board", "normal": [ @@ -201,14 +201,14 @@ { "marker_id": 58, "position_m": [ - 0.05212441406860238, - -0.2178417196827393, - -0.02735915315693813 + 0.05009, + -0.21811000000000003, + -0.0273 ], "position_mm": [ - 52.124414068602384, - -217.8417196827393, - -27.35915315693813 + 50.09, + -218.11, + -27.3 ], "link": "Board", "normal": [ @@ -220,14 +220,14 @@ { "marker_id": 60, "position_m": [ - 0.43452872979783574, - 0.2851723570533919, - -0.028656930235296103 + 0.43436, + 0.28381, + -0.0273 ], "position_mm": [ - 434.52872979783575, - 285.17235705339186, - -28.6569302352961 + 434.36, + 283.81, + -27.3 ], "link": "Board", "normal": [ @@ -239,14 +239,14 @@ { "marker_id": 61, "position_m": [ - -0.010123962211920254, - 0.3692805373356988, - -0.06540606214453806 + -0.022420000000000002, + 0.33583, + -0.0273 ], "position_mm": [ - -10.123962211920254, - 369.2805373356988, - -65.40606214453807 + -22.42, + 335.83000000000004, + -27.3 ], "link": "Board", "normal": [ @@ -258,14 +258,14 @@ { "marker_id": 62, "position_m": [ - 0.4047950583363621, - -0.17539226211362574, - -0.02874726828040475 + 0.4047, + -0.1751, + -0.0273 ], "position_mm": [ - 404.7950583363621, - -175.39226211362575, - -28.74726828040475 + 404.7, + -175.1, + -27.3 ], "link": "Board", "normal": [ @@ -277,14 +277,14 @@ { "marker_id": 63, "position_m": [ - 0.7933708401590123, - -0.24523600152007727, - -0.047078037302345416 + 0.7774, + -0.23615, + -0.0273 ], "position_mm": [ - 793.3708401590122, - -245.23600152007728, - -47.078037302345415 + 777.4, + -236.15, + -27.3 ], "link": "Board", "normal": [ @@ -296,14 +296,14 @@ { "marker_id": 64, "position_m": [ - -0.019436243227938195, - -0.18768003979444278, - -0.026254232800957476 + -0.02127, + -0.18822999999999998, + -0.0273 ], "position_mm": [ - -19.436243227938196, - -187.6800397944428, - -26.254232800957475 + -21.27, + -188.23, + -27.3 ], "link": "Board", "normal": [ @@ -315,14 +315,14 @@ { "marker_id": 66, "position_m": [ - 0.21553925423099204, - -0.3585582840007798, - -0.02523674900356317 + 0.20975, + -0.36323000000000005, + -0.0273 ], "position_mm": [ - 215.53925423099204, - -358.55828400077985, - -25.23674900356317 + 209.75, + -363.2300000000001, + -27.3 ], "link": "Board", "normal": [ @@ -334,14 +334,14 @@ { "marker_id": 68, "position_m": [ - 0.5709428665711936, - 0.1726383690293072, - -0.022075066370605047 + 0.5737300000000001, + 0.17064, + -0.0273 ], "position_mm": [ - 570.9428665711937, - 172.6383690293072, - -22.075066370605047 + 573.73, + 170.64, + -27.3 ], "link": "Board", "normal": [ @@ -353,14 +353,14 @@ { "marker_id": 69, "position_m": [ - 0.017834112808371022, - -0.27059472142420615, - -0.004250964283180778 + 0.0076100000000000004, + -0.28120999999999996, + -0.0273 ], "position_mm": [ - 17.83411280837102, - -270.59472142420617, - -4.250964283180778 + 7.61, + -281.21, + -27.3 ], "link": "Board", "normal": [ @@ -372,14 +372,14 @@ { "marker_id": 72, "position_m": [ - 0.4334460529422468, - 0.20407582745516323, - -0.03413463588841859 + 0.44099, + 0.19432, + -0.0273 ], "position_mm": [ - 433.4460529422468, - 204.07582745516322, - -34.13463588841859 + 440.99, + 194.32, + -27.3 ], "link": "Board", "normal": [ @@ -391,14 +391,14 @@ { "marker_id": 75, "position_m": [ - -0.01864439808105608, - 0.2237306305051548, - -0.062184646297192454 + -0.0257, + 0.19458, + -0.0273 ], "position_mm": [ - -18.64439808105608, - 223.7306305051548, - -62.18464629719245 + -25.7, + 194.58, + -27.3 ], "link": "Board", "normal": [ @@ -410,14 +410,14 @@ { "marker_id": 79, "position_m": [ - 0.31182862211648754, - -0.15856876174473852, - -0.02921181780512751 + 0.3123, + -0.15911000000000003, + -0.0273 ], "position_mm": [ - 311.82862211648757, - -158.5687617447385, - -29.21181780512751 + 312.3, + -159.11000000000004, + -27.3 ], "link": "Board", "normal": [ @@ -429,14 +429,14 @@ { "marker_id": 83, "position_m": [ - 0.05697296825126395, - 0.364887777206735, - -0.05709829193544353 + 0.04416, + 0.33922, + -0.0273 ], "position_mm": [ - 56.97296825126395, - 364.887777206735, - -57.098291935443534 + 44.16, + 339.22, + -27.3 ], "link": "Board", "normal": [ @@ -448,14 +448,14 @@ { "marker_id": 84, "position_m": [ - 0.394996347874007, - 0.27696527598348375, - -0.03688398019183106 + 0.40749, + 0.25842000000000004, + -0.0273 ], "position_mm": [ - 394.99634787400703, - 276.96527598348376, - -36.883980191831064 + 407.49, + 258.42, + -27.3 ], "link": "Board", "normal": [ @@ -467,14 +467,14 @@ { "marker_id": 85, "position_m": [ - 0.5044488881389911, - -0.312098591225284, - -0.02902395917817957 + 0.50458, + -0.31275000000000003, + -0.0273 ], "position_mm": [ - 504.44888813899115, - -312.098591225284, - -29.02395917817957 + 504.58000000000004, + -312.75, + -27.3 ], "link": "Board", "normal": [ @@ -486,14 +486,14 @@ { "marker_id": 86, "position_m": [ - 0.36506878932159953, - 0.289463699084765, - -0.027986852427688825 + 0.36289, + 0.29201, + -0.0273 ], "position_mm": [ - 365.0687893215995, - 289.463699084765, - -27.986852427688824 + 362.89, + 292.01, + -27.3 ], "link": "Board", "normal": [ @@ -505,14 +505,14 @@ { "marker_id": 92, "position_m": [ - 0.6483566480111661, - -0.19176627617754713, - -0.02727582949341032 + 0.64509, + -0.18484, + -0.0273 ], "position_mm": [ - 648.3566480111662, - -191.76627617754713, - -27.27582949341032 + 645.09, + -184.84, + -27.3 ], "link": "Board", "normal": [ @@ -524,14 +524,14 @@ { "marker_id": 95, "position_m": [ - 0.18858975175453324, - -0.27280157769187824, - -0.026055699573846004 + 0.18603999999999998, + -0.27407, + -0.0273 ], "position_mm": [ - 188.58975175453324, - -272.80157769187826, - -26.055699573846002 + 186.04, + -274.07, + -27.3 ], "link": "Board", "normal": [ @@ -543,14 +543,14 @@ { "marker_id": 96, "position_m": [ - 0.3696526460049592, - -0.1869584013989223, - -0.028661154723504004 + 0.36977, + -0.18649000000000002, + -0.0273 ], "position_mm": [ - 369.6526460049592, - -186.95840139892232, - -28.661154723504005 + 369.77, + -186.49, + -27.3 ], "link": "Board", "normal": [ @@ -562,14 +562,14 @@ { "marker_id": 97, "position_m": [ - 0.306902949578878, - -0.35557764113886897, - -0.026320750591851405 + 0.30435, + -0.35967000000000005, + -0.0273 ], "position_mm": [ - 306.902949578878, - -355.57764113886896, - -26.320750591851404 + 304.35, + -359.6700000000001, + -27.3 ], "link": "Board", "normal": [ @@ -581,14 +581,14 @@ { "marker_id": 102, "position_m": [ - 0.6540110675047102, - -0.22757491771842786, - -0.03276331158593055 + 0.6496900000000001, + -0.223, + -0.0273 ], "position_mm": [ - 654.0110675047101, - -227.57491771842786, - -32.76331158593055 + 649.69, + -223.0, + -27.3 ], "link": "Board", "normal": [ @@ -600,14 +600,14 @@ { "marker_id": 103, "position_m": [ - 0.10574443771115535, - -0.1876625170768477, - -0.027841133159968633 + 0.10571, + -0.18771000000000002, + -0.0273 ], "position_mm": [ - 105.74443771115536, - -187.6625170768477, - -27.84113315996863 + 105.71, + -187.71, + -27.3 ], "link": "Board", "normal": [ @@ -619,14 +619,14 @@ { "marker_id": 105, "position_m": [ - 0.5251505065301493, - -0.2683498725420233, - -0.02832190897844432 + 0.5248400000000001, + -0.26625, + -0.0273 ], "position_mm": [ - 525.1505065301493, - -268.3498725420233, - -28.32190897844432 + 524.84, + -266.25, + -27.3 ], "link": "Board", "normal": [ @@ -695,14 +695,14 @@ { "marker_id": 205, "position_m": [ - 0.7332347001664562, - -0.10985247177864625, - 0.040486930923137765 + 0.75, + -0.09, + 0.0003 ], "position_mm": [ - 733.2347001664562, - -109.85247177864625, - 40.48693092313776 + 750.0, + -90.0, + 0.3 ], "link": "Board", "normal": [ @@ -714,14 +714,14 @@ { "marker_id": 206, "position_m": [ - 0.6487167133153804, - -0.0061839893976751185, - 0.003823440117237419 + 0.65, + -0.01, + 0.0003 ], "position_mm": [ - 648.7167133153804, - -6.183989397675118, - 3.823440117237419 + 650.0, + -10.0, + 0.3 ], "link": "Board", "normal": [ @@ -733,14 +733,14 @@ { "marker_id": 207, "position_m": [ - 0.748770275714809, - -0.004058294834022015, - 0.004168827693892214 + 0.75, + -0.01, + 0.0003 ], "position_mm": [ - 748.770275714809, - -4.058294834022015, - 4.168827693892213 + 750.0, + -10.0, + 0.3 ], "link": "Board", "normal": [ @@ -752,14 +752,14 @@ { "marker_id": 208, "position_m": [ - 0.34850778569044394, - -0.09917615050089638, - 0.0022992868907357297 + 0.35000000000000003, + -0.09, + 0.0003 ], "position_mm": [ - 348.50778569044394, - -99.17615050089638, - 2.2992868907357296 + 350.00000000000006, + -90.0, + 0.3 ], "link": "Board", "normal": [ @@ -771,14 +771,14 @@ { "marker_id": 210, "position_m": [ - 0.01904761485941944, - -0.0057694617487496986, - -0.0073921554862603185 + 0.02, + -0.02, + 0.0003 ], "position_mm": [ - 19.04761485941944, - -5.769461748749698, - -7.392155486260319 + 20.0, + -20.0, + 0.3 ], "link": "Board", "normal": [ @@ -790,14 +790,14 @@ { "marker_id": 211, "position_m": [ - 0.2505307789840388, - -0.010957966408644507, - 0.004931893214629631 + 0.25, + -0.01, + 0.0003 ], "position_mm": [ - 250.53077898403882, - -10.957966408644507, - 4.931893214629631 + 250.0, + -10.0, + 0.3 ], "link": "Board", "normal": [ @@ -809,14 +809,14 @@ { "marker_id": 214, "position_m": [ - 0.3484353657821889, - -0.005256461133634065, - 0.005062659608766313 + 0.35000000000000003, + -0.01, + 0.0003 ], "position_mm": [ - 348.4353657821889, - -5.256461133634065, - 5.062659608766313 + 350.00000000000006, + -10.0, + 0.3 ], "link": "Board", "normal": [ @@ -828,14 +828,14 @@ { "marker_id": 217, "position_m": [ - 0.6541282521258601, - -0.10529053647438955, - 0.0062384204502635605 + 0.65, + -0.09, + 0.0003 ], "position_mm": [ - 654.1282521258602, - -105.29053647438954, - 6.23842045026356 + 650.0, + -90.0, + 0.3 ], "link": "Board", "normal": [ diff --git a/data/evaluations/Scene9/aruco_positions_optimized.json b/data/evaluations/Scene9/aruco_positions_optimized.json index 2fa9116..e64860a 100644 --- a/data/evaluations/Scene9/aruco_positions_optimized.json +++ b/data/evaluations/Scene9/aruco_positions_optimized.json @@ -1,23 +1,23 @@ { "schema_version": "1.2", - "created_utc": "2026-06-01T16:30:02Z", + "created_utc": "2026-06-01T17:39:37Z", "summary": { "num_cameras": 7, "num_markers": 48, - "num_constraints": 94 + "num_constraints": 163 }, "markers": [ { "marker_id": 41, "position_m": [ - 0.1571273925444109, - -0.2417091517279724, - 0.5004883537060872 + 0.15713394067836678, + -0.24169846761336594, + 0.5004650323384412 ], "position_mm": [ - 157.12739254441092, - -241.7091517279724, - 500.48835370608725 + 157.13394067836677, + -241.69846761336595, + 500.4650323384412 ], "link": "FingerA", "normal": [ @@ -29,14 +29,14 @@ { "marker_id": 42, "position_m": [ - 0.14791429060362243, - -0.19727321113148424, - 0.51423694375173 + 0.14792169025730362, + -0.19726356216914873, + 0.5142175415595074 ], "position_mm": [ - 147.91429060362245, - -197.27321113148423, - 514.23694375173 + 147.92169025730362, + -197.2635621691487, + 514.2175415595074 ], "link": "FingerA", "normal": [ @@ -48,14 +48,14 @@ { "marker_id": 43, "position_m": [ - 0.1995420422389749, - -0.1786853796663364, - 0.4893315305410218 + 0.19954401025306587, + -0.17868124757281725, + 0.48932495195604525 ], "position_mm": [ - 199.5420422389749, - -178.68537966633642, - 489.3315305410218 + 199.54401025306586, + -178.68124757281726, + 489.32495195604525 ], "link": "FingerB", "normal": [ @@ -67,14 +67,14 @@ { "marker_id": 46, "position_m": [ - 0.5537230882431512, - 0.1977611666244955, - -0.04996016972217795 + 0.5367100000359836, + 0.1854400000005472, + -0.027299999991479484 ], "position_mm": [ - 553.7230882431512, - 197.7611666244955, - -49.960169722177945 + 536.7100000359836, + 185.4400000005472, + -27.299999991479485 ], "link": "Board", "normal": [ @@ -86,14 +86,14 @@ { "marker_id": 47, "position_m": [ - 0.34332130966761365, - -0.2887639957420238, - -0.028114094135045332 + 0.3442299999972001, + -0.28654000000969543, + -0.027300000007238 ], "position_mm": [ - 343.32130966761366, - -288.76399574202384, - -28.11409413504533 + 344.2299999972001, + -286.5400000096954, + -27.300000007238 ], "link": "Board", "normal": [ @@ -105,14 +105,14 @@ { "marker_id": 51, "position_m": [ - 0.16642387487428473, - -0.16684364399024212, - -0.03274030026346752 + 0.1677999999969726, + -0.1720800000064549, + -0.027300000002555547 ], "position_mm": [ - 166.42387487428473, - -166.84364399024213, - -32.74030026346752 + 167.7999999969726, + -172.0800000064549, + -27.300000002555546 ], "link": "Board", "normal": [ @@ -124,14 +124,14 @@ { "marker_id": 53, "position_m": [ - 0.4894977912056363, - 0.212643597189728, - -0.029794389274099962 + 0.4862500000200562, + 0.21224000000961854, + -0.027299999997122695 ], "position_mm": [ - 489.4977912056363, - 212.643597189728, - -29.794389274099963 + 486.2500000200562, + 212.24000000961854, + -27.299999997122697 ], "link": "Board", "normal": [ @@ -143,14 +143,14 @@ { "marker_id": 54, "position_m": [ - 0.33917399491630046, - -0.3273770220199586, - -0.007231621521410211 + 0.3422700000010497, + -0.3305899999824172, + -0.0272999999973273 ], "position_mm": [ - 339.17399491630044, - -327.3770220199586, - -7.231621521410211 + 342.27000000104965, + -330.5899999824172, + -27.299999997327298 ], "link": "Board", "normal": [ @@ -162,14 +162,14 @@ { "marker_id": 55, "position_m": [ - 0.2839627083125436, - -0.26208377047205506, - -0.02759771899372336 + 0.2837199999994003, + -0.26257999999666404, + -0.02730000000010175 ], "position_mm": [ - 283.9627083125436, - -262.08377047205505, - -27.597718993723362 + 283.7199999994003, + -262.579999996664, + -27.30000000010175 ], "link": "Board", "normal": [ @@ -181,14 +181,14 @@ { "marker_id": 56, "position_m": [ - 0.5151342183417627, - 0.18242584975183368, - -0.05176078959042257 + 0.49868000002448615, + 0.1686699999948678, + -0.027299999999856325 ], "position_mm": [ - 515.1342183417627, - 182.42584975183368, - -51.760789590422576 + 498.68000002448616, + 168.6699999948678, + -27.299999999856325 ], "link": "Board", "normal": [ @@ -200,14 +200,14 @@ { "marker_id": 58, "position_m": [ - 0.05047028595322087, - -0.21805046551807833, - -0.027899136253572415 + 0.050090000009267596, + -0.21810999999282626, + -0.027300000000000792 ], "position_mm": [ - 50.470285953220866, - -218.05046551807834, - -27.899136253572415 + 50.0900000092676, + -218.10999999282626, + -27.300000000000793 ], "link": "Board", "normal": [ @@ -219,14 +219,14 @@ { "marker_id": 60, "position_m": [ - 0.43450310210255794, - 0.287334797016034, - -0.030088268897900873 + 0.4343600000011619, + 0.2838100000007643, + -0.02730000000147565 ], "position_mm": [ - 434.50310210255793, - 287.334797016034, - -30.088268897900875 + 434.3600000011619, + 283.81000000076426, + -27.300000001475652 ], "link": "Board", "normal": [ @@ -238,14 +238,14 @@ { "marker_id": 61, "position_m": [ - -0.010273167795059716, - 0.36463632019321685, - -0.05936521876385093 + -0.022419999969346745, + 0.3358300000022, + -0.02730000000320633 ], "position_mm": [ - -10.273167795059715, - 364.6363201932168, - -59.36521876385093 + -22.419999969346744, + 335.8300000022, + -27.30000000320633 ], "link": "Board", "normal": [ @@ -257,14 +257,14 @@ { "marker_id": 62, "position_m": [ - 0.4052500991034773, - -0.17961608003520677, - -0.02860129330488841 + 0.404700000004358, + -0.17510000003546192, + -0.027300000013916446 ], "position_mm": [ - 405.25009910347734, - -179.61608003520678, - -28.601293304888408 + 404.700000004358, + -175.1000000354619, + -27.300000013916446 ], "link": "Board", "normal": [ @@ -276,14 +276,14 @@ { "marker_id": 63, "position_m": [ - 0.793650705177529, - -0.2455555576219817, - -0.04804152775546483 + 0.7774000000171626, + -0.2361500000361161, + -0.02730000000002445 ], "position_mm": [ - 793.650705177529, - -245.5555576219817, - -48.04152775546483 + 777.4000000171626, + -236.1500000361161, + -27.30000000002445 ], "link": "Board", "normal": [ @@ -295,14 +295,14 @@ { "marker_id": 64, "position_m": [ - -0.020212843087242333, - -0.18664711640406315, - -0.02623228398950468 + -0.02126999998409922, + -0.18822999998399934, + -0.027299999993596866 ], "position_mm": [ - -20.212843087242334, - -186.64711640406315, - -26.232283989504683 + -21.26999998409922, + -188.22999998399933, + -27.299999993596867 ], "link": "Board", "normal": [ @@ -314,14 +314,14 @@ { "marker_id": 66, "position_m": [ - 0.2112402941494965, - -0.35712995003941583, - -0.02398275523167106 + 0.2097500000174469, + -0.3632299999427288, + -0.027299999990566506 ], "position_mm": [ - 211.2402941494965, - -357.12995003941586, - -23.98275523167106 + 209.7500000174469, + -363.2299999427288, + -27.299999990566505 ], "link": "Board", "normal": [ @@ -333,14 +333,14 @@ { "marker_id": 68, "position_m": [ - 0.571640476179435, - 0.17338792419550367, - -0.023990325126361893 + 0.5737299999973222, + 0.170640000009351, + -0.027299999996577534 ], "position_mm": [ - 571.640476179435, - 173.38792419550367, - -23.990325126361892 + 573.7299999973222, + 170.640000009351, + -27.299999996577533 ], "link": "Board", "normal": [ @@ -352,14 +352,14 @@ { "marker_id": 69, "position_m": [ - 0.017838832300215667, - -0.273525688820154, - 0.012645184176436158 + 0.007610000042528948, + -0.2812099999494889, + -0.02729999999105512 ], "position_mm": [ - 17.838832300215667, - -273.525688820154, - 12.645184176436157 + 7.610000042528948, + -281.2099999494889, + -27.299999991055117 ], "link": "Board", "normal": [ @@ -371,14 +371,14 @@ { "marker_id": 72, "position_m": [ - 0.4428316629283471, - 0.19901767904449094, - -0.0322869105551904 + 0.4409900000077613, + 0.1943200000015428, + -0.02730000001090054 ], "position_mm": [ - 442.8316629283471, - 199.01767904449093, - -32.2869105551904 + 440.9900000077613, + 194.32000000154278, + -27.30000001090054 ], "link": "Board", "normal": [ @@ -390,14 +390,14 @@ { "marker_id": 75, "position_m": [ - -0.027008690088654197, - 0.19823472058773403, - -0.033723204473509905 + -0.025700000005315346, + 0.19457999999768544, + -0.027300000002817387 ], "position_mm": [ - -27.0086900886542, - 198.23472058773402, - -33.7232044735099 + -25.700000005315346, + 194.57999999768543, + -27.300000002817388 ], "link": "Board", "normal": [ @@ -409,14 +409,14 @@ { "marker_id": 79, "position_m": [ - 0.3118339050382921, - -0.16253770901397716, - -0.028924941128076205 + 0.3122999999935043, + -0.1591100000236665, + -0.02730000001254783 ], "position_mm": [ - 311.83390503829213, - -162.53770901397715, - -28.924941128076206 + 312.2999999935043, + -159.1100000236665, + -27.30000001254783 ], "link": "Board", "normal": [ @@ -428,14 +428,14 @@ { "marker_id": 83, "position_m": [ - 0.0426438302170005, - 0.339559015660868, - -0.027501294555736213 + 0.04415999999418578, + 0.3392200000003566, + -0.027299999999146778 ], "position_mm": [ - 42.6438302170005, - 339.559015660868, - -27.501294555736212 + 44.15999999418578, + 339.2200000003566, + -27.299999999146777 ], "link": "Board", "normal": [ @@ -447,14 +447,14 @@ { "marker_id": 84, "position_m": [ - 0.40750100554231905, - 0.262085539172646, - -0.029994018343480658 + 0.40748999999267627, + 0.25842000002025645, + -0.02730000000234602 ], "position_mm": [ - 407.50100554231904, - 262.085539172646, - -29.994018343480658 + 407.48999999267625, + 258.42000002025645, + -27.30000000234602 ], "link": "Board", "normal": [ @@ -466,14 +466,14 @@ { "marker_id": 85, "position_m": [ - 0.5052327332276563, - -0.31461067764594497, - -0.02860128894112495 + 0.5045800000020342, + -0.3127500000092318, + -0.027300000006790923 ], "position_mm": [ - 505.2327332276563, - -314.610677645945, - -28.601288941124952 + 504.5800000020342, + -312.7500000092318, + -27.300000006790924 ], "link": "Board", "normal": [ @@ -485,14 +485,14 @@ { "marker_id": 86, "position_m": [ - 0.36255478065592384, - 0.2951968143044119, - -0.02903589102000064 + 0.3628900000084787, + 0.29200999999890775, + -0.027300000000480565 ], "position_mm": [ - 362.5547806559238, - 295.19681430441193, - -29.03589102000064 + 362.8900000084787, + 292.00999999890774, + -27.300000000480566 ], "link": "Board", "normal": [ @@ -504,14 +504,14 @@ { "marker_id": 92, "position_m": [ - 0.647609094189999, - -0.18750754754418164, - -0.02681176252783257 + 0.6450900000110146, + -0.18484000002823847, + -0.027300000009261798 ], "position_mm": [ - 647.609094189999, - -187.50754754418165, - -26.81176252783257 + 645.0900000110146, + -184.84000002823848, + -27.300000009261797 ], "link": "Board", "normal": [ @@ -523,14 +523,14 @@ { "marker_id": 95, "position_m": [ - 0.186262561904669, - -0.26836246119075224, - -0.026825122038875483 + 0.18604000000805365, + -0.27406999997800086, + -0.027299999994194708 ], "position_mm": [ - 186.262561904669, - -268.36246119075224, - -26.82512203887548 + 186.04000000805365, + -274.06999997800085, + -27.299999994194707 ], "link": "Board", "normal": [ @@ -542,14 +542,14 @@ { "marker_id": 96, "position_m": [ - 0.36974226201707755, - -0.18895941440950972, - -0.029917117770460532 + 0.36976999999887583, + -0.18649000003342558, + -0.027300000013514313 ], "position_mm": [ - 369.74226201707756, - -188.95941440950972, - -29.917117770460532 + 369.76999999887585, + -186.4900000334256, + -27.300000013514314 ], "link": "Board", "normal": [ @@ -561,14 +561,14 @@ { "marker_id": 97, "position_m": [ - 0.30573593471495575, - -0.3539299974438902, - -0.028688604748835767 + 0.3043500000038174, + -0.35966999996345184, + -0.027299999994730633 ], "position_mm": [ - 305.73593471495576, - -353.9299974438902, - -28.68860474883577 + 304.3500000038174, + -359.66999996345186, + -27.299999994730634 ], "link": "Board", "normal": [ @@ -580,14 +580,14 @@ { "marker_id": 102, "position_m": [ - 0.6532853169116069, - -0.22523581436884305, - -0.031471736394007105 + 0.6496900000090133, + -0.22300000002994805, + -0.027300000003426892 ], "position_mm": [ - 653.2853169116069, - -225.23581436884305, - -31.471736394007106 + 649.6900000090134, + -223.00000002994804, + -27.30000000342689 ], "link": "Board", "normal": [ @@ -599,14 +599,14 @@ { "marker_id": 103, "position_m": [ - 0.10587298764085004, - -0.1872685011631118, - -0.028756873558720263 + 0.10570999999966921, + -0.1877100000042866, + -0.027300000006104306 ], "position_mm": [ - 105.87298764085004, - -187.2685011631118, - -28.75687355872026 + 105.70999999966921, + -187.7100000042866, + -27.300000006104305 ], "link": "Board", "normal": [ @@ -618,14 +618,14 @@ { "marker_id": 105, "position_m": [ - 0.5268925468058784, - -0.2687493257903883, - -0.028050114591019405 + 0.5248400000008, + -0.266250000011556, + -0.027300000005354836 ], "position_mm": [ - 526.8925468058784, - -268.7493257903883, - -28.050114591019405 + 524.8400000008, + -266.25000001155604, + -27.300000005354836 ], "link": "Board", "normal": [ @@ -637,14 +637,14 @@ { "marker_id": 113, "position_m": [ - 0.28041637693260424, - -0.19872158877928978, - 0.2957722126619203 + 0.28041655515672465, + -0.19872202787736862, + 0.2957723820910251 ], "position_mm": [ - 280.41637693260424, - -198.7215887792898, - 295.77221266192026 + 280.41655515672466, + -198.72202787736862, + 295.77238209102507 ], "link": "Arm2", "normal": [ @@ -656,14 +656,14 @@ { "marker_id": 124, "position_m": [ - 0.3179510325507324, - -0.2390062904241294, - 0.3172875248346795 + 0.3179511335747054, + -0.23900686595704584, + 0.3172875736042142 ], "position_mm": [ - 317.9510325507324, - -239.00629042412942, - 317.28752483467946 + 317.9511335747054, + -239.00686595704585, + 317.28757360421423 ], "link": "Arm2", "normal": [ @@ -675,14 +675,14 @@ { "marker_id": 198, "position_m": [ - 0.13056884685316103, - -0.07389348412117368, - 0.13587886912748515 + 0.1305678934779346, + -0.07389339954733694, + 0.13587831139024056 ], "position_mm": [ - 130.56884685316103, - -73.89348412117367, - 135.87886912748516 + 130.5678934779346, + -73.89339954733694, + 135.87831139024055 ], "link": "Arm1", "normal": [ @@ -694,14 +694,14 @@ { "marker_id": 205, "position_m": [ - 0.748375356811976, - -0.09452600727786088, - 0.011969556185094469 + 0.7500000000102852, + -0.09000000002077212, + 0.0003000000047908272 ], "position_mm": [ - 748.375356811976, - -94.52600727786088, - 11.969556185094469 + 750.0000000102852, + -90.00000002077212, + 0.3000000047908272 ], "link": "Board", "normal": [ @@ -713,14 +713,14 @@ { "marker_id": 206, "position_m": [ - 0.6470440216888218, - -0.01371610726089136, - 0.007318694801492925 + 0.6499999999965762, + -0.009999999978380395, + 0.00030000001800584966 ], "position_mm": [ - 647.0440216888218, - -13.716107260891361, - 7.318694801492924 + 649.9999999965762, + -9.999999978380394, + 0.30000001800584963 ], "link": "Board", "normal": [ @@ -732,14 +732,14 @@ { "marker_id": 207, "position_m": [ - 0.7468786402756248, - -0.014546553422639141, - 0.013005282032526235 + 0.7499999999972703, + -0.009999999982210846, + 0.0003000000082263813 ], "position_mm": [ - 746.8786402756248, - -14.54655342263914, - 13.005282032526235 + 749.9999999972703, + -9.999999982210847, + 0.3000000082263813 ], "link": "Board", "normal": [ @@ -751,14 +751,14 @@ { "marker_id": 208, "position_m": [ - 0.3487272920557953, - -0.09413350037790832, - 0.001389765445743052 + 0.3499999999748163, + -0.09000000004800203, + 0.0002999999868283744 ], "position_mm": [ - 348.72729205579526, - -94.13350037790832, - 1.389765445743052 + 349.99999997481626, + -90.00000004800204, + 0.2999999868283744 ], "link": "Board", "normal": [ @@ -770,14 +770,14 @@ { "marker_id": 210, "position_m": [ - 0.018120861349245686, - -0.01738466109655536, - -0.0007950740683794831 + 0.019999999985949906, + -0.019999999992125886, + 0.0003000000053156064 ], "position_mm": [ - 18.120861349245686, - -17.38466109655536, - -0.795074068379483 + 19.999999985949906, + -19.999999992125886, + 0.3000000053156064 ], "link": "Board", "normal": [ @@ -789,14 +789,14 @@ { "marker_id": 211, "position_m": [ - 0.25068179595184664, - -0.011240353169632511, - 0.004935236021898448 + 0.24999999999517145, + -0.009999999994696722, + 0.0003000000159843018 ], "position_mm": [ - 250.68179595184665, - -11.240353169632511, - 4.935236021898448 + 249.99999999517144, + -9.999999994696722, + 0.3000000159843018 ], "link": "Board", "normal": [ @@ -808,14 +808,14 @@ { "marker_id": 214, "position_m": [ - 0.3507756143687356, - -0.014233440506156315, - 0.004826210435999327 + 0.3499999999960562, + -0.009999999984652053, + 0.0003000000168137388 ], "position_mm": [ - 350.7756143687356, - -14.233440506156315, - 4.826210435999327 + 349.9999999960562, + -9.999999984652053, + 0.3000000168137388 ], "link": "Board", "normal": [ @@ -827,14 +827,14 @@ { "marker_id": 217, "position_m": [ - 0.6499721820721994, - -0.09359823072313132, - 0.004107661422486767 + 0.6500000000030222, + -0.09000000000650436, + 0.0003000000167335214 ], "position_mm": [ - 649.9721820721994, - -93.59823072313132, - 4.107661422486768 + 650.0000000030221, + -90.00000000650437, + 0.3000000167335214 ], "link": "Board", "normal": [ @@ -846,14 +846,14 @@ { "marker_id": 229, "position_m": [ - 0.16640174681388165, - -0.1518263116866857, - 0.10863026418479936 + 0.1664016351598673, + -0.15182598489277338, + 0.10863012054339682 ], "position_mm": [ - 166.40174681388166, - -151.8263116866857, - 108.63026418479936 + 166.4016351598673, + -151.8259848927734, + 108.63012054339683 ], "link": "Arm1", "normal": [ @@ -865,14 +865,14 @@ { "marker_id": 243, "position_m": [ - 0.16847986408197693, - -0.17155976689014704, - 0.06328360140903642 + 0.16847984718022438, + -0.17155971955638796, + 0.06328358372084991 ], "position_mm": [ - 168.47986408197693, - -171.55976689014705, - 63.28360140903642 + 168.47984718022437, + -171.55971955638796, + 63.28358372084991 ], "link": "Arm1", "normal": [ @@ -884,14 +884,14 @@ { "marker_id": 244, "position_m": [ - 0.25553836987099976, - -0.02006360774474789, - 0.006208931593469432 + 0.2555374153548736, + -0.020064183575894814, + 0.006203550921159422 ], "position_mm": [ - 255.53836987099976, - -20.063607744747888, - 6.208931593469432 + 255.53741535487362, + -20.064183575894813, + 6.2035509211594215 ], "link": "Ellbow", "normal": [ @@ -903,14 +903,14 @@ { "marker_id": 245, "position_m": [ - 0.2406130307128613, - -0.06726290463887721, - 0.006046891493775955 + 0.24061408860575673, + -0.0672641401035908, + 0.006049684956170499 ], "position_mm": [ - 240.6130307128613, - -67.26290463887722, - 6.046891493775955 + 240.61408860575673, + -67.2641401035908, + 6.049684956170499 ], "link": "Ellbow", "normal": [ diff --git a/data/evaluations/Scene9/render_a_aruco_detection.json b/data/evaluations/Scene9/render_a_aruco_detection.json index 658d9e3..5202095 100644 --- a/data/evaluations/Scene9/render_a_aruco_detection.json +++ b/data/evaluations/Scene9/render_a_aruco_detection.json @@ -1,6 +1,6 @@ { "schema_version": "1.0", - "created_utc": "2026-06-01T16:29:08Z", + "created_utc": "2026-06-01T17:39:21Z", "vision_config": { "MarkerType": "DICT_4X4_250", "MarkerSize": 0.025 @@ -46,7 +46,7 @@ }, "detections": [ { - "observation_id": "828323f9-310c-46d4-9344-27a3b93ff5f7", + "observation_id": "48d34e1f-316c-41b2-b08f-eacad4634407", "type": "aruco", "marker_id": 42, "marker_size_m": 0.025, @@ -100,7 +100,7 @@ "confidence": 0.8374556851639195 }, { - "observation_id": "e8dca706-74d4-44d8-a48b-f37b80b5a987", + "observation_id": "8a4f303b-a202-4e19-9947-5967ce481f35", "type": "aruco", "marker_id": 43, "marker_size_m": 0.025, @@ -154,7 +154,7 @@ "confidence": 0.8294132973023032 }, { - "observation_id": "f0a5037d-f91a-4b5a-8a14-0aa7b751da61", + "observation_id": "32f7a44e-84f5-486e-82f1-303d7d0c9562", "type": "aruco", "marker_id": 219, "marker_size_m": 0.025, @@ -208,7 +208,7 @@ "confidence": 0.8981552472038941 }, { - "observation_id": "a659c0bc-ef7e-45ab-a3da-f09f78858d85", + "observation_id": "0dcc1d6d-ef68-4a2e-9d29-0f525c5e91c6", "type": "aruco", "marker_id": 218, "marker_size_m": 0.025, @@ -262,7 +262,7 @@ "confidence": 0.6805707817398313 }, { - "observation_id": "c0152252-d6f7-46e9-9c06-8a0174bf69f9", + "observation_id": "0fc4b5d9-d69f-4f3f-9955-7396c67f5298", "type": "aruco", "marker_id": 229, "marker_size_m": 0.025, @@ -316,7 +316,7 @@ "confidence": 0.6358432130578832 }, { - "observation_id": "4681004b-f93e-410a-8b95-35e8e4b1bdf9", + "observation_id": "6a37e879-b612-4efe-aeb9-6f2e951a4ba0", "type": "aruco", "marker_id": 47, "marker_size_m": 0.025, @@ -370,7 +370,7 @@ "confidence": 0.12146268776527554 }, { - "observation_id": "f4fa37cf-44bc-4ae8-8422-4a30fd3d7758", + "observation_id": "c128e9d6-67a6-401f-8ee2-a42b40745e6a", "type": "aruco", "marker_id": 113, "marker_size_m": 0.025, @@ -424,7 +424,7 @@ "confidence": 0.3676840060581848 }, { - "observation_id": "c48557f8-6193-42f2-8bc1-3677101f64d4", + "observation_id": "397fef0c-ee3f-4233-b3a4-9b59955fa904", "type": "aruco", "marker_id": 210, "marker_size_m": 0.025, @@ -478,7 +478,7 @@ "confidence": 0.46829700346999537 }, { - "observation_id": "1aba28a0-3c4e-42d7-bcc5-9bef8639e5f0", + "observation_id": "bba2b49f-c371-43a6-8bba-c87e16f04ae3", "type": "aruco", "marker_id": 243, "marker_size_m": 0.025, @@ -532,7 +532,7 @@ "confidence": 0.4531062923543488 }, { - "observation_id": "531eca86-3fbd-4caf-9ac4-51794ec44b19", + "observation_id": "c5a773d6-c4c6-490d-be11-c9e5fcb33ae8", "type": "aruco", "marker_id": 245, "marker_size_m": 0.025, @@ -586,7 +586,7 @@ "confidence": 0.5158823529411765 }, { - "observation_id": "5a41b11c-6fa8-4660-a476-8fa5c89565fe", + "observation_id": "8332365e-d9cc-49ad-86e5-dece63b32eab", "type": "aruco", "marker_id": 198, "marker_size_m": 0.025, @@ -640,7 +640,7 @@ "confidence": 0.5036164123338793 }, { - "observation_id": "9bbfc8ae-1537-40ef-a506-16bf7f61716b", + "observation_id": "4e4b0d16-6789-4f9a-b1fb-bc880d1cf9cf", "type": "aruco", "marker_id": 85, "marker_size_m": 0.025, @@ -694,7 +694,7 @@ "confidence": 0.4560525484643318 }, { - "observation_id": "c2756a47-fcac-4831-b093-001921f5164a", + "observation_id": "152a5dac-6010-43da-9ce3-1b60f59bcfdb", "type": "aruco", "marker_id": 79, "marker_size_m": 0.025, @@ -748,7 +748,7 @@ "confidence": 0.5734281513866332 }, { - "observation_id": "a6e55917-816e-40ae-ac6a-b9135c601baf", + "observation_id": "d6694108-bb92-466d-a0c1-f07c287cb78d", "type": "aruco", "marker_id": 96, "marker_size_m": 0.025, @@ -802,7 +802,7 @@ "confidence": 0.525542829627259 }, { - "observation_id": "d8e82891-13f7-4b17-82d5-e6b1e815b740", + "observation_id": "37e7cc83-6cf5-4fd5-8764-0b123d1eff82", "type": "aruco", "marker_id": 62, "marker_size_m": 0.025, @@ -856,7 +856,7 @@ "confidence": 0.5038606541951498 }, { - "observation_id": "f130b885-4944-4fbe-83d8-b34ded9fb490", + "observation_id": "5c384a47-63b5-4314-a58f-69d37e107791", "type": "aruco", "marker_id": 105, "marker_size_m": 0.025, @@ -910,7 +910,7 @@ "confidence": 0.43622925667631085 }, { - "observation_id": "410902c1-0e7f-4bc4-9d84-11cd8f0a3da9", + "observation_id": "a847e666-a038-420b-a83a-879ad7d63152", "type": "aruco", "marker_id": 75, "marker_size_m": 0.025, @@ -964,7 +964,7 @@ "confidence": 0.29844141482805986 }, { - "observation_id": "43eb0f4e-1f52-4a50-b6c1-7795198aef5e", + "observation_id": "a32a483d-ab92-454b-b9fa-4139156f1194", "type": "aruco", "marker_id": 102, "marker_size_m": 0.025, @@ -1018,7 +1018,7 @@ "confidence": 0.2521714913889437 }, { - "observation_id": "975b649d-b9fa-482b-afee-9e346fe81467", + "observation_id": "1f45aa9a-b74c-4ae9-90c5-461c5224749b", "type": "aruco", "marker_id": 92, "marker_size_m": 0.025, @@ -1072,7 +1072,7 @@ "confidence": 0.31777455864589965 }, { - "observation_id": "80bf45f1-1eff-4f87-aaee-3e4467ef8b98", + "observation_id": "b640bb03-e99e-4e70-bfea-cb1110bb6d3f", "type": "aruco", "marker_id": 217, "marker_size_m": 0.025, @@ -1126,7 +1126,7 @@ "confidence": 0.3029173397022545 }, { - "observation_id": "f55388ff-734e-41bc-bcc7-d2293a7f1e8f", + "observation_id": "4d1e838c-bbd3-4249-a4e5-7cd8394dd041", "type": "aruco", "marker_id": 61, "marker_size_m": 0.025, @@ -1180,7 +1180,7 @@ "confidence": 0.1527342148240039 }, { - "observation_id": "65f8ec9b-8645-4d42-aed0-874e0ca86d32", + "observation_id": "b14c4e71-1615-40b5-8804-685b2c388538", "type": "aruco", "marker_id": 83, "marker_size_m": 0.025, @@ -1234,7 +1234,7 @@ "confidence": 0.19743498130596515 }, { - "observation_id": "c36df8de-41a8-4013-8af8-79730d571343", + "observation_id": "c51fa6c5-c5b5-4593-aedf-6c3736e772d6", "type": "aruco", "marker_id": 206, "marker_size_m": 0.025, @@ -1288,7 +1288,7 @@ "confidence": 0.2849187633475991 }, { - "observation_id": "ef83c693-58f2-4b6a-ae77-4f0973f2ab4f", + "observation_id": "669db1c5-a779-4ad8-b2fc-b937f0f1136e", "type": "aruco", "marker_id": 207, "marker_size_m": 0.025, @@ -1342,7 +1342,7 @@ "confidence": 0.24627951083020566 }, { - "observation_id": "3234410e-0132-4c28-8255-b4296e75b8a7", + "observation_id": "665e11e6-4483-4ec9-80f3-a411f7460e8b", "type": "aruco", "marker_id": 72, "marker_size_m": 0.025, @@ -1396,7 +1396,7 @@ "confidence": 0.1970529186973567 }, { - "observation_id": "3c35350f-ca0c-42ee-aeec-68b460af032f", + "observation_id": "e1266e51-667e-42cf-826e-544bfc399a32", "type": "aruco", "marker_id": 84, "marker_size_m": 0.025, @@ -1450,7 +1450,7 @@ "confidence": 0.1988568274481309 }, { - "observation_id": "de89e570-6291-4e53-97d2-c611dd878d05", + "observation_id": "6465eb50-c9fb-4e8c-8c8c-8676a576f05d", "type": "aruco", "marker_id": 86, "marker_size_m": 0.025, @@ -1504,7 +1504,7 @@ "confidence": 0.17646704338372862 }, { - "observation_id": "dcbb80cf-60c7-4adb-a167-b19c93d5beb6", + "observation_id": "952a6f64-3139-468b-9899-03cd9365b71c", "type": "aruco", "marker_id": 93, "marker_size_m": 0.025, diff --git a/data/evaluations/Scene9/render_a_camera_pose.json b/data/evaluations/Scene9/render_a_camera_pose.json index b5ba08b..5a05061 100644 --- a/data/evaluations/Scene9/render_a_camera_pose.json +++ b/data/evaluations/Scene9/render_a_camera_pose.json @@ -1,6 +1,6 @@ { "schema_version": "1.0", - "created_utc": "2026-06-01T16:29:13Z", + "created_utc": "2026-06-01T17:39:26Z", "source": { "detection_json": "C:\\Users\\kech\\SynologyDrive\\2026-AppServer-AppRobot\\appRobotRendering\\data\\evaluations\\Scene9\\render_a_aruco_detection.json", "robot_json": "C:\\Users\\kech\\SynologyDrive\\2026-AppServer-AppRobot\\appRobotRendering\\data\\robot\\robot.json" diff --git a/data/evaluations/Scene9/render_a_camera_pose_v8.json b/data/evaluations/Scene9/render_a_camera_pose_v8.json new file mode 100644 index 0000000..0f7be8d --- /dev/null +++ b/data/evaluations/Scene9/render_a_camera_pose_v8.json @@ -0,0 +1,471 @@ +{ + "schema_version": "1.0", + "created_utc": "2026-06-01T17:39:38Z", + "source": { + "detection_json": "C:\\Users\\kech\\SynologyDrive\\2026-AppServer-AppRobot\\appRobotRendering\\data\\evaluations\\Scene9\\render_a_aruco_detection.json", + "robot_json": "C:\\Users\\kech\\SynologyDrive\\2026-AppServer-AppRobot\\appRobotRendering\\data\\robot\\robot.json" + }, + "camera": { + "camera_id": "a", + "camera_matrix": [ + [ + 1777.77783203125, + 0.0, + 640.0 + ], + [ + 0.0, + 1500.0, + 360.0 + ], + [ + 0.0, + 0.0, + 1.0 + ] + ], + "distortion_coefficients": [ + 0.0, + 0.0, + 0.0, + 0.0, + 0.0 + ] + }, + "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": 19, + "used_marker_ids": [ + 47, + 210, + 85, + 79, + 96, + 62, + 105, + 75, + 102, + 92, + 217, + 61, + 83, + 206, + 207, + 72, + 84, + 86, + 93 + ], + "history": { + "iters": [ + 0, + 1, + 2, + 3, + 4 + ], + "rms": [ + 0.01688824416861389, + 0.0026488948713162797, + 0.0022847901177283567, + 0.002284778536088292, + 0.0022847785345118145 + ], + "lambda": [ + 0.001, + 0.0005, + 0.00025, + 0.000125, + 6.25e-05 + ] + }, + "residual_rms_px": 5.260777163796182, + "residual_median_px": 3.9336177789442863, + "residual_max_px": 9.206418967088428, + "sigma2_normalized": 6.199002880217139e-06 + }, + "camera_pose": { + "world_to_camera": { + "rotation_matrix": [ + [ + 0.8034524321556091, + -0.5953208208084106, + 0.0075734867714345455 + ], + [ + -0.40606069564819336, + -0.5572388172149658, + -0.7242924571037292 + ], + [ + 0.4354065954685211, + 0.578859269618988, + -0.689451277256012 + ] + ], + "translation_m": [ + -0.22688822381054466, + 0.24849895309534112, + 1.18343443222719 + ], + "rvec_rad": [ + 2.2371428918604392, + -0.7344684570702414, + 0.32490605356533975 + ] + }, + "camera_in_world": { + "position_m": [ + -0.23207562983899432, + -0.6816399528075987, + 0.9976246180294603 + ], + "position_mm": [ + -232.07562983899433, + -681.6399528075987, + 997.6246180294603 + ], + "orientation_deg": { + "roll": 139.98336791992188, + "pitch": -25.811166763305664, + "yaw": -26.81179428100586 + } + }, + "uncertainty": { + "pose_covariance_6x6": [ + [ + 4.097591089411523e-05, + -1.3516690365163344e-05, + 3.233947921489375e-06, + 2.8375694519427413e-06, + 6.358422974851678e-06, + 1.0788754679638468e-05 + ], + [ + -1.3516690365163376e-05, + 1.6114384837211145e-05, + -8.778002475074104e-06, + -3.914652718179436e-06, + -4.423000384742518e-06, + -1.9181520799013528e-06 + ], + [ + 3.233947921489427e-06, + -8.77800247507413e-06, + 5.513946330528815e-05, + 8.433095193903186e-06, + -4.2346249444135545e-06, + -1.2253759154226465e-05 + ], + [ + 2.8375694519427536e-06, + -3.914652718179437e-06, + 8.433095193903184e-06, + 2.3821183334401835e-06, + 3.118681673870334e-07, + -3.036440640129871e-07 + ], + [ + 6.358422974851689e-06, + -4.42300038474252e-06, + -4.234624944413562e-06, + 3.1186816738703346e-07, + 2.862874214018809e-06, + 3.601866363327852e-06 + ], + [ + 1.0788754679638462e-05, + -1.9181520799013405e-06, + -1.2253759154226542e-05, + -3.0364406401299863e-07, + 3.6018663633278545e-06, + 1.615160848576946e-05 + ] + ], + "parameter_std": { + "rvec_std_deg": [ + 0.3667642028343509, + 0.23000088015077183, + 0.42545526236590314 + ], + "tvec_std_m": [ + 0.0015434112651656342, + 0.001692003018324379, + 0.00401890637932379 + ] + }, + "camera_center_std_m": [ + 0.006748912533574303, + 0.007725868343634181, + 0.007397731347808048 + ], + "camera_center_std_mm": [ + 6.748912533574303, + 7.725868343634182, + 7.397731347808048 + ], + "orientation_std_deg": { + "roll": 0.4950206613769511, + "pitch": 0.3279056973051422, + "yaw": 0.2131206805888579 + } + } + }, + "observations": { + "markers": [ + { + "marker_id": 47, + "observed_center_px": [ + 984.25, + 690.75 + ], + "projected_center_px": [ + 981.2843627929688, + 684.5106811523438 + ], + "reprojection_error_px": 6.908263437829121, + "confidence": 0.12146268776527554 + }, + { + "marker_id": 210, + "observed_center_px": [ + 324.0, + 632.0 + ], + "projected_center_px": [ + 331.15069580078125, + 637.7987670898438 + ], + "reprojection_error_px": 9.206418967088428, + "confidence": 0.46829700346999537 + }, + { + "marker_id": 85, + "observed_center_px": [ + 1183.75, + 610.25 + ], + "projected_center_px": [ + 1179.2086181640625, + 606.8020629882812 + ], + "reprojection_error_px": 5.701966206192657, + "confidence": 0.4560525484643318 + }, + { + "marker_id": 79, + "observed_center_px": [ + 814.0, + 599.0 + ], + "projected_center_px": [ + 815.020751953125, + 596.3807373046875 + ], + "reprojection_error_px": 2.811133511035042, + "confidence": 0.5734281513866332 + }, + { + "marker_id": 96, + "observed_center_px": [ + 905.25, + 587.25 + ], + "projected_center_px": [ + 904.92529296875, + 584.64599609375 + ], + "reprojection_error_px": 2.624170535599477, + "confidence": 0.525542829627259 + }, + { + "marker_id": 62, + "observed_center_px": [ + 931.0, + 557.5 + ], + "projected_center_px": [ + 930.7962036132812, + 555.8448486328125 + ], + "reprojection_error_px": 1.6676507474715048, + "confidence": 0.5038606541951498 + }, + { + "marker_id": 105, + "observed_center_px": [ + 1150.25, + 560.25 + ], + "projected_center_px": [ + 1147.2882080078125, + 558.3479614257812 + ], + "reprojection_error_px": 3.5199378606449994, + "confidence": 0.43622925667631085 + }, + { + "marker_id": 75, + "observed_center_px": [ + 128.5, + 514.75 + ], + "projected_center_px": [ + 129.98768615722656, + 514.7237548828125 + ], + "reprojection_error_px": 1.4879176417328084, + "confidence": 0.29844141482805986 + }, + { + "marker_id": 102, + "observed_center_px": [ + 1217.75, + 461.5 + ], + "projected_center_px": [ + 1217.2900390625, + 461.2925720214844 + ], + "reprojection_error_px": 0.5045695495141949, + "confidence": 0.2521714913889437 + }, + { + "marker_id": 92, + "observed_center_px": [ + 1173.25, + 437.75 + ], + "projected_center_px": [ + 1173.5399169921875, + 438.0331115722656 + ], + "reprojection_error_px": 0.4052209578856468, + "confidence": 0.31777455864589965 + }, + { + "marker_id": 217, + "observed_center_px": [ + 1087.75, + 347.0 + ], + "projected_center_px": [ + 1091.2442626953125, + 354.3226623535156 + ], + "reprojection_error_px": 8.113646265856527, + "confidence": 0.3029173397022545 + }, + { + "marker_id": 61, + "observed_center_px": [ + 58.5, + 415.5 + ], + "projected_center_px": [ + 54.10175704956055, + 416.18798828125 + ], + "reprojection_error_px": 4.4517265107177995, + "confidence": 0.1527342148240039 + }, + { + "marker_id": 83, + "observed_center_px": [ + 139.0, + 383.0 + ], + "projected_center_px": [ + 133.5531005859375, + 383.4892272949219 + ], + "reprojection_error_px": 5.468825886148779, + "confidence": 0.19743498130596515 + }, + { + "marker_id": 206, + "observed_center_px": [ + 1013.0, + 301.0 + ], + "projected_center_px": [ + 1017.0421142578125, + 307.5049133300781 + ], + "reprojection_error_px": 7.6584975749189335, + "confidence": 0.2849187633475991 + }, + { + "marker_id": 207, + "observed_center_px": [ + 1098.0, + 262.0 + ], + "projected_center_px": [ + 1103.2645263671875, + 267.52166748046875 + ], + "reprojection_error_px": 7.629157858877907, + "confidence": 0.24627951083020566 + }, + { + "marker_id": 72, + "observed_center_px": [ + 655.75, + 300.75 + ], + "projected_center_px": [ + 654.464599609375, + 299.97552490234375 + ], + "reprojection_error_px": 1.500688455712431, + "confidence": 0.1970529186973567 + }, + { + "marker_id": 84, + "observed_center_px": [ + 579.25, + 279.75 + ], + "projected_center_px": [ + 576.6786499023438, + 278.639404296875 + ], + "reprojection_error_px": 2.80093986735105, + "confidence": 0.1988568274481309 + }, + { + "marker_id": 86, + "observed_center_px": [ + 514.0, + 278.75 + ], + "projected_center_px": [ + 510.1328430175781, + 278.02996826171875 + ], + "reprojection_error_px": 3.9336177789442863, + "confidence": 0.17646704338372862 + }, + { + "marker_id": 93, + "observed_center_px": [ + 1104.25, + 154.5 + ], + "projected_center_px": [ + 1111.6312255859375, + 150.52688598632812 + ], + "reprojection_error_px": 8.38260855081127, + "confidence": 0.15396639291733288 + } + ] + }, + "qa": { + "sanity_notes": [] + }, + "v8_z_correction_mm": 54.81633454946478 +} \ No newline at end of file diff --git a/data/evaluations/Scene9/render_b_aruco_detection.json b/data/evaluations/Scene9/render_b_aruco_detection.json index 757199e..da1d0aa 100644 --- a/data/evaluations/Scene9/render_b_aruco_detection.json +++ b/data/evaluations/Scene9/render_b_aruco_detection.json @@ -1,6 +1,6 @@ { "schema_version": "1.0", - "created_utc": "2026-06-01T16:29:09Z", + "created_utc": "2026-06-01T17:39:22Z", "vision_config": { "MarkerType": "DICT_4X4_250", "MarkerSize": 0.025 @@ -46,7 +46,7 @@ }, "detections": [ { - "observation_id": "9659e815-c908-4da1-908f-69eb1b7c9eda", + "observation_id": "c78e63e3-caad-4650-97c4-6d953036f7ab", "type": "aruco", "marker_id": 43, "marker_size_m": 0.025, @@ -100,7 +100,7 @@ "confidence": 0.7925285650886857 }, { - "observation_id": "bb51ce4c-d6e9-4f5d-b332-78eceeda6e04", + "observation_id": "1bbceeb3-7583-4585-a24f-0bdc472825ff", "type": "aruco", "marker_id": 63, "marker_size_m": 0.025, @@ -154,7 +154,7 @@ "confidence": 0.1539593300495616 }, { - "observation_id": "6e0118bd-590a-422e-9463-c897ae23c0bb", + "observation_id": "ccaf4f90-f7bc-42df-86b1-6c1fa3deb7b7", "type": "aruco", "marker_id": 229, "marker_size_m": 0.025, @@ -208,7 +208,7 @@ "confidence": 0.4787342723608016 }, { - "observation_id": "7e33f2a8-ecb8-45cd-a78e-8fe5436be64d", + "observation_id": "44ddd894-bd0d-4b7a-92e4-860d5d3deee9", "type": "aruco", "marker_id": 102, "marker_size_m": 0.025, @@ -262,7 +262,7 @@ "confidence": 0.39637168760361213 }, { - "observation_id": "91e4ed36-b110-4ec0-9790-c7f313b1f698", + "observation_id": "e7834e37-252d-441c-b9c0-9f8cb72c7ff2", "type": "aruco", "marker_id": 64, "marker_size_m": 0.025, @@ -316,7 +316,7 @@ "confidence": 0.4633649853376546 }, { - "observation_id": "bf9d8b2c-0bee-4833-8dec-2adb5c88faef", + "observation_id": "8c74ab86-3679-4555-bb0b-44c6cb87461b", "type": "aruco", "marker_id": 58, "marker_size_m": 0.025, @@ -370,7 +370,7 @@ "confidence": 0.3638956157928849 }, { - "observation_id": "d250d2bb-be6a-4f93-9b43-548fd087ca0e", + "observation_id": "e4542236-25af-4e65-be63-85e78ee7acd9", "type": "aruco", "marker_id": 113, "marker_size_m": 0.025, @@ -424,7 +424,7 @@ "confidence": 0.33787297122479 }, { - "observation_id": "e863518f-eb06-4a3b-b258-3d09a8d54203", + "observation_id": "a1f6675f-9f20-41ab-ae0e-c59d83bd42af", "type": "aruco", "marker_id": 92, "marker_size_m": 0.025, @@ -478,7 +478,7 @@ "confidence": 0.46896024883690896 }, { - "observation_id": "ac190ef4-a8ad-46d6-afec-28924b9ae5b2", + "observation_id": "84a1bfed-885f-4b52-859f-3f8d5e86bcb1", "type": "aruco", "marker_id": 96, "marker_size_m": 0.025, @@ -532,7 +532,7 @@ "confidence": 0.44372569385651617 }, { - "observation_id": "9f3e2a15-836e-4616-b6b4-5e6cae4411be", + "observation_id": "b0ae235c-38bf-4950-8cc1-dd40370935c1", "type": "aruco", "marker_id": 103, "marker_size_m": 0.025, @@ -586,7 +586,7 @@ "confidence": 0.45199802144368495 }, { - "observation_id": "1cdfcfd8-9dae-4496-ab03-302271e6e919", + "observation_id": "03a035ff-f9a8-4ebf-b2aa-d284dd5cace6", "type": "aruco", "marker_id": 62, "marker_size_m": 0.025, @@ -640,7 +640,7 @@ "confidence": 0.44348322079976393 }, { - "observation_id": "89897f91-b8bf-4b76-9513-e624cf6effc4", + "observation_id": "b30718cb-749b-47ca-8d8a-bff1e0a74848", "type": "aruco", "marker_id": 51, "marker_size_m": 0.025, @@ -694,7 +694,7 @@ "confidence": 0.44348322079976393 }, { - "observation_id": "a0a83014-19e8-4571-a03b-b12f5ce9f59d", + "observation_id": "35ab7717-b6a7-427a-9786-a201208573a9", "type": "aruco", "marker_id": 42, "marker_size_m": 0.025, @@ -748,7 +748,7 @@ "confidence": 0.24113570084112637 }, { - "observation_id": "b6b5e1a6-9c90-4d2a-aaa6-3ad0faee7c17", + "observation_id": "b67c9edd-1ea1-4d69-a7fd-d3fe404dec6a", "type": "aruco", "marker_id": 79, "marker_size_m": 0.025, @@ -802,7 +802,7 @@ "confidence": 0.41815762699787656 }, { - "observation_id": "07d65889-ec09-4529-b098-4b5eb82e0100", + "observation_id": "f3ab75a9-e24a-4ff4-9534-fdf5d2c4fe53", "type": "aruco", "marker_id": 205, "marker_size_m": 0.025, @@ -856,7 +856,7 @@ "confidence": 0.3958181457519531 }, { - "observation_id": "bccb3dba-4381-4620-8b34-d1c75d492b89", + "observation_id": "5f7c5a31-c8e7-4a87-81b8-f1fa2218786a", "type": "aruco", "marker_id": 198, "marker_size_m": 0.025, @@ -910,7 +910,7 @@ "confidence": 0.3918555899450243 }, { - "observation_id": "da29a6ad-b0d2-43d6-b798-771cb96460ce", + "observation_id": "d8854b7d-9151-46d1-82e6-f58f2a5b1a0c", "type": "aruco", "marker_id": 217, "marker_size_m": 0.025, @@ -964,7 +964,7 @@ "confidence": 0.4015868133874269 }, { - "observation_id": "eff35d03-2dcd-47ea-a1f6-2080b43bf3e6", + "observation_id": "5ee65273-d7d2-4b06-be24-fa05dd7e6c79", "type": "aruco", "marker_id": 208, "marker_size_m": 0.025, @@ -1018,7 +1018,7 @@ "confidence": 0.3776 }, { - "observation_id": "d7647185-397f-4695-9838-e8b225164305", + "observation_id": "e7095cb9-07de-41f4-84af-f772a83a6686", "type": "aruco", "marker_id": 210, "marker_size_m": 0.025, @@ -1072,7 +1072,7 @@ "confidence": 0.3320910299473707 }, { - "observation_id": "a8724dea-465e-4f9c-b6d8-218caf590ac7", + "observation_id": "c2de495a-74a8-4acb-b33f-d0c7df3ace75", "type": "aruco", "marker_id": 214, "marker_size_m": 0.025, @@ -1126,7 +1126,7 @@ "confidence": 0.3465862068965517 }, { - "observation_id": "459f23c1-75e5-4707-a841-a2cf6b36dbf7", + "observation_id": "771ab1ef-09b2-4c1f-b8b6-81ebb9ddf83c", "type": "aruco", "marker_id": 206, "marker_size_m": 0.025, @@ -1180,7 +1180,7 @@ "confidence": 0.3579602826436361 }, { - "observation_id": "2ae83c33-763c-4eae-bac8-ebf7b16fc90f", + "observation_id": "fe84711c-552f-471a-ba9e-61e529b48828", "type": "aruco", "marker_id": 207, "marker_size_m": 0.025, @@ -1234,7 +1234,7 @@ "confidence": 0.343462485354258 }, { - "observation_id": "f8661ad5-5243-4698-8b2d-5dbbf16cf0d1", + "observation_id": "f9b1e73d-de29-4435-bebd-aeb7ba101800", "type": "aruco", "marker_id": 245, "marker_size_m": 0.025, @@ -1288,7 +1288,7 @@ "confidence": 0.212625 }, { - "observation_id": "41608084-4852-417c-8712-0e2025c9d1e4", + "observation_id": "9478d653-33c8-4c62-8e5d-fdaae66be786", "type": "aruco", "marker_id": 243, "marker_size_m": 0.025, @@ -1342,7 +1342,7 @@ "confidence": 0.15432248002290727 }, { - "observation_id": "ef9d2529-d326-4efc-b271-a9da60d98479", + "observation_id": "a5a23764-c387-426a-ac12-26ee308c9b65", "type": "aruco", "marker_id": 94, "marker_size_m": 0.025, @@ -1396,7 +1396,7 @@ "confidence": 0.06057156860351561 }, { - "observation_id": "2390282b-6b9e-459a-b42a-e3fc85529d3a", + "observation_id": "c43a6058-aa64-417b-8316-c9852e42cf81", "type": "aruco", "marker_id": 76, "marker_size_m": 0.025, @@ -1450,7 +1450,7 @@ "confidence": 0.2459421895345052 }, { - "observation_id": "362bf6d9-548d-4e08-92d7-040bf6216830", + "observation_id": "3a8791f0-5b36-47fb-a924-9d9e79befae7", "type": "aruco", "marker_id": 100, "marker_size_m": 0.025, @@ -1504,7 +1504,7 @@ "confidence": 0.24407473894265982 }, { - "observation_id": "83e0d56a-8a0a-441c-9a7c-0f3a2adab5d6", + "observation_id": "7458d560-f629-4981-bde1-e36648a0a966", "type": "aruco", "marker_id": 75, "marker_size_m": 0.025, @@ -1558,7 +1558,7 @@ "confidence": 0.23896265492072474 }, { - "observation_id": "dfa42ae4-5d5f-436c-8523-f64088821bc6", + "observation_id": "ac6fa9f7-4ff5-4c4c-8edd-49e1282ceced", "type": "aruco", "marker_id": 68, "marker_size_m": 0.025, @@ -1612,7 +1612,7 @@ "confidence": 0.24909137483284013 }, { - "observation_id": "3b56e5cc-d5c0-40f4-8da7-3a2f2f963359", + "observation_id": "a7b159a9-bd34-4e86-a261-401ad41c902d", "type": "aruco", "marker_id": 46, "marker_size_m": 0.025, @@ -1666,7 +1666,7 @@ "confidence": 0.23734254719660833 }, { - "observation_id": "188d5832-fc7f-41c6-8c05-86f0b0b76849", + "observation_id": "6452eb7d-45e7-4d15-9709-322becfff4f6", "type": "aruco", "marker_id": 50, "marker_size_m": 0.025, @@ -1720,7 +1720,7 @@ "confidence": 0.2211554500544793 }, { - "observation_id": "8b42b396-c6d1-4b79-b1fe-5dc266132b48", + "observation_id": "2f94e32e-e2ea-48bc-964b-98617cb16656", "type": "aruco", "marker_id": 72, "marker_size_m": 0.025, @@ -1774,7 +1774,7 @@ "confidence": 0.21841319450965294 }, { - "observation_id": "6c60a978-18b7-41c8-b4c5-4edc4dd34998", + "observation_id": "a58f4696-c341-42ea-a855-14dac03148c9", "type": "aruco", "marker_id": 104, "marker_size_m": 0.025, @@ -1828,7 +1828,7 @@ "confidence": 0.22417849731445313 }, { - "observation_id": "36f8ea87-87d7-4ccf-b790-b1d193ba42f2", + "observation_id": "e99bbb66-100f-4885-99b8-f44b41a7aa6f", "type": "aruco", "marker_id": 53, "marker_size_m": 0.025, @@ -1882,7 +1882,7 @@ "confidence": 0.22367025973033955 }, { - "observation_id": "485c6fb1-a7d3-436e-b120-b6e0a71c5813", + "observation_id": "613cd1a1-71e6-425b-bc59-7d06e24ba992", "type": "aruco", "marker_id": 60, "marker_size_m": 0.025, @@ -1936,7 +1936,7 @@ "confidence": 0.19874429613402733 }, { - "observation_id": "564a32f5-2a1e-4fe4-baf9-4ebc8d092a3c", + "observation_id": "a6991594-f31a-4413-b924-3da488f47feb", "type": "aruco", "marker_id": 67, "marker_size_m": 0.025, @@ -1990,7 +1990,7 @@ "confidence": 0.19627771759033205 }, { - "observation_id": "004aa822-ce11-4fde-a299-cb65a9f30194", + "observation_id": "66edebca-c6fa-44dd-b8a1-71e17f61d3c5", "type": "aruco", "marker_id": 86, "marker_size_m": 0.025, @@ -2044,7 +2044,7 @@ "confidence": 0.18966921411877496 }, { - "observation_id": "ba4a0f09-9e46-4ae8-8a61-6f2762ee6458", + "observation_id": "b084b394-47d2-4149-8a84-b3fb160d8bcb", "type": "aruco", "marker_id": 88, "marker_size_m": 0.025, @@ -2098,7 +2098,7 @@ "confidence": 0.17697203515072252 }, { - "observation_id": "fc9b01b8-57d0-49df-8e23-fc673185a297", + "observation_id": "b126f36f-0cc9-405c-95ae-755ad7b1e5ca", "type": "aruco", "marker_id": 70, "marker_size_m": 0.025, @@ -2152,7 +2152,7 @@ "confidence": 0.193995418548584 }, { - "observation_id": "c2898182-1f5e-47db-b804-0bdb0b4eadfd", + "observation_id": "e854fdee-0c99-4c89-9985-50c3b8723b5b", "type": "aruco", "marker_id": 90, "marker_size_m": 0.025, @@ -2206,7 +2206,7 @@ "confidence": 0.17958947754575058 }, { - "observation_id": "36822611-9dc9-4db5-b7f7-9fbf3b862e42", + "observation_id": "2f854f7f-273b-41cd-ba76-d324ea923a09", "type": "aruco", "marker_id": 83, "marker_size_m": 0.025, @@ -2260,7 +2260,7 @@ "confidence": 0.17676838843571283 }, { - "observation_id": "fa9c29c4-4e34-4854-80e5-dd536c34128b", + "observation_id": "ce0ab490-eb43-4db8-ab4b-0416e44b6ed2", "type": "aruco", "marker_id": 61, "marker_size_m": 0.025, @@ -2314,7 +2314,7 @@ "confidence": 0.1668050360320266 }, { - "observation_id": "fa4b2148-c749-4d63-97dd-4a67f62997f2", + "observation_id": "4c417fee-edbb-43b8-801a-88cd9ecb16fe", "type": "aruco", "marker_id": 91, "marker_size_m": 0.025, diff --git a/data/evaluations/Scene9/render_b_camera_pose.json b/data/evaluations/Scene9/render_b_camera_pose.json index 648451d..daec4e4 100644 --- a/data/evaluations/Scene9/render_b_camera_pose.json +++ b/data/evaluations/Scene9/render_b_camera_pose.json @@ -1,6 +1,6 @@ { "schema_version": "1.0", - "created_utc": "2026-06-01T16:29:13Z", + "created_utc": "2026-06-01T17:39:27Z", "source": { "detection_json": "C:\\Users\\kech\\SynologyDrive\\2026-AppServer-AppRobot\\appRobotRendering\\data\\evaluations\\Scene9\\render_b_aruco_detection.json", "robot_json": "C:\\Users\\kech\\SynologyDrive\\2026-AppServer-AppRobot\\appRobotRendering\\data\\robot\\robot.json" diff --git a/data/evaluations/Scene9/render_b_camera_pose_v8.json b/data/evaluations/Scene9/render_b_camera_pose_v8.json new file mode 100644 index 0000000..2657c77 --- /dev/null +++ b/data/evaluations/Scene9/render_b_camera_pose_v8.json @@ -0,0 +1,712 @@ +{ + "schema_version": "1.0", + "created_utc": "2026-06-01T17:39:38Z", + "source": { + "detection_json": "C:\\Users\\kech\\SynologyDrive\\2026-AppServer-AppRobot\\appRobotRendering\\data\\evaluations\\Scene9\\render_b_aruco_detection.json", + "robot_json": "C:\\Users\\kech\\SynologyDrive\\2026-AppServer-AppRobot\\appRobotRendering\\data\\robot\\robot.json" + }, + "camera": { + "camera_id": "b", + "camera_matrix": [ + [ + 1777.77783203125, + 0.0, + 640.0 + ], + [ + 0.0, + 1500.0, + 360.0 + ], + [ + 0.0, + 0.0, + 1.0 + ] + ], + "distortion_coefficients": [ + 0.0, + 0.0, + 0.0, + 0.0, + 0.0 + ] + }, + "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": 36, + "used_marker_ids": [ + 63, + 102, + 64, + 58, + 92, + 96, + 103, + 62, + 51, + 79, + 205, + 217, + 208, + 210, + 214, + 206, + 207, + 94, + 76, + 100, + 75, + 68, + 46, + 50, + 72, + 104, + 53, + 60, + 67, + 86, + 88, + 70, + 90, + 83, + 61, + 91 + ], + "history": { + "iters": [ + 0, + 1, + 2, + 3, + 4, + 5 + ], + "rms": [ + 0.018586687295892478, + 0.004524773188371243, + 0.004401379732697687, + 0.004400889630930333, + 0.004400885875121036, + 0.004400885841339656 + ], + "lambda": [ + 0.001, + 0.0005, + 0.00025, + 0.000125, + 6.25e-05, + 3.125e-05 + ] + }, + "residual_rms_px": 10.292890093493769, + "residual_median_px": 7.4678436874840095, + "residual_max_px": 24.31129229011066, + "sigma2_normalized": 2.1128504929624298e-05 + }, + "camera_pose": { + "world_to_camera": { + "rotation_matrix": [ + [ + 0.9994555115699768, + -0.02737392485141754, + 0.018421687185764313 + ], + [ + -0.016220903024077415, + -0.8938210010528564, + -0.44813042879104614 + ], + [ + 0.028732780367136, + 0.44758760929107666, + -0.893778383731842 + ] + ], + "translation_m": [ + -0.3129983147776608, + 0.09796694849823295, + 1.519483216405018 + ], + "rvec_rad": [ + 2.676766457100025, + -0.030813699542104743, + 0.03332972568205707 + ] + }, + "camera_in_world": { + "position_m": [ + 0.2707580244494364, + -0.6011049259069332, + 1.407749117047217 + ], + "position_mm": [ + 270.7580244494364, + -601.1049259069332, + 1407.749117047217 + ], + "orientation_deg": { + "roll": 153.3991241455078, + "pitch": -1.6464935541152954, + "yaw": -0.9298138618469238 + } + }, + "uncertainty": { + "pose_covariance_6x6": [ + [ + 0.00018657518370904268, + 3.2614109577068e-07, + 1.602449603391029e-05, + 3.6495787472589852e-06, + 1.1980728245686841e-05, + 4.131249908075356e-05 + ], + [ + 3.261410957703507e-07, + 2.372399124672742e-05, + -9.93790439358011e-06, + -1.6114706168064627e-06, + -6.845548839083708e-06, + 5.391364200550181e-06 + ], + [ + 1.6024496033910718e-05, + -9.937904393580179e-06, + 0.0003263354532916631, + 2.012545236972588e-05, + -2.26070059708291e-05, + -0.00011959367220891756 + ], + [ + 3.6495787472590136e-06, + -1.611470616806491e-06, + 2.0125452369725986e-05, + 2.944038178204139e-06, + -7.915876131278405e-07, + -4.022481608715947e-06 + ], + [ + 1.198072824568691e-05, + -6.845548839083682e-06, + -2.260700597082915e-05, + -7.915876131278457e-07, + 6.3443530931111025e-06, + 1.2047681591156984e-05 + ], + [ + 4.131249908075341e-05, + 5.391364200550281e-06, + -0.00011959367220891755, + -4.0224816087159735e-06, + 1.2047681591156943e-05, + 8.529746705107022e-05 + ] + ], + "parameter_std": { + "rvec_std_deg": [ + 0.7826175297261447, + 0.2790721575370424, + 1.0350343464348573 + ], + "tvec_std_m": [ + 0.001715819972550774, + 0.0025187999311400465, + 0.00923566278352941 + ] + }, + "camera_center_std_m": [ + 0.020458553874397604, + 0.01861041550873078, + 0.01216387062995681 + ], + "camera_center_std_mm": [ + 20.458553874397605, + 18.61041550873078, + 12.16387062995681 + ], + "orientation_std_deg": { + "roll": 1.0421182767903001, + "pitch": 0.7383343261342494, + "yaw": 0.2473240342127264 + } + } + }, + "observations": { + "markers": [ + { + "marker_id": 63, + "observed_center_px": [ + 1246.0, + 678.75 + ], + "projected_center_px": [ + 1233.14697265625, + 661.9085693359375 + ], + "reprojection_error_px": 21.18570505580614, + "confidence": 0.1539593300495616 + }, + { + "marker_id": 102, + "observed_center_px": [ + 1078.25, + 665.5 + ], + "projected_center_px": [ + 1071.257080078125, + 651.162353515625 + ], + "reprojection_error_px": 15.952085623662727, + "confidence": 0.39637168760361213 + }, + { + "marker_id": 64, + "observed_center_px": [ + 220.5, + 635.25 + ], + "projected_center_px": [ + 225.70152282714844, + 630.446533203125 + ], + "reprojection_error_px": 7.080193005139538, + "confidence": 0.4633649853376546 + }, + { + "marker_id": 58, + "observed_center_px": [ + 307.25, + 668.0 + ], + "projected_center_px": [ + 314.0374450683594, + 660.0361328125 + ], + "reprojection_error_px": 10.463870753030886, + "confidence": 0.3638956157928849 + }, + { + "marker_id": 92, + "observed_center_px": [ + 1064.5, + 622.75 + ], + "projected_center_px": [ + 1059.1376953125, + 612.031005859375 + ], + "reprojection_error_px": 11.98545564208293, + "confidence": 0.46896024883690896 + }, + { + "marker_id": 96, + "observed_center_px": [ + 716.75, + 628.0 + ], + "projected_center_px": [ + 717.737548828125, + 619.830322265625 + ], + "reprojection_error_px": 8.229148617656245, + "confidence": 0.44372569385651617 + }, + { + "marker_id": 103, + "observed_center_px": [ + 382.0, + 633.0 + ], + "projected_center_px": [ + 386.3920593261719, + 627.0259399414062 + ], + "reprojection_error_px": 7.414821556065831, + "confidence": 0.45199802144368495 + }, + { + "marker_id": 62, + "observed_center_px": [ + 760.25, + 615.0 + ], + "projected_center_px": [ + 760.47509765625, + 607.4323120117188 + ], + "reprojection_error_px": 7.571034965103883, + "confidence": 0.44348322079976393 + }, + { + "marker_id": 51, + "observed_center_px": [ + 461.75, + 615.0 + ], + "projected_center_px": [ + 464.9672546386719, + 609.5865478515625 + ], + "reprojection_error_px": 6.297316219904975, + "confidence": 0.44348322079976393 + }, + { + "marker_id": 79, + "observed_center_px": [ + 643.75, + 598.75 + ], + "projected_center_px": [ + 644.9561767578125, + 593.2598876953125 + ], + "reprojection_error_px": 5.621049322783795, + "confidence": 0.41815762699787656 + }, + { + "marker_id": 205, + "observed_center_px": [ + 1181.0, + 502.0 + ], + "projected_center_px": [ + 1178.9991455078125, + 506.276611328125 + ], + "reprojection_error_px": 4.72152762893049, + "confidence": 0.3958181457519531 + }, + { + "marker_id": 217, + "observed_center_px": [ + 1058.0, + 503.25 + ], + "projected_center_px": [ + 1057.4124755859375, + 508.2463684082031 + ], + "reprojection_error_px": 5.030793397428453, + "confidence": 0.4015868133874269 + }, + { + "marker_id": 208, + "observed_center_px": [ + 688.75, + 507.0 + ], + "projected_center_px": [ + 689.7410888671875, + 514.2028198242188 + ], + "reprojection_error_px": 7.2706857010065855, + "confidence": 0.3776 + }, + { + "marker_id": 210, + "observed_center_px": [ + 291.0, + 441.75 + ], + "projected_center_px": [ + 285.5662536621094, + 453.19012451171875 + ], + "reprojection_error_px": 12.664993016506877, + "confidence": 0.3320910299473707 + }, + { + "marker_id": 214, + "observed_center_px": [ + 686.25, + 427.5 + ], + "projected_center_px": [ + 685.8961791992188, + 437.7833251953125 + ], + "reprojection_error_px": 10.289410392807468, + "confidence": 0.3465862068965517 + }, + { + "marker_id": 206, + "observed_center_px": [ + 1043.0, + 424.5 + ], + "projected_center_px": [ + 1044.7210693359375, + 432.414306640625 + ], + "reprojection_error_px": 8.099279551969133, + "confidence": 0.3579602826436361 + }, + { + "marker_id": 207, + "observed_center_px": [ + 1162.0, + 423.25 + ], + "projected_center_px": [ + 1163.405029296875, + 430.6384582519531 + ], + "reprojection_error_px": 7.520865818902188, + "confidence": 0.343462485354258 + }, + { + "marker_id": 94, + "observed_center_px": [ + 1252.0, + 279.5 + ], + "projected_center_px": [ + 1260.8394775390625, + 281.34625244140625 + ], + "reprojection_error_px": 9.030227640596275, + "confidence": 0.06057156860351561 + }, + { + "marker_id": 76, + "observed_center_px": [ + 1046.0, + 287.5 + ], + "projected_center_px": [ + 1051.4119873046875, + 289.6189270019531 + ], + "reprojection_error_px": 5.812009826704075, + "confidence": 0.2459421895345052 + }, + { + "marker_id": 100, + "observed_center_px": [ + 1173.25, + 281.5 + ], + "projected_center_px": [ + 1181.211181640625, + 283.404541015625 + ], + "reprojection_error_px": 8.185822475183693, + "confidence": 0.24407473894265982 + }, + { + "marker_id": 75, + "observed_center_px": [ + 271.75, + 271.5 + ], + "projected_center_px": [ + 253.8015594482422, + 276.647705078125 + ], + "reprojection_error_px": 18.672048248955928, + "confidence": 0.23896265492072474 + }, + { + "marker_id": 68, + "observed_center_px": [ + 924.0, + 285.25 + ], + "projected_center_px": [ + 926.9244995117188, + 288.0189208984375 + ], + "reprojection_error_px": 4.027358977772796, + "confidence": 0.24909137483284013 + }, + { + "marker_id": 46, + "observed_center_px": [ + 881.75, + 273.5 + ], + "projected_center_px": [ + 884.1876220703125, + 276.38165283203125 + ], + "reprojection_error_px": 3.7743773528925697, + "confidence": 0.23734254719660833 + }, + { + "marker_id": 50, + "observed_center_px": [ + 918.75, + 251.25 + ], + "projected_center_px": [ + 922.0274658203125, + 254.4427032470703 + ], + "reprojection_error_px": 4.57549300372867, + "confidence": 0.2211554500544793 + }, + { + "marker_id": 72, + "observed_center_px": [ + 777.75, + 267.25 + ], + "projected_center_px": [ + 777.0671997070312, + 270.43988037109375 + ], + "reprojection_error_px": 3.262139332089819, + "confidence": 0.21841319450965294 + }, + { + "marker_id": 104, + "observed_center_px": [ + 1184.0, + 228.0 + ], + "projected_center_px": [ + 1194.67431640625, + 229.40283203125 + ], + "reprojection_error_px": 10.76610275116483, + "confidence": 0.22417849731445313 + }, + { + "marker_id": 53, + "observed_center_px": [ + 825.5, + 252.25 + ], + "projected_center_px": [ + 825.8674926757812, + 255.29368591308594 + ], + "reprojection_error_px": 3.0657910568515003, + "confidence": 0.22367025973033955 + }, + { + "marker_id": 60, + "observed_center_px": [ + 765.0, + 197.25 + ], + "projected_center_px": [ + 763.8517456054688, + 199.3125457763672 + ], + "reprojection_error_px": 2.3606319565257206, + "confidence": 0.19874429613402733 + }, + { + "marker_id": 67, + "observed_center_px": [ + 859.25, + 209.25 + ], + "projected_center_px": [ + 861.4623413085938, + 211.2976837158203 + ], + "reprojection_error_px": 3.0145418666434187, + "confidence": 0.19627771759033205 + }, + { + "marker_id": 86, + "observed_center_px": [ + 690.25, + 192.0 + ], + "projected_center_px": [ + 685.8648681640625, + 193.8142852783203 + ], + "reprojection_error_px": 4.745630863192206, + "confidence": 0.18966921411877496 + }, + { + "marker_id": 88, + "observed_center_px": [ + 1105.5, + 170.0 + ], + "projected_center_px": [ + 1116.3076171875, + 170.71231079101562 + ], + "reprojection_error_px": 10.831065318542896, + "confidence": 0.17697203515072252 + }, + { + "marker_id": 70, + "observed_center_px": [ + 938.0, + 183.5 + ], + "projected_center_px": [ + 943.200927734375, + 184.5773468017578 + ], + "reprojection_error_px": 5.31133932539137, + "confidence": 0.193995418548584 + }, + { + "marker_id": 90, + "observed_center_px": [ + 978.5, + 170.75 + ], + "projected_center_px": [ + 985.5296020507812, + 171.8170166015625 + ], + "reprojection_error_px": 7.1101216178317195, + "confidence": 0.17958947754575058 + }, + { + "marker_id": 83, + "observed_center_px": [ + 361.0, + 159.75 + ], + "projected_center_px": [ + 340.492919921875, + 161.3194580078125 + ], + "reprojection_error_px": 20.56704966126445, + "confidence": 0.17676838843571283 + }, + { + "marker_id": 61, + "observed_center_px": [ + 292.25, + 162.5 + ], + "projected_center_px": [ + 268.0343017578125, + 164.65380859375 + ], + "reprojection_error_px": 24.31129229011066, + "confidence": 0.1668050360320266 + }, + { + "marker_id": 91, + "observed_center_px": [ + 1059.25, + 161.75 + ], + "projected_center_px": [ + 1069.322509765625, + 162.12203979492188 + ], + "reprojection_error_px": 10.079378283784001, + "confidence": 0.17612778902053833 + } + ] + }, + "qa": { + "sanity_notes": [] + }, + "v8_z_correction_mm": 54.81633454946478 +} \ No newline at end of file diff --git a/data/evaluations/Scene9/render_c_aruco_detection.json b/data/evaluations/Scene9/render_c_aruco_detection.json index 4592fa7..3bfe0f3 100644 --- a/data/evaluations/Scene9/render_c_aruco_detection.json +++ b/data/evaluations/Scene9/render_c_aruco_detection.json @@ -1,6 +1,6 @@ { "schema_version": "1.0", - "created_utc": "2026-06-01T16:29:09Z", + "created_utc": "2026-06-01T17:39:23Z", "vision_config": { "MarkerType": "DICT_4X4_250", "MarkerSize": 0.025 @@ -46,7 +46,7 @@ }, "detections": [ { - "observation_id": "4c338f7b-2ef7-4fe7-bb9a-99867b2e7728", + "observation_id": "6b702a27-d28d-4495-9f34-60a4caa12254", "type": "aruco", "marker_id": 113, "marker_size_m": 0.025, @@ -100,7 +100,7 @@ "confidence": 0.9487615650349993 }, { - "observation_id": "06aaf42b-e970-4f4c-b13c-11d172a293b6", + "observation_id": "46cc4c8e-b8b9-46f7-afba-da4d24da9a33", "type": "aruco", "marker_id": 245, "marker_size_m": 0.025, @@ -154,7 +154,7 @@ "confidence": 0.9266602848500798 }, { - "observation_id": "33d0d869-585f-4f78-ae20-84471b2e8596", + "observation_id": "29a0e049-9ecf-4662-8385-4656717bf3c5", "type": "aruco", "marker_id": 243, "marker_size_m": 0.025, @@ -208,7 +208,7 @@ "confidence": 0.8890505808415132 }, { - "observation_id": "511089c6-e12c-4197-b986-24d586d142f3", + "observation_id": "67b4cc8b-73e5-4307-8ef0-daf6f715b14a", "type": "aruco", "marker_id": 229, "marker_size_m": 0.025, @@ -262,7 +262,7 @@ "confidence": 0.3082915922280886 }, { - "observation_id": "73a318fc-d5e7-496a-8b1a-21d3cd4e1302", + "observation_id": "a38c028a-79b4-45d5-83f4-30a9d891fca5", "type": "aruco", "marker_id": 208, "marker_size_m": 0.025, @@ -316,7 +316,7 @@ "confidence": 0.2964796698261984 }, { - "observation_id": "6e99e711-d94f-481b-ac0d-80ebba9f995d", + "observation_id": "18d48a79-b877-466f-8063-deaa13baec23", "type": "aruco", "marker_id": 198, "marker_size_m": 0.025, @@ -370,7 +370,7 @@ "confidence": 0.21181999247805575 }, { - "observation_id": "21e8a19f-ba71-4da0-a662-c589883d166f", + "observation_id": "7b9ff620-f60b-4ce6-8a53-5f65ce9eabfc", "type": "aruco", "marker_id": 214, "marker_size_m": 0.025, @@ -424,7 +424,7 @@ "confidence": 0.21966133686197709 }, { - "observation_id": "9f922615-d6a0-4531-ac41-14539e8719de", + "observation_id": "0828ba21-00e9-48d7-aa7a-ecee11d5d351", "type": "aruco", "marker_id": 210, "marker_size_m": 0.025, diff --git a/data/evaluations/Scene9/render_c_camera_pose.json b/data/evaluations/Scene9/render_c_camera_pose.json index 5d75405..5b87474 100644 --- a/data/evaluations/Scene9/render_c_camera_pose.json +++ b/data/evaluations/Scene9/render_c_camera_pose.json @@ -1,6 +1,6 @@ { "schema_version": "1.0", - "created_utc": "2026-06-01T16:29:13Z", + "created_utc": "2026-06-01T17:39:27Z", "source": { "detection_json": "C:\\Users\\kech\\SynologyDrive\\2026-AppServer-AppRobot\\appRobotRendering\\data\\evaluations\\Scene9\\render_c_aruco_detection.json", "robot_json": "C:\\Users\\kech\\SynologyDrive\\2026-AppServer-AppRobot\\appRobotRendering\\data\\robot\\robot.json" diff --git a/data/evaluations/Scene9/render_c_camera_pose_v8.json b/data/evaluations/Scene9/render_c_camera_pose_v8.json new file mode 100644 index 0000000..bc3dc67 --- /dev/null +++ b/data/evaluations/Scene9/render_c_camera_pose_v8.json @@ -0,0 +1,259 @@ +{ + "schema_version": "1.0", + "created_utc": "2026-06-01T17:39:38Z", + "source": { + "detection_json": "C:\\Users\\kech\\SynologyDrive\\2026-AppServer-AppRobot\\appRobotRendering\\data\\evaluations\\Scene9\\render_c_aruco_detection.json", + "robot_json": "C:\\Users\\kech\\SynologyDrive\\2026-AppServer-AppRobot\\appRobotRendering\\data\\robot\\robot.json" + }, + "camera": { + "camera_id": "c", + "camera_matrix": [ + [ + 1777.77783203125, + 0.0, + 640.0 + ], + [ + 0.0, + 1500.0, + 360.0 + ], + [ + 0.0, + 0.0, + 1.0 + ] + ], + "distortion_coefficients": [ + 0.0, + 0.0, + 0.0, + 0.0, + 0.0 + ] + }, + "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": 3, + "used_marker_ids": [ + 208, + 214, + 210 + ], + "history": { + "iters": [ + 0, + 1, + 2, + 3, + 4, + 5, + 6, + 7, + 8 + ], + "rms": [ + 0.006127890335695162, + 0.0008478528520640616, + 0.00014681024076620722, + 1.4963709028061363e-05, + 8.683670034931927e-07, + 2.746078069496483e-08, + 4.529318590563993e-10, + 3.809098542147234e-12, + 1.617483009487371e-14 + ], + "lambda": [ + 0.001, + 0.0005, + 0.00025, + 0.000125, + 6.25e-05, + 3.125e-05, + 1.5625e-05, + 7.8125e-06, + 3.90625e-06 + ] + }, + "residual_rms_px": 0.0, + "residual_median_px": 0.0, + "residual_max_px": 0.0, + "sigma2_normalized": 1.4637067577342992e-32 + }, + "camera_pose": { + "world_to_camera": { + "rotation_matrix": [ + [ + 0.9944018125534058, + 0.10561227053403854, + 0.0033347229473292828 + ], + [ + 0.04051270708441734, + -0.35192349553108215, + -0.9351516366004944 + ], + [ + -0.09758992493152618, + 0.9300515651702881, + -0.35423198342323303 + ] + ], + "translation_m": [ + -0.19802458946542495, + 0.17701345841136637, + 1.022779883008575 + ], + "rvec_rad": [ + 1.9306504238906828, + 0.10446594124923296, + -0.06738381085751584 + ] + }, + "camera_in_world": { + "position_m": [ + 0.2895577135529438, + -0.8680290032432617, + 0.528496135754973 + ], + "position_mm": [ + 289.5577135529438, + -868.0290032432617, + 528.496135754973 + ], + "orientation_deg": { + "roll": 110.85050201416016, + "pitch": 5.600404262542725, + "yaw": 2.332984685897827 + } + }, + "uncertainty": { + "pose_covariance_6x6": [ + [ + 5.5276687512634244e-30, + -1.206457356216508e-30, + 8.29197807375731e-31, + -2.9021089545003607e-32, + -8.396160241991216e-32, + 8.636387114318996e-32 + ], + [ + -1.2064573562166456e-30, + 1.594399691698936e-30, + -2.6701861017445683e-30, + 6.662980742991194e-32, + -1.6061172779125545e-32, + -1.8506593523891487e-32 + ], + [ + 8.291978073760105e-31, + -2.670186101744606e-30, + 6.099489375082028e-30, + -1.2623061654064467e-31, + -6.416052610833511e-32, + 2.7359215533525156e-32 + ], + [ + -2.9021089545010975e-32, + 6.662980742991381e-32, + -1.2623061654064646e-31, + 7.744704080393524e-33, + 1.1616522854011098e-33, + 8.598401270402733e-33 + ], + [ + -8.396160241991087e-32, + -1.6061172779127915e-32, + -6.416052610833059e-32, + 1.1616522854010374e-33, + 2.1112104038689702e-32, + 2.4996270792384415e-32 + ], + [ + 8.63638711431877e-32, + -1.850659352389075e-32, + 2.7359215533524696e-32, + 8.598401270403007e-33, + 2.4996270792384404e-32, + 1.7243883853867915e-31 + ] + ], + "parameter_std": { + "rvec_std_deg": [ + 1.3470807725377516e-13, + 7.234711765071248e-14, + 1.4150421354980368e-13 + ], + "tvec_std_m": [ + 8.800400036585566e-17, + 1.4530004830931647e-16, + 4.1525755687124967e-16 + ] + }, + "camera_center_std_m": [ + 2.217696547073064e-15, + 1.1327794084579684e-15, + 1.9962965035361475e-15 + ], + "camera_center_std_mm": [ + 2.217696547073064e-12, + 1.1327794084579684e-12, + 1.9962965035361473e-12 + ], + "orientation_std_deg": { + "roll": 1.3986198939544745e-13, + "pitch": 1.3057305303039504e-13, + "yaw": 3.4300461836332537e-14 + } + } + }, + "observations": { + "markers": [ + { + "marker_id": 208, + "observed_center_px": [ + 922.5, + 650.25 + ], + "projected_center_px": [ + 922.5, + 650.25 + ], + "reprojection_error_px": 0.0, + "confidence": 0.2964796698261984 + }, + { + "marker_id": 214, + "observed_center_px": [ + 916.25, + 583.75 + ], + "projected_center_px": [ + 916.25, + 583.75 + ], + "reprojection_error_px": 0.0, + "confidence": 0.21966133686197709 + }, + { + "marker_id": 210, + "observed_center_px": [ + 314.25, + 563.5 + ], + "projected_center_px": [ + 314.25, + 563.5 + ], + "reprojection_error_px": 0.0, + "confidence": 0.233781757000696 + } + ] + }, + "qa": { + "sanity_notes": [] + }, + "v8_z_correction_mm": 54.81633454946478 +} \ No newline at end of file diff --git a/data/evaluations/Scene9/render_d_aruco_detection.json b/data/evaluations/Scene9/render_d_aruco_detection.json index 7952350..6afe2a2 100644 --- a/data/evaluations/Scene9/render_d_aruco_detection.json +++ b/data/evaluations/Scene9/render_d_aruco_detection.json @@ -1,6 +1,6 @@ { "schema_version": "1.0", - "created_utc": "2026-06-01T16:29:10Z", + "created_utc": "2026-06-01T17:39:24Z", "vision_config": { "MarkerType": "DICT_4X4_250", "MarkerSize": 0.025 @@ -46,7 +46,7 @@ }, "detections": [ { - "observation_id": "c6edc030-1270-477f-9b6c-b01857dbaca3", + "observation_id": "7bf1b1d4-90cd-4e94-88cb-e26503c195ae", "type": "aruco", "marker_id": 113, "marker_size_m": 0.025, @@ -100,7 +100,7 @@ "confidence": 0.9819147066961816 }, { - "observation_id": "48783691-cd10-496e-9825-1ff3ecaa4032", + "observation_id": "14d29c71-36d0-42f4-9e1d-a14aa2f46e12", "type": "aruco", "marker_id": 245, "marker_size_m": 0.025, @@ -154,7 +154,7 @@ "confidence": 0.896516741806838 }, { - "observation_id": "6f06ad1f-943c-418e-adab-d8e138d6082c", + "observation_id": "932f774f-4e00-4613-9ad3-6c4816956662", "type": "aruco", "marker_id": 243, "marker_size_m": 0.025, @@ -208,7 +208,7 @@ "confidence": 0.8782459535277616 }, { - "observation_id": "44eb12ae-2972-40e4-ac1a-986f706438dd", + "observation_id": "ce799fa4-c2c3-4469-b7df-ebd057b1f90d", "type": "aruco", "marker_id": 244, "marker_size_m": 0.025, @@ -262,7 +262,7 @@ "confidence": 0.49420707353484883 }, { - "observation_id": "855ddc73-e2f2-454d-8d84-120fe75bde10", + "observation_id": "9675e83b-bfa3-49c1-81c4-9270daabb7bf", "type": "aruco", "marker_id": 208, "marker_size_m": 0.025, @@ -316,7 +316,7 @@ "confidence": 0.06739671544456982 }, { - "observation_id": "303e80c5-4d8a-4d5c-b25b-8b42a88af948", + "observation_id": "bf0f473c-91da-4641-aef6-e28c6da66d9c", "type": "aruco", "marker_id": 103, "marker_size_m": 0.025, @@ -370,7 +370,7 @@ "confidence": 0.17416420855033052 }, { - "observation_id": "fcab8cf0-28c5-4fff-803c-4c76d5873281", + "observation_id": "e5e24bc2-806b-4b1a-ab9a-01fbb46a2f5f", "type": "aruco", "marker_id": 229, "marker_size_m": 0.025, @@ -424,7 +424,7 @@ "confidence": 0.4189637021373363 }, { - "observation_id": "a0fde815-04de-4dd3-a459-6f496f89a8d6", + "observation_id": "2f6720bf-5b34-48df-8198-fee5dd64394f", "type": "aruco", "marker_id": 58, "marker_size_m": 0.025, @@ -478,7 +478,7 @@ "confidence": 0.24540823915500745 }, { - "observation_id": "dcc2a1af-3b51-4945-ac7f-8ce2d0c00d3f", + "observation_id": "3133bfbd-c37f-4aad-b117-3a07fa7e7da8", "type": "aruco", "marker_id": 214, "marker_size_m": 0.025, @@ -532,7 +532,7 @@ "confidence": 0.32624039952470835 }, { - "observation_id": "2916d93b-da82-4dc7-8b2f-9af4a054bae9", + "observation_id": "ec538e9f-a506-4224-b8ce-3f45c3f36942", "type": "aruco", "marker_id": 64, "marker_size_m": 0.025, @@ -586,7 +586,7 @@ "confidence": 0.45882243623190877 }, { - "observation_id": "db111a8f-0e23-4dba-be10-8deb0501b413", + "observation_id": "b2c3ccf6-e214-4135-811e-556619d5c7a8", "type": "aruco", "marker_id": 124, "marker_size_m": 0.025, @@ -640,7 +640,7 @@ "confidence": 0.051262886894149665 }, { - "observation_id": "1f155a26-9e44-46db-8182-16ebf14a8715", + "observation_id": "67e94429-c3a8-40bf-9cb6-6754a61a0e22", "type": "aruco", "marker_id": 211, "marker_size_m": 0.025, @@ -694,7 +694,7 @@ "confidence": 0.3071912693949274 }, { - "observation_id": "2b3b9c08-c155-497b-891e-fe18c99885e7", + "observation_id": "fa2bc2d8-3fb1-4e16-b1ff-039d2229de1c", "type": "aruco", "marker_id": 72, "marker_size_m": 0.025, @@ -748,7 +748,7 @@ "confidence": 0.013395930107400523 }, { - "observation_id": "dd51ae5a-5bec-48c7-a4a9-5018ffbc0669", + "observation_id": "3883a462-49c5-477f-af6f-16d8df30a4dd", "type": "aruco", "marker_id": 84, "marker_size_m": 0.025, @@ -802,7 +802,7 @@ "confidence": 0.07285288505606423 }, { - "observation_id": "8d133eb6-15d4-4719-9ae7-985a9cd81fb4", + "observation_id": "cc178f65-204b-4f74-be9d-ba4d38e7c06c", "type": "aruco", "marker_id": 86, "marker_size_m": 0.025, diff --git a/data/evaluations/Scene9/render_d_camera_pose.json b/data/evaluations/Scene9/render_d_camera_pose.json index 1338c6d..dc1ff92 100644 --- a/data/evaluations/Scene9/render_d_camera_pose.json +++ b/data/evaluations/Scene9/render_d_camera_pose.json @@ -1,6 +1,6 @@ { "schema_version": "1.0", - "created_utc": "2026-06-01T16:29:14Z", + "created_utc": "2026-06-01T17:39:27Z", "source": { "detection_json": "C:\\Users\\kech\\SynologyDrive\\2026-AppServer-AppRobot\\appRobotRendering\\data\\evaluations\\Scene9\\render_d_aruco_detection.json", "robot_json": "C:\\Users\\kech\\SynologyDrive\\2026-AppServer-AppRobot\\appRobotRendering\\data\\robot\\robot.json" diff --git a/data/evaluations/Scene9/render_d_camera_pose_v8.json b/data/evaluations/Scene9/render_d_camera_pose_v8.json new file mode 100644 index 0000000..b088c94 --- /dev/null +++ b/data/evaluations/Scene9/render_d_camera_pose_v8.json @@ -0,0 +1,328 @@ +{ + "schema_version": "1.0", + "created_utc": "2026-06-01T17:39:38Z", + "source": { + "detection_json": "C:\\Users\\kech\\SynologyDrive\\2026-AppServer-AppRobot\\appRobotRendering\\data\\evaluations\\Scene9\\render_d_aruco_detection.json", + "robot_json": "C:\\Users\\kech\\SynologyDrive\\2026-AppServer-AppRobot\\appRobotRendering\\data\\robot\\robot.json" + }, + "camera": { + "camera_id": "d", + "camera_matrix": [ + [ + 1777.77783203125, + 0.0, + 640.0 + ], + [ + 0.0, + 1500.0, + 360.0 + ], + [ + 0.0, + 0.0, + 1.0 + ] + ], + "distortion_coefficients": [ + 0.0, + 0.0, + 0.0, + 0.0, + 0.0 + ] + }, + "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": 9, + "used_marker_ids": [ + 208, + 103, + 58, + 214, + 64, + 211, + 72, + 84, + 86 + ], + "history": { + "iters": [ + 0, + 1, + 2, + 3 + ], + "rms": [ + 0.006170555783051489, + 0.0012293953054527144, + 0.00121100792156609, + 0.0012110078502646229 + ], + "lambda": [ + 0.001, + 0.0005, + 0.00025, + 0.000125 + ] + }, + "residual_rms_px": 2.571926995828887, + "residual_median_px": 1.7530882678650423, + "residual_max_px": 5.015482946936298, + "sigma2_normalized": 2.1998100201036963e-06 + }, + "camera_pose": { + "world_to_camera": { + "rotation_matrix": [ + [ + 0.8208228945732117, + 0.5711369514465332, + -0.007236112374812365 + ], + [ + 0.17046144604682922, + -0.25703468918800354, + -0.9512497186660767 + ], + [ + -0.545153796672821, + 0.7795740962028503, + -0.3083367645740509 + ] + ], + "translation_m": [ + -0.11533180926721431, + 0.16293781478307687, + 1.1402263928262872 + ], + "rvec_rad": [ + 1.820345783135202, + 0.565739972072733, + -0.42139931920823825 + ] + }, + "camera_in_world": { + "position_m": [ + 0.6884911351722325, + -0.7811400221621128, + 0.50573375491592 + ], + "position_mm": [ + 688.4911351722325, + -781.1400221621127, + 505.73375491592 + ], + "orientation_deg": { + "roll": 111.57975769042969, + "pitch": 33.03517150878906, + "yaw": 11.731935501098633 + } + }, + "uncertainty": { + "pose_covariance_6x6": [ + [ + 3.802912364722085e-05, + 1.641716016150694e-05, + 1.691836245137162e-05, + 6.126801770729793e-08, + -7.054768849224667e-06, + -1.4055169549040093e-06 + ], + [ + 1.6417160161507313e-05, + 1.8076806685023157e-05, + -1.2387621424337972e-07, + 1.428054155254671e-06, + -3.564815364989778e-06, + 3.3814832059954696e-06 + ], + [ + 1.691836245137113e-05, + -1.2387621424384347e-07, + 3.514815322876603e-05, + -1.9686880580364376e-06, + -5.9266379714250665e-06, + -9.613830700805953e-06 + ], + [ + 6.126801770734447e-08, + 1.428054155254699e-06, + -1.9686880580364237e-06, + 4.860268624097902e-07, + 1.2958398906388404e-07, + 1.137747180562379e-06 + ], + [ + -7.0547688492246515e-06, + -3.5648153649896957e-06, + -5.926637971425152e-06, + 1.2958398906389237e-07, + 2.168988131799405e-06, + 1.8523330142213258e-06 + ], + [ + -1.4055169549037846e-06, + 3.3814832059956026e-06, + -9.61383070080584e-06, + 1.1377471805623797e-06, + 1.8523330142212812e-06, + 8.248418996032322e-06 + ] + ], + "parameter_std": { + "rvec_std_deg": [ + 0.3533302259848121, + 0.243603480626876, + 0.3396830590573791 + ], + "tvec_std_m": [ + 0.0006971562682855188, + 0.0014727484957722432, + 0.0028720060926175493 + ] + }, + "camera_center_std_m": [ + 0.004836840199544631, + 0.003058465639926295, + 0.006511032751858579 + ], + "camera_center_std_mm": [ + 4.836840199544631, + 3.058465639926295, + 6.511032751858579 + ], + "orientation_std_deg": { + "roll": 0.4538839876757688, + "pitch": 0.25057379305976407, + "yaw": 0.3499434553975412 + } + } + }, + "observations": { + "markers": [ + { + "marker_id": 208, + "observed_center_px": [ + 887.5, + 696.5 + ], + "projected_center_px": [ + 887.7296752929688, + 696.2703247070312 + ], + "reprojection_error_px": 0.3248099142584202, + "confidence": 0.06739671544456982 + }, + { + "marker_id": 103, + "observed_center_px": [ + 379.5, + 691.25 + ], + "projected_center_px": [ + 379.45953369140625, + 688.251953125 + ], + "reprojection_error_px": 2.998319960716079, + "confidence": 0.17416420855033052 + }, + { + "marker_id": 58, + "observed_center_px": [ + 261.5, + 685.0 + ], + "projected_center_px": [ + 261.4115295410156, + 683.2491455078125 + ], + "reprojection_error_px": 1.7530882678650423, + "confidence": 0.24540823915500745 + }, + { + "marker_id": 214, + "observed_center_px": [ + 958.75, + 638.25 + ], + "projected_center_px": [ + 958.8698120117188, + 640.2307739257812 + ], + "reprojection_error_px": 1.984394180400396, + "confidence": 0.32624039952470835 + }, + { + "marker_id": 64, + "observed_center_px": [ + 211.5, + 631.75 + ], + "projected_center_px": [ + 210.99404907226562, + 633.2077026367188 + ], + "reprojection_error_px": 1.5430111206248873, + "confidence": 0.45882243623190877 + }, + { + "marker_id": 211, + "observed_center_px": [ + 792.0, + 593.5 + ], + "projected_center_px": [ + 792.0845336914062, + 598.5147705078125 + ], + "reprojection_error_px": 5.015482946936298, + "confidence": 0.3071912693949274 + }, + { + "marker_id": 72, + "observed_center_px": [ + 1249.0, + 596.75 + ], + "projected_center_px": [ + 1249.3333740234375, + 593.0040283203125 + ], + "reprojection_error_px": 3.7607767900426765, + "confidence": 0.013395930107400523 + }, + { + "marker_id": 84, + "observed_center_px": [ + 1226.5, + 549.5 + ], + "projected_center_px": [ + 1226.4927978515625, + 548.7413940429688 + ], + "reprojection_error_px": 0.758640144591238, + "confidence": 0.07285288505606423 + }, + { + "marker_id": 86, + "observed_center_px": [ + 1174.5, + 518.5 + ], + "projected_center_px": [ + 1174.326416015625, + 519.5684814453125 + ], + "reprojection_error_px": 1.0824897221722658, + "confidence": 0.14539527499019034 + } + ] + }, + "qa": { + "sanity_notes": [] + }, + "v8_z_correction_mm": 54.81633454946478 +} \ No newline at end of file diff --git a/data/evaluations/Scene9/render_e_aruco_detection.json b/data/evaluations/Scene9/render_e_aruco_detection.json index ba35ad6..c4931b7 100644 --- a/data/evaluations/Scene9/render_e_aruco_detection.json +++ b/data/evaluations/Scene9/render_e_aruco_detection.json @@ -1,6 +1,6 @@ { "schema_version": "1.0", - "created_utc": "2026-06-01T16:29:11Z", + "created_utc": "2026-06-01T17:39:24Z", "vision_config": { "MarkerType": "DICT_4X4_250", "MarkerSize": 0.025 @@ -46,7 +46,7 @@ }, "detections": [ { - "observation_id": "b5792e42-ad47-4475-bbd0-fafe9169265c", + "observation_id": "d4c2d49a-d5a2-41e8-ab16-c56d09039b0f", "type": "aruco", "marker_id": 92, "marker_size_m": 0.025, @@ -100,7 +100,7 @@ "confidence": 0.15369374989294518 }, { - "observation_id": "ab6de0a8-8ab2-4909-a9e8-5406c7bc778c", + "observation_id": "c13f1780-9fb6-4e71-a8c8-81f48f6e4a59", "type": "aruco", "marker_id": 113, "marker_size_m": 0.025, @@ -154,7 +154,7 @@ "confidence": 0.6379583967674639 }, { - "observation_id": "3c6ac6ea-b094-48d9-bda6-6cde563e9323", + "observation_id": "c5c22347-c916-4b33-93b9-7dead9184c3b", "type": "aruco", "marker_id": 217, "marker_size_m": 0.025, @@ -208,7 +208,7 @@ "confidence": 0.3233651345714012 }, { - "observation_id": "3576a7d2-3019-43b9-a2a2-a541ab5c3cb0", + "observation_id": "83fbec59-ae42-4d8c-986b-206286e18707", "type": "aruco", "marker_id": 105, "marker_size_m": 0.025, @@ -262,7 +262,7 @@ "confidence": 0.420622587927407 }, { - "observation_id": "2b3a27c0-e1d0-4d3a-ac91-04667afec31b", + "observation_id": "a9d18886-3b74-49ae-a5b8-b52b1a0b7cb4", "type": "aruco", "marker_id": 85, "marker_size_m": 0.025, @@ -316,7 +316,7 @@ "confidence": 0.3128949822399185 }, { - "observation_id": "77feecb7-ab2d-4087-9eb7-521f10b28375", + "observation_id": "361f898d-4df7-4264-8afb-b3eb5d8f998d", "type": "aruco", "marker_id": 206, "marker_size_m": 0.025, @@ -370,7 +370,7 @@ "confidence": 0.11623157468788738 }, { - "observation_id": "0ff9abbb-9592-4adf-b281-9464b303afdb", + "observation_id": "cd26fca3-64f5-4bda-9136-1483b4055d11", "type": "aruco", "marker_id": 244, "marker_size_m": 0.025, @@ -424,7 +424,7 @@ "confidence": 0.48895218467117135 }, { - "observation_id": "7d41074b-5276-41b6-8555-9d33fe59097e", + "observation_id": "c44ff6c1-bf51-454b-b472-b578a37dc7a1", "type": "aruco", "marker_id": 97, "marker_size_m": 0.025, @@ -478,7 +478,7 @@ "confidence": 0.22596816505744277 }, { - "observation_id": "6cd1c203-9456-4300-95a8-7ed0108ed24d", + "observation_id": "99aa3687-533b-4c99-bc5b-4d581bb7830d", "type": "aruco", "marker_id": 245, "marker_size_m": 0.025, @@ -532,7 +532,7 @@ "confidence": 0.32694949112255345 }, { - "observation_id": "127b0fcb-06df-4e06-8d3e-ced84cec6c37", + "observation_id": "cbaa94d0-b167-4732-a9fd-0e8f99f8ac12", "type": "aruco", "marker_id": 47, "marker_size_m": 0.025, @@ -586,7 +586,7 @@ "confidence": 0.24626971873720385 }, { - "observation_id": "65fdd6d5-191e-4818-8b3a-df171e0e239b", + "observation_id": "aabe2ac4-c842-4fa3-98e0-48041e69f5ff", "type": "aruco", "marker_id": 96, "marker_size_m": 0.025, @@ -640,7 +640,7 @@ "confidence": 0.2205630261207473 }, { - "observation_id": "b40004e2-82e2-45cb-b285-f93d3026c579", + "observation_id": "0d59062d-e9f7-436b-be31-a1f48562cb53", "type": "aruco", "marker_id": 208, "marker_size_m": 0.025, @@ -694,7 +694,7 @@ "confidence": 0.22017552547080893 }, { - "observation_id": "6fd3ddd9-7349-4260-8cfc-94b31219d8bd", + "observation_id": "df48a7ee-fb72-4bb7-a880-7bafbd7e4745", "type": "aruco", "marker_id": 62, "marker_size_m": 0.025, @@ -748,7 +748,7 @@ "confidence": 0.24902550615732547 }, { - "observation_id": "cdc74eb7-deb9-4298-9b30-6a7f6a9e3096", + "observation_id": "7d333789-0ec1-4adc-a929-f76a5cf68cc7", "type": "aruco", "marker_id": 124, "marker_size_m": 0.025, @@ -802,7 +802,7 @@ "confidence": 0.1717072854797086 }, { - "observation_id": "fdb98dea-5053-4907-85ac-a9f792e0c720", + "observation_id": "57ceb64f-09b9-4e22-8f46-6d01af4c0004", "type": "aruco", "marker_id": 79, "marker_size_m": 0.025, @@ -856,7 +856,7 @@ "confidence": 0.2093822185726055 }, { - "observation_id": "eb030f5d-af77-4d75-9ccd-0f51f5983c5c", + "observation_id": "35e0c1de-8fed-4d9a-8c86-3b38d73803ca", "type": "aruco", "marker_id": 66, "marker_size_m": 0.025, @@ -910,7 +910,7 @@ "confidence": 0.16725963004706537 }, { - "observation_id": "dc232799-ed86-4a54-8c29-deef32438db3", + "observation_id": "e78ef00a-beef-4848-a38b-c8f8663076cd", "type": "aruco", "marker_id": 55, "marker_size_m": 0.025, @@ -964,7 +964,7 @@ "confidence": 0.22298824455832925 }, { - "observation_id": "2f08d771-74fd-41d5-9be0-4925cf9f32fa", + "observation_id": "29005bee-121b-49ae-b499-9d2701b1f2eb", "type": "aruco", "marker_id": 53, "marker_size_m": 0.025, @@ -1018,7 +1018,7 @@ "confidence": 0.13595850692924102 }, { - "observation_id": "7a28aae1-78c8-4263-84a4-0594db7bbf21", + "observation_id": "3adbc624-a548-46ff-8107-f2f714b62b9f", "type": "aruco", "marker_id": 243, "marker_size_m": 0.025, @@ -1072,7 +1072,7 @@ "confidence": 0.2298583378390498 }, { - "observation_id": "445e0795-7d59-4374-ba67-6f24ea67e0a8", + "observation_id": "fcbc80bc-52f5-4293-8ea8-20c89b8e50cf", "type": "aruco", "marker_id": 214, "marker_size_m": 0.025, @@ -1126,7 +1126,7 @@ "confidence": 0.17248468175234963 }, { - "observation_id": "78cddb0e-1fc2-43c4-83ed-43b7b1fabb94", + "observation_id": "5b244d03-f503-4361-a3e2-cf2c1ff8ce83", "type": "aruco", "marker_id": 51, "marker_size_m": 0.025, @@ -1180,7 +1180,7 @@ "confidence": 0.12157403976480062 }, { - "observation_id": "1333b472-3cbc-405e-89bb-f1771905329c", + "observation_id": "b257701e-d5cf-4c8c-833c-9a0a96bbc26d", "type": "aruco", "marker_id": 95, "marker_size_m": 0.025, @@ -1234,7 +1234,7 @@ "confidence": 0.14922985097126407 }, { - "observation_id": "2f77ef69-b9aa-40dc-bbe9-8b11769adde1", + "observation_id": "e8b44df3-65fb-432e-9bfc-aa4ec85d9674", "type": "aruco", "marker_id": 122, "marker_size_m": 0.025, @@ -1288,7 +1288,7 @@ "confidence": 0.1374474660290558 }, { - "observation_id": "176dc1b8-32ef-48da-8035-cec402a1e676", + "observation_id": "5cc4c46e-38e6-4d0c-8e5b-ad2c0298e003", "type": "aruco", "marker_id": 103, "marker_size_m": 0.025, @@ -1342,7 +1342,7 @@ "confidence": 0.11373255626245794 }, { - "observation_id": "856d7060-73b1-4639-9a3f-c9da8dfecf6b", + "observation_id": "73f51982-82b1-484a-99df-ba16cf7f2ae2", "type": "aruco", "marker_id": 60, "marker_size_m": 0.025, @@ -1396,7 +1396,7 @@ "confidence": 0.1208904643109979 }, { - "observation_id": "8793175f-6a41-4f20-bea5-e0b3f44ced08", + "observation_id": "a1ea3edd-3a9f-4a5d-85eb-743202da150d", "type": "aruco", "marker_id": 72, "marker_size_m": 0.025, @@ -1450,7 +1450,7 @@ "confidence": 0.15549629518828512 }, { - "observation_id": "155cf594-aaa7-4f36-b631-01eda2be4274", + "observation_id": "7867756a-d0c9-4e96-aa6f-1885973ff5cd", "type": "aruco", "marker_id": 211, "marker_size_m": 0.025, @@ -1504,7 +1504,7 @@ "confidence": 0.13332463075982282 }, { - "observation_id": "32ef40b0-c8d5-4120-bdda-666ef94724f0", + "observation_id": "0db37fb8-6ad5-4ced-96d7-7b8ff13f1019", "type": "aruco", "marker_id": 84, "marker_size_m": 0.025, @@ -1558,7 +1558,7 @@ "confidence": 0.13255097071329755 }, { - "observation_id": "973a6c76-79f3-4d98-8875-0344631306ce", + "observation_id": "848bb571-2e54-474f-89ae-704020f2aaa4", "type": "aruco", "marker_id": 86, "marker_size_m": 0.025, @@ -1612,7 +1612,7 @@ "confidence": 0.1265670983135443 }, { - "observation_id": "77d902fa-dc60-43c9-bc72-378b20af87f6", + "observation_id": "74036fa3-4dc1-4374-9b33-fde262445c0e", "type": "aruco", "marker_id": 64, "marker_size_m": 0.025, diff --git a/data/evaluations/Scene9/render_e_camera_pose.json b/data/evaluations/Scene9/render_e_camera_pose.json index 6ad768d..3ac91f5 100644 --- a/data/evaluations/Scene9/render_e_camera_pose.json +++ b/data/evaluations/Scene9/render_e_camera_pose.json @@ -1,6 +1,6 @@ { "schema_version": "1.0", - "created_utc": "2026-06-01T16:29:15Z", + "created_utc": "2026-06-01T17:39:28Z", "source": { "detection_json": "C:\\Users\\kech\\SynologyDrive\\2026-AppServer-AppRobot\\appRobotRendering\\data\\evaluations\\Scene9\\render_e_aruco_detection.json", "robot_json": "C:\\Users\\kech\\SynologyDrive\\2026-AppServer-AppRobot\\appRobotRendering\\data\\robot\\robot.json" diff --git a/data/evaluations/Scene9/render_e_camera_pose_v8.json b/data/evaluations/Scene9/render_e_camera_pose_v8.json new file mode 100644 index 0000000..12c116e --- /dev/null +++ b/data/evaluations/Scene9/render_e_camera_pose_v8.json @@ -0,0 +1,538 @@ +{ + "schema_version": "1.0", + "created_utc": "2026-06-01T17:39:38Z", + "source": { + "detection_json": "C:\\Users\\kech\\SynologyDrive\\2026-AppServer-AppRobot\\appRobotRendering\\data\\evaluations\\Scene9\\render_e_aruco_detection.json", + "robot_json": "C:\\Users\\kech\\SynologyDrive\\2026-AppServer-AppRobot\\appRobotRendering\\data\\robot\\robot.json" + }, + "camera": { + "camera_id": "e", + "camera_matrix": [ + [ + 1777.77783203125, + 0.0, + 640.0 + ], + [ + 0.0, + 1500.0, + 360.0 + ], + [ + 0.0, + 0.0, + 1.0 + ] + ], + "distortion_coefficients": [ + 0.0, + 0.0, + 0.0, + 0.0, + 0.0 + ] + }, + "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": 24, + "used_marker_ids": [ + 92, + 217, + 105, + 85, + 206, + 97, + 47, + 96, + 208, + 62, + 79, + 66, + 55, + 53, + 214, + 51, + 95, + 103, + 60, + 72, + 211, + 84, + 86, + 64 + ], + "history": { + "iters": [ + 0, + 1, + 2, + 3 + ], + "rms": [ + 0.007095341925032369, + 0.0013349437109003125, + 0.0012927816364674517, + 0.0012927812569370745 + ], + "lambda": [ + 0.001, + 0.0005, + 0.00025, + 0.000125 + ] + }, + "residual_rms_px": 2.7749011523490723, + "residual_median_px": 2.078164275946058, + "residual_max_px": 5.196564935359262, + "sigma2_normalized": 1.910038146612797e-06 + }, + "camera_pose": { + "world_to_camera": { + "rotation_matrix": [ + [ + 0.6307641863822937, + 0.7759707570075989, + -0.002437180606648326 + ], + [ + 0.24203786253929138, + -0.19972774386405945, + -0.9494875073432922 + ], + [ + -0.7372612953186035, + 0.5983127951622009, + -0.31379541754722595 + ] + ], + "translation_m": [ + -0.05555845086754969, + 0.04199432234959863, + 1.5598637086701992 + ], + "rvec_rad": [ + 1.7490034211859098, + 0.8303460658691646, + -0.6033404001661316 + ] + }, + "camera_in_world": { + "position_m": [ + 1.1749072161404899, + -0.8817872875554502, + 0.5292157456011847 + ], + "position_mm": [ + 1174.90721614049, + -881.7872875554502, + 529.2157456011847 + ], + "orientation_deg": { + "roll": 117.67552947998047, + "pitch": 47.49863815307617, + "yaw": 20.992887496948242 + } + }, + "uncertainty": { + "pose_covariance_6x6": [ + [ + 5.663846922649341e-06, + 1.2187131020285088e-06, + 1.418825051755898e-06, + -1.6252114155662747e-07, + -1.6271670193759301e-06, + 6.978917567451072e-07 + ], + [ + 1.2187131020285183e-06, + 4.122558930254296e-06, + 1.5390128559489638e-07, + 1.0002999823743167e-06, + -1.1337782962224744e-06, + 8.312992703514572e-07 + ], + [ + 1.418825051755848e-06, + 1.5390128559490705e-07, + 7.880821288709876e-06, + -1.2441730290158325e-06, + -1.3484606758105873e-06, + -9.509612049445034e-07 + ], + [ + -1.6252114155663952e-07, + 1.0002999823743398e-06, + -1.244173029015829e-06, + 6.006266124768371e-07, + 2.2984016135938396e-08, + 6.438843290101196e-07 + ], + [ + -1.6271670193759244e-06, + -1.1337782962224748e-06, + -1.3484606758105964e-06, + 2.2984016135940418e-08, + 9.18643775595386e-07, + 2.5772987300597183e-07 + ], + [ + 6.978917567451163e-07, + 8.312992703514586e-07, + -9.509612049445044e-07, + 6.438843290101158e-07, + 2.577298730059702e-07, + 4.274426720275254e-06 + ] + ], + "parameter_std": { + "rvec_std_deg": [ + 0.1363572977261127, + 0.11633384131256229, + 0.16084529887405638 + ], + "tvec_std_m": [ + 0.0007750010403069387, + 0.0009584590630774931, + 0.0020674686745571877 + ] + }, + "camera_center_std_m": [ + 0.00252614437881669, + 0.002300959332032644, + 0.0030076833004178947 + ], + "camera_center_std_mm": [ + 2.52614437881669, + 2.300959332032644, + 3.0076833004178947 + ], + "orientation_std_deg": { + "roll": 0.18862165343992418, + "pitch": 0.14056395002412728, + "yaw": 0.17916027863716213 + } + } + }, + "observations": { + "markers": [ + { + "marker_id": 92, + "observed_center_px": [ + 1023.0, + 688.5 + ], + "projected_center_px": [ + 1022.8868408203125, + 684.736328125 + ], + "reprojection_error_px": 3.7653726220141297, + "confidence": 0.15369374989294518 + }, + { + "marker_id": 217, + "observed_center_px": [ + 1141.25, + 600.5 + ], + "projected_center_px": [ + 1140.9591064453125, + 605.114501953125 + ], + "reprojection_error_px": 4.623661680481518, + "confidence": 0.3233651345714012 + }, + { + "marker_id": 105, + "observed_center_px": [ + 760.5, + 654.75 + ], + "projected_center_px": [ + 761.7445068359375, + 652.6561889648438 + ], + "reprojection_error_px": 2.4357425799203933, + "confidence": 0.420622587927407 + }, + { + "marker_id": 85, + "observed_center_px": [ + 675.0, + 665.5 + ], + "projected_center_px": [ + 675.7681884765625, + 663.0847778320312 + ], + "reprojection_error_px": 2.5344450390906257, + "confidence": 0.3128949822399185 + }, + { + "marker_id": 206, + "observed_center_px": [ + 1223.5, + 566.75 + ], + "projected_center_px": [ + 1222.654541015625, + 571.3515625 + ], + "reprojection_error_px": 4.678587215780706, + "confidence": 0.11623157468788738 + }, + { + "marker_id": 97, + "observed_center_px": [ + 411.0, + 578.0 + ], + "projected_center_px": [ + 411.7170715332031, + 577.7417602539062 + ], + "reprojection_error_px": 0.7621544136150133, + "confidence": 0.22596816505744277 + }, + { + "marker_id": 47, + "observed_center_px": [ + 543.75, + 569.25 + ], + "projected_center_px": [ + 543.9366455078125, + 568.3673095703125 + ], + "reprojection_error_px": 0.902207814335749, + "confidence": 0.24626971873720385 + }, + { + "marker_id": 96, + "observed_center_px": [ + 690.25, + 544.25 + ], + "projected_center_px": [ + 690.1197509765625, + 543.3026123046875 + ], + "reprojection_error_px": 0.9562992488420937, + "confidence": 0.2205630261207473 + }, + { + "marker_id": 208, + "observed_center_px": [ + 778.5, + 467.5 + ], + "projected_center_px": [ + 777.5751953125, + 472.5607604980469 + ], + "reprojection_error_px": 5.1445661166529515, + "confidence": 0.22017552547080893 + }, + { + "marker_id": 62, + "observed_center_px": [ + 738.75, + 556.0 + ], + "projected_center_px": [ + 738.748779296875, + 554.3997802734375 + ], + "reprojection_error_px": 1.6002201921597794, + "confidence": 0.24902550615732547 + }, + { + "marker_id": 79, + "observed_center_px": [ + 667.0, + 511.75 + ], + "projected_center_px": [ + 665.9569702148438, + 510.8033447265625 + ], + "reprojection_error_px": 1.408569252628397, + "confidence": 0.2093822185726055 + }, + { + "marker_id": 66, + "observed_center_px": [ + 331.25, + 537.25 + ], + "projected_center_px": [ + 330.6866760253906, + 537.0372924804688 + ], + "reprojection_error_px": 0.6021448241368856, + "confidence": 0.16725963004706537 + }, + { + "marker_id": 55, + "observed_center_px": [ + 519.5, + 534.0 + ], + "projected_center_px": [ + 519.3466796875, + 533.4042358398438 + ], + "reprojection_error_px": 0.6151764403419393, + "confidence": 0.22298824455832925 + }, + { + "marker_id": 53, + "observed_center_px": [ + 1199.25, + 466.0 + ], + "projected_center_px": [ + 1200.085205078125, + 463.62249755859375 + ], + "reprojection_error_px": 2.5199375749050743, + "confidence": 0.13595850692924102 + }, + { + "marker_id": 214, + "observed_center_px": [ + 857.75, + 444.5 + ], + "projected_center_px": [ + 858.741943359375, + 449.60101318359375 + ], + "reprojection_error_px": 5.196564935359262, + "confidence": 0.17248468175234963 + }, + { + "marker_id": 51, + "observed_center_px": [ + 529.25, + 463.25 + ], + "projected_center_px": [ + 528.1810913085938, + 462.8843994140625 + ], + "reprojection_error_px": 1.12970331459267, + "confidence": 0.12157403976480062 + }, + { + "marker_id": 95, + "observed_center_px": [ + 425.25, + 498.75 + ], + "projected_center_px": [ + 425.3331298828125, + 498.75323486328125 + ], + "reprojection_error_px": 0.08319279870799132, + "confidence": 0.14922985097126407 + }, + { + "marker_id": 103, + "observed_center_px": [ + 465.5, + 447.25 + ], + "projected_center_px": [ + 464.1731262207031, + 447.00830078125 + ], + "reprojection_error_px": 1.3487077290984628, + "confidence": 0.11373255626245794 + }, + { + "marker_id": 60, + "observed_center_px": [ + 1195.75, + 431.0 + ], + "projected_center_px": [ + 1196.6109619140625, + 428.8692932128906 + ], + "reprojection_error_px": 2.298078943400361, + "confidence": 0.1208904643109979 + }, + { + "marker_id": 72, + "observed_center_px": [ + 1133.5, + 455.5 + ], + "projected_center_px": [ + 1134.412109375, + 453.6326904296875 + ], + "reprojection_error_px": 2.0781695174704935, + "confidence": 0.15549629518828512 + }, + { + "marker_id": 211, + "observed_center_px": [ + 763.75, + 413.0 + ], + "projected_center_px": [ + 763.891845703125, + 417.86798095703125 + ], + "reprojection_error_px": 4.870047104650417, + "confidence": 0.13332463075982282 + }, + { + "marker_id": 84, + "observed_center_px": [ + 1147.5, + 429.0 + ], + "projected_center_px": [ + 1148.4207763671875, + 427.11407470703125 + ], + "reprojection_error_px": 2.0987003904869974, + "confidence": 0.13255097071329755 + }, + { + "marker_id": 86, + "observed_center_px": [ + 1127.5, + 408.75 + ], + "projected_center_px": [ + 1127.431396484375, + 406.6729736328125 + ], + "reprojection_error_px": 2.078159034421623, + "confidence": 0.1265670983135443 + }, + { + "marker_id": 64, + "observed_center_px": [ + 378.5, + 409.25 + ], + "projected_center_px": [ + 377.0504150390625, + 409.83306884765625 + ], + "reprojection_error_px": 1.5624550681806375, + "confidence": 0.09620577544552089 + } + ] + }, + "qa": { + "sanity_notes": [] + }, + "v8_z_correction_mm": 54.81633454946478 +} \ No newline at end of file diff --git a/data/evaluations/Scene9/render_f_aruco_detection.json b/data/evaluations/Scene9/render_f_aruco_detection.json index 5eaf32b..d84aba0 100644 --- a/data/evaluations/Scene9/render_f_aruco_detection.json +++ b/data/evaluations/Scene9/render_f_aruco_detection.json @@ -1,6 +1,6 @@ { "schema_version": "1.0", - "created_utc": "2026-06-01T16:29:11Z", + "created_utc": "2026-06-01T17:39:25Z", "vision_config": { "MarkerType": "DICT_4X4_250", "MarkerSize": 0.025 @@ -46,7 +46,7 @@ }, "detections": [ { - "observation_id": "d1aa4d50-913a-44cc-97e2-afa65d5349e0", + "observation_id": "b692e820-943c-443a-93c1-ab9cf072223b", "type": "aruco", "marker_id": 43, "marker_size_m": 0.025, @@ -100,7 +100,7 @@ "confidence": 0.850354724870378 }, { - "observation_id": "42782343-eb0f-4cb1-88fc-f374a8b65712", + "observation_id": "c8cb0486-8380-42ef-a2ec-8bd83cf4ed68", "type": "aruco", "marker_id": 41, "marker_size_m": 0.025, @@ -154,7 +154,7 @@ "confidence": 0.3023072583773299 }, { - "observation_id": "5be60c86-51d7-4677-8b9d-16416a3e9ae2", + "observation_id": "5f08a3e6-f8f1-427f-a9a0-599da1ef647c", "type": "aruco", "marker_id": 46, "marker_size_m": 0.025, @@ -208,7 +208,7 @@ "confidence": 0.2988751797371847 }, { - "observation_id": "d85a3a92-f740-4ff1-8475-45365c135ea1", + "observation_id": "eb435cda-5ceb-41bc-8e8d-94405295608c", "type": "aruco", "marker_id": 56, "marker_size_m": 0.025, @@ -262,7 +262,7 @@ "confidence": 0.5697620483284124 }, { - "observation_id": "2e2e3384-dba9-4fc9-800d-77159ab09a91", + "observation_id": "fa8a4389-f47a-4464-839c-7fa213b4a673", "type": "aruco", "marker_id": 208, "marker_size_m": 0.025, @@ -316,7 +316,7 @@ "confidence": 0.5829305549976826 }, { - "observation_id": "1d3fdc60-69ca-451c-b263-5da58e2d8f81", + "observation_id": "fadb8bf3-766f-465b-916a-626bbd838067", "type": "aruco", "marker_id": 47, "marker_size_m": 0.025, @@ -370,7 +370,7 @@ "confidence": 0.5768583617164568 }, { - "observation_id": "b314f7bf-fa88-43da-9cf9-4eef61061f26", + "observation_id": "18122e61-ee7f-4081-b50d-e723ea6f4497", "type": "aruco", "marker_id": 62, "marker_size_m": 0.025, @@ -424,7 +424,7 @@ "confidence": 0.5593704450665263 }, { - "observation_id": "a159786c-db42-4584-bc6c-798fa0b21db5", + "observation_id": "bc5f689c-f497-4532-80d1-dd04edbeaa2e", "type": "aruco", "marker_id": 54, "marker_size_m": 0.025, @@ -478,7 +478,7 @@ "confidence": 0.5766374039623903 }, { - "observation_id": "0a71b8d9-dfa5-4e65-8eec-b363cabe4b7b", + "observation_id": "025466dc-8c10-42eb-80e1-40f666094ab5", "type": "aruco", "marker_id": 53, "marker_size_m": 0.025, @@ -532,7 +532,7 @@ "confidence": 0.21364841201201337 }, { - "observation_id": "1ed22bce-4d6f-435c-9b8b-c7c28a9d3233", + "observation_id": "35007e1d-283e-4aa7-bc58-833113b81bd3", "type": "aruco", "marker_id": 229, "marker_size_m": 0.025, @@ -586,7 +586,7 @@ "confidence": 0.5464657910873614 }, { - "observation_id": "3abe6368-3bd1-440a-baf5-28bf23fcdacb", + "observation_id": "d99b116c-e245-41f8-83c9-ea3b6061e5ed", "type": "aruco", "marker_id": 97, "marker_size_m": 0.025, @@ -640,7 +640,7 @@ "confidence": 0.5705029634947052 }, { - "observation_id": "4c1d8a24-b090-406f-ba5c-db7750f2eab3", + "observation_id": "7ce8593d-fec2-4640-afaa-d510ffc06456", "type": "aruco", "marker_id": 72, "marker_size_m": 0.025, @@ -694,7 +694,7 @@ "confidence": 0.5440516905787338 }, { - "observation_id": "185fbe4f-c6af-46a5-9c1e-b314ab92bda5", + "observation_id": "e2eba250-5e42-4a2b-a480-1e661be24ca0", "type": "aruco", "marker_id": 55, "marker_size_m": 0.025, @@ -748,7 +748,7 @@ "confidence": 0.5461315019106076 }, { - "observation_id": "625b3925-f45b-4755-91a3-88b1482c46ff", + "observation_id": "1e3b6db9-8873-4bc2-9b38-37b1f5c2ce1d", "type": "aruco", "marker_id": 96, "marker_size_m": 0.025, @@ -802,7 +802,7 @@ "confidence": 0.5763709732716893 }, { - "observation_id": "10bc13cc-a5b3-4412-a3f2-d6a1f6d4e3b7", + "observation_id": "317bcb38-4b5c-4df2-a7cd-9608db191e71", "type": "aruco", "marker_id": 42, "marker_size_m": 0.025, @@ -856,7 +856,7 @@ "confidence": 0.2932628535560303 }, { - "observation_id": "d5a10576-d01a-4406-89cd-1af5133d7e96", + "observation_id": "0067d828-93d9-42c6-a0f8-8f92c60fe7ad", "type": "aruco", "marker_id": 84, "marker_size_m": 0.025, @@ -910,7 +910,7 @@ "confidence": 0.06519221426443914 }, { - "observation_id": "73fcd9a5-07cb-44a9-aa98-a90138ecfa6d", + "observation_id": "e88fa055-3e8d-4ae8-b351-530496cb5a3d", "type": "aruco", "marker_id": 79, "marker_size_m": 0.025, @@ -964,7 +964,7 @@ "confidence": 0.5460974493377216 }, { - "observation_id": "4e16e51e-b424-4084-a715-c4394d289f88", + "observation_id": "ace2036b-21f1-409b-8d25-531f5a599d13", "type": "aruco", "marker_id": 66, "marker_size_m": 0.025, @@ -1018,7 +1018,7 @@ "confidence": 0.5349107016469481 }, { - "observation_id": "39522e25-1a83-4c63-b709-320db062a5c8", + "observation_id": "7cb60d0f-3d2c-40ae-9708-4f320ee5edf1", "type": "aruco", "marker_id": 95, "marker_size_m": 0.025, @@ -1072,7 +1072,7 @@ "confidence": 0.5227826547122322 }, { - "observation_id": "46722ca4-cca2-43ee-8880-24fdee901f1b", + "observation_id": "57929e2e-daec-42e0-b7c4-8c0a288c193b", "type": "aruco", "marker_id": 103, "marker_size_m": 0.025, @@ -1126,7 +1126,7 @@ "confidence": 0.5046333482067283 }, { - "observation_id": "0a2c5da9-efd8-4d12-94ce-0fba94b74374", + "observation_id": "33c8d8ff-3409-462e-91d5-59065c532b88", "type": "aruco", "marker_id": 52, "marker_size_m": 0.025, @@ -1180,7 +1180,7 @@ "confidence": 0.4723088830007061 }, { - "observation_id": "d4dfd711-abca-42d0-8331-7f21361c6a8d", + "observation_id": "e972de75-cbe8-4adb-acb1-5ac102dbb06c", "type": "aruco", "marker_id": 73, "marker_size_m": 0.025, @@ -1234,7 +1234,7 @@ "confidence": 0.13607001327160623 }, { - "observation_id": "6fd48197-2029-43ca-a7e4-62d3b9a760d8", + "observation_id": "62901942-1493-4f5f-8f08-24a28c275c68", "type": "aruco", "marker_id": 210, "marker_size_m": 0.025, @@ -1288,7 +1288,7 @@ "confidence": 0.46988879526830113 }, { - "observation_id": "96cdd3fa-f04e-48b0-8321-9ed3b73019cf", + "observation_id": "0beb85e9-1740-426c-b7d1-2228ad200a96", "type": "aruco", "marker_id": 58, "marker_size_m": 0.025, @@ -1342,7 +1342,7 @@ "confidence": 0.4655541127751829 }, { - "observation_id": "3c89c755-60cd-4515-a3ee-a21fe407ceaa", + "observation_id": "f73fbd6a-0a4c-44dc-a190-638c0a7ff53f", "type": "aruco", "marker_id": 69, "marker_size_m": 0.025, @@ -1396,7 +1396,7 @@ "confidence": 0.4655541127751829 }, { - "observation_id": "ea60dba0-109e-45b7-80ed-fe20dc65ab51", + "observation_id": "e9dbedb1-bf63-489a-8cae-e087461fdc0c", "type": "aruco", "marker_id": 82, "marker_size_m": 0.025, @@ -1450,7 +1450,7 @@ "confidence": 0.49001748422717006 }, { - "observation_id": "1522de61-2fe4-4ba6-b5a2-b18def82657e", + "observation_id": "8b088a43-cdb6-422f-8af6-3f10b66ed956", "type": "aruco", "marker_id": 101, "marker_size_m": 0.025, @@ -1504,7 +1504,7 @@ "confidence": 0.46225891142368675 }, { - "observation_id": "1cf986ab-e726-4043-885d-e5a45d8018db", + "observation_id": "556255e3-e0cd-40f1-823f-b257acf2a73a", "type": "aruco", "marker_id": 64, "marker_size_m": 0.025, @@ -1558,7 +1558,7 @@ "confidence": 0.43211414091114625 }, { - "observation_id": "30465b47-6dcd-4b92-8ff0-911394ccdf93", + "observation_id": "e664659a-d231-47bb-a0f0-4a2ee611e4e1", "type": "aruco", "marker_id": 81, "marker_size_m": 0.025, @@ -1612,7 +1612,7 @@ "confidence": 0.4468602604238168 }, { - "observation_id": "9e4a382a-a31d-4e02-bf8b-33b1dd48e4c8", + "observation_id": "5032ce03-aa16-4b13-bfbe-16806d4ffeaa", "type": "aruco", "marker_id": 83, "marker_size_m": 0.025, @@ -1666,7 +1666,7 @@ "confidence": 0.4377857805109236 }, { - "observation_id": "6ace4964-9165-485e-ac5c-9ffa32b5e1bd", + "observation_id": "f775f2d4-3851-46d0-9958-9cb93bb49665", "type": "aruco", "marker_id": 75, "marker_size_m": 0.025, @@ -1720,7 +1720,7 @@ "confidence": 0.22473325223116958 }, { - "observation_id": "42304a3f-a13b-4cd7-bb2a-f0d2e059bf07", + "observation_id": "ea5c0b5a-c212-4b01-a7ba-6937c4766ab1", "type": "aruco", "marker_id": 113, "marker_size_m": 0.025, diff --git a/data/evaluations/Scene9/render_f_camera_pose.json b/data/evaluations/Scene9/render_f_camera_pose.json index 849c1f0..3ef7a4f 100644 --- a/data/evaluations/Scene9/render_f_camera_pose.json +++ b/data/evaluations/Scene9/render_f_camera_pose.json @@ -1,6 +1,6 @@ { "schema_version": "1.0", - "created_utc": "2026-06-01T16:29:15Z", + "created_utc": "2026-06-01T17:39:28Z", "source": { "detection_json": "C:\\Users\\kech\\SynologyDrive\\2026-AppServer-AppRobot\\appRobotRendering\\data\\evaluations\\Scene9\\render_f_aruco_detection.json", "robot_json": "C:\\Users\\kech\\SynologyDrive\\2026-AppServer-AppRobot\\appRobotRendering\\data\\robot\\robot.json" diff --git a/data/evaluations/Scene9/render_f_camera_pose_v8.json b/data/evaluations/Scene9/render_f_camera_pose_v8.json new file mode 100644 index 0000000..67ef43b --- /dev/null +++ b/data/evaluations/Scene9/render_f_camera_pose_v8.json @@ -0,0 +1,601 @@ +{ + "schema_version": "1.0", + "created_utc": "2026-06-01T17:39:38Z", + "source": { + "detection_json": "C:\\Users\\kech\\SynologyDrive\\2026-AppServer-AppRobot\\appRobotRendering\\data\\evaluations\\Scene9\\render_f_aruco_detection.json", + "robot_json": "C:\\Users\\kech\\SynologyDrive\\2026-AppServer-AppRobot\\appRobotRendering\\data\\robot\\robot.json" + }, + "camera": { + "camera_id": "f", + "camera_matrix": [ + [ + 1777.77783203125, + 0.0, + 640.0 + ], + [ + 0.0, + 1500.0, + 360.0 + ], + [ + 0.0, + 0.0, + 1.0 + ] + ], + "distortion_coefficients": [ + 0.0, + 0.0, + 0.0, + 0.0, + 0.0 + ] + }, + "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": 27, + "used_marker_ids": [ + 46, + 56, + 208, + 47, + 62, + 54, + 53, + 97, + 72, + 55, + 96, + 84, + 79, + 66, + 95, + 103, + 52, + 73, + 210, + 58, + 69, + 82, + 101, + 64, + 81, + 83, + 75 + ], + "history": { + "iters": [ + 0, + 1, + 2, + 3, + 4, + 5, + 6, + 7, + 8, + 9, + 10 + ], + "rms": [ + 0.015701356394471733, + 0.015297855069293168, + 0.011524674965863707, + 0.008661433675275389, + 0.00789850187690886, + 0.007842132486163736, + 0.007839540532042596, + 0.007839421032317734, + 0.007839415701149656, + 0.007839415464271995, + 0.007839415453743833 + ], + "lambda": [ + 0.001, + 0.0005, + 0.00025, + 0.000125, + 6.25e-05, + 3.125e-05, + 1.5625e-05, + 7.8125e-06, + 3.90625e-06, + 1.953125e-06, + 9.765625e-07 + ] + }, + "residual_rms_px": 18.137879039135672, + "residual_median_px": 15.891270492416046, + "residual_max_px": 32.8404433163514, + "sigma2_normalized": 6.913848898029083e-05 + }, + "camera_pose": { + "world_to_camera": { + "rotation_matrix": [ + [ + 0.3255375623703003, + 0.8988600373268127, + 0.29338693618774414 + ], + [ + 0.9455116391181946, + -0.3075793981552124, + -0.1067829430103302 + ], + [ + -0.005743145477026701, + 0.3121626079082489, + -0.9500113129615784 + ] + ], + "translation_m": [ + 0.10647550468277854, + -0.1940357287725178, + 1.3456141914248498 + ], + "rvec_rad": [ + 2.334443448932517, + 1.6668089931536274, + 0.2599515229751258 + ] + }, + "camera_in_world": { + "position_m": [ + 0.15652932822514254, + -0.5754384567326216, + 1.2263905023878365 + ], + "position_mm": [ + 156.52932822514254, + -575.4384567326216, + 1226.3905023878365 + ], + "orientation_deg": { + "roll": 161.81007385253906, + "pitch": 0.32905977964401245, + "yaw": 71.00152587890625 + } + }, + "uncertainty": { + "pose_covariance_6x6": [ + [ + 0.0006521111112735179, + 0.00036528966280300094, + -0.00010637666565730888, + 1.1187114044635454e-06, + 2.7785039095203165e-05, + 0.00014853189086861253 + ], + [ + 0.00036528966280300365, + 0.0003633076638036935, + 2.562778432160452e-05, + 2.6092071905066404e-05, + 1.6263683163092177e-05, + 7.600815489637061e-05 + ], + [ + -0.00010637666565727772, + 2.562778432162969e-05, + 0.0017152116736520494, + 5.891878151451568e-05, + 3.901380666156852e-07, + -0.0004990497236999936 + ], + [ + 1.118711404465086e-06, + 2.609207190506745e-05, + 5.8918781514514094e-05, + 1.0796844344238786e-05, + 6.555994303168036e-07, + -3.3813792197815607e-06 + ], + [ + 2.77850390952032e-05, + 1.626368316309203e-05, + 3.901380666137898e-07, + 6.555994303167142e-07, + 5.6739233703903745e-06, + 8.500206420348859e-06 + ], + [ + 0.00014853189086860418, + 7.600815489636319e-05, + -0.0004990497237000007, + -3.3813792197823214e-06, + 8.500206420348362e-06, + 0.0002672399327877841 + ] + ], + "parameter_std": { + "rvec_std_deg": [ + 1.4631317428727735, + 1.0920937257134558, + 2.3729112444167018 + ], + "tvec_std_m": [ + 0.0032858551922199473, + 0.0023819998678401254, + 0.016347474813798737 + ] + }, + "camera_center_std_m": [ + 0.03722572649769533, + 0.030657108809873723, + 0.024724327431695548 + ], + "camera_center_std_mm": [ + 37.22572649769533, + 30.657108809873723, + 24.72432743169555 + ], + "orientation_std_deg": { + "roll": 1.232318313836353, + "pitch": 1.6371795162133258, + "yaw": 0.48210298661799955 + } + } + }, + "observations": { + "markers": [ + { + "marker_id": 46, + "observed_center_px": [ + 1234.0, + 666.0 + ], + "projected_center_px": [ + 1229.82373046875, + 636.6405029296875 + ], + "reprojection_error_px": 29.655038280523858, + "confidence": 0.2988751797371847 + }, + { + "marker_id": 56, + "observed_center_px": [ + 1196.0, + 626.75 + ], + "projected_center_px": [ + 1196.3397216796875, + 603.91357421875 + ], + "reprojection_error_px": 22.838952543454994, + "confidence": 0.5697620483284124 + }, + { + "marker_id": 208, + "observed_center_px": [ + 831.25, + 547.75 + ], + "projected_center_px": [ + 859.1162719726562, + 548.44580078125 + ], + "reprojection_error_px": 27.874957441783394, + "confidence": 0.5829305549976826 + }, + { + "marker_id": 47, + "observed_center_px": [ + 593.75, + 623.75 + ], + "projected_center_px": [ + 595.1937866210938, + 624.6065673828125 + ], + "reprojection_error_px": 1.6787577218132352, + "confidence": 0.5768583617164568 + }, + { + "marker_id": 62, + "observed_center_px": [ + 751.0, + 651.75 + ], + "projected_center_px": [ + 765.1891479492188, + 644.5945434570312 + ], + "reprojection_error_px": 15.891270492416046, + "confidence": 0.5593704450665263 + }, + { + "marker_id": 54, + "observed_center_px": [ + 540.5, + 639.0 + ], + "projected_center_px": [ + 535.7850341796875, + 642.0477905273438 + ], + "reprojection_error_px": 5.614261285804342, + "confidence": 0.5766374039623903 + }, + { + "marker_id": 53, + "observed_center_px": [ + 1240.5, + 594.75 + ], + "projected_center_px": [ + 1235.982666015625, + 574.2188720703125 + ], + "reprojection_error_px": 21.022214925920235, + "confidence": 0.21364841201201337 + }, + { + "marker_id": 97, + "observed_center_px": [ + 491.5, + 605.25 + ], + "projected_center_px": [ + 478.2646179199219, + 610.6361694335938 + ], + "reprojection_error_px": 14.289372273582657, + "confidence": 0.5705029634947052 + }, + { + "marker_id": 72, + "observed_center_px": [ + 1197.75, + 548.5 + ], + "projected_center_px": [ + 1198.48974609375, + 534.4537353515625 + ], + "reprojection_error_px": 14.065730512744919, + "confidence": 0.5440516905787338 + }, + { + "marker_id": 55, + "observed_center_px": [ + 598.75, + 542.75 + ], + "projected_center_px": [ + 598.1221313476562, + 544.5460815429688 + ], + "reprojection_error_px": 1.902663384203565, + "confidence": 0.5461315019106076 + }, + { + "marker_id": 96, + "observed_center_px": [ + 723.0, + 614.5 + ], + "projected_center_px": [ + 735.0128173828125, + 610.1817626953125 + ], + "reprojection_error_px": 12.765381110346723, + "confidence": 0.5763709732716893 + }, + { + "marker_id": 84, + "observed_center_px": [ + 1254.25, + 485.0 + ], + "projected_center_px": [ + 1249.8275146484375, + 476.7846374511719 + ], + "reprojection_error_px": 9.330088879183982, + "confidence": 0.06519221426443914 + }, + { + "marker_id": 79, + "observed_center_px": [ + 731.5, + 535.75 + ], + "projected_center_px": [ + 742.62255859375, + 534.1879272460938 + ], + "reprojection_error_px": 11.231713180094042, + "confidence": 0.5460974493377216 + }, + { + "marker_id": 66, + "observed_center_px": [ + 453.0, + 495.75 + ], + "projected_center_px": [ + 428.0283203125, + 500.76373291015625 + ], + "reprojection_error_px": 25.470027563971815, + "confidence": 0.5349107016469481 + }, + { + "marker_id": 95, + "observed_center_px": [ + 548.75, + 435.0 + ], + "projected_center_px": [ + 537.2727661132812, + 436.9281311035156 + ], + "reprojection_error_px": 11.63806630170105, + "confidence": 0.5227826547122322 + }, + { + "marker_id": 103, + "observed_center_px": [ + 618.0, + 313.5 + ], + "projected_center_px": [ + 612.1203002929688, + 313.2383117675781 + ], + "reprojection_error_px": 5.88552031479388, + "confidence": 0.5046333482067283 + }, + { + "marker_id": 52, + "observed_center_px": [ + 1054.75, + 161.0 + ], + "projected_center_px": [ + 1067.6309814453125, + 173.99093627929688 + ], + "reprojection_error_px": 18.29437368174261, + "confidence": 0.4723088830007061 + }, + { + "marker_id": 73, + "observed_center_px": [ + 1247.5, + 251.25 + ], + "projected_center_px": [ + 1247.70263671875, + 265.3039855957031 + ], + "reprojection_error_px": 14.055446373702141, + "confidence": 0.13607001327160623 + }, + { + "marker_id": 210, + "observed_center_px": [ + 775.0, + 150.5 + ], + "projected_center_px": [ + 793.588623046875, + 156.1845245361328 + ], + "reprojection_error_px": 19.438382802607535, + "confidence": 0.46988879526830113 + }, + { + "marker_id": 58, + "observed_center_px": [ + 562.75, + 264.25 + ], + "projected_center_px": [ + 547.3587036132812, + 261.0544128417969 + ], + "reprojection_error_px": 15.71953503604653, + "confidence": 0.4655541127751829 + }, + { + "marker_id": 69, + "observed_center_px": [ + 476.25, + 240.75 + ], + "projected_center_px": [ + 444.06695556640625, + 234.21192932128906 + ], + "reprojection_error_px": 32.8404433163514, + "confidence": 0.4655541127751829 + }, + { + "marker_id": 82, + "observed_center_px": [ + 1207.5, + 261.5 + ], + "projected_center_px": [ + 1210.841552734375, + 273.69903564453125 + ], + "reprojection_error_px": 12.6484167125041, + "confidence": 0.49001748422717006 + }, + { + "marker_id": 101, + "observed_center_px": [ + 1162.25, + 153.5 + ], + "projected_center_px": [ + 1170.449462890625, + 171.389404296875 + ], + "reprojection_error_px": 19.678972986205, + "confidence": 0.46225891142368675 + }, + { + "marker_id": 64, + "observed_center_px": [ + 570.5, + 177.75 + ], + "projected_center_px": [ + 553.1890258789062, + 170.61465454101562 + ], + "reprojection_error_px": 18.723861242815982, + "confidence": 0.43211414091114625 + }, + { + "marker_id": 81, + "observed_center_px": [ + 1027.5, + 214.0 + ], + "projected_center_px": [ + 1041.18798828125, + 224.353515625 + ], + "reprojection_error_px": 17.1626428321735, + "confidence": 0.4468602604238168 + }, + { + "marker_id": 83, + "observed_center_px": [ + 1173.0, + 64.0 + ], + "projected_center_px": [ + 1181.1949462890625, + 86.80318450927734 + ], + "reprojection_error_px": 24.23102078833588, + "confidence": 0.4377857805109236 + }, + { + "marker_id": 75, + "observed_center_px": [ + 987.75, + 42.0 + ], + "projected_center_px": [ + 1002.008056640625, + 54.512149810791016 + ], + "reprojection_error_px": 18.969609169799686, + "confidence": 0.22473325223116958 + } + ] + }, + "qa": { + "sanity_notes": [] + }, + "v8_z_correction_mm": 54.81633454946478 +} \ No newline at end of file diff --git a/data/evaluations/Scene9/render_g_aruco_detection.json b/data/evaluations/Scene9/render_g_aruco_detection.json index 97e2710..93a328c 100644 --- a/data/evaluations/Scene9/render_g_aruco_detection.json +++ b/data/evaluations/Scene9/render_g_aruco_detection.json @@ -1,6 +1,6 @@ { "schema_version": "1.0", - "created_utc": "2026-06-01T16:29:12Z", + "created_utc": "2026-06-01T17:39:26Z", "vision_config": { "MarkerType": "DICT_4X4_250", "MarkerSize": 0.025 @@ -46,7 +46,7 @@ }, "detections": [ { - "observation_id": "85bbf7da-497e-47e3-a810-4232b3cb2ddb", + "observation_id": "d34538a1-e688-470d-ba56-5b68f95d195f", "type": "aruco", "marker_id": 41, "marker_size_m": 0.025, @@ -100,7 +100,7 @@ "confidence": 0.7407693857081211 }, { - "observation_id": "8570bb34-0860-4371-955a-a5bcf696e24d", + "observation_id": "a06715c2-aacf-4fa6-b407-98789f3ff35b", "type": "aruco", "marker_id": 42, "marker_size_m": 0.025, @@ -154,7 +154,7 @@ "confidence": 0.47851333141876906 }, { - "observation_id": "fc7ac70e-d673-4173-bd0a-cafeed2cace7", + "observation_id": "6a3d553e-9da5-48de-a753-fb97d111b4a1", "type": "aruco", "marker_id": 198, "marker_size_m": 0.025, @@ -208,7 +208,7 @@ "confidence": 0.5891588970505985 }, { - "observation_id": "64dd3c65-dfde-46b0-87bf-fba6ab424fb0", + "observation_id": "633990d1-d2d8-4e77-a5ae-d529f3fb734d", "type": "aruco", "marker_id": 43, "marker_size_m": 0.025, @@ -262,7 +262,7 @@ "confidence": 0.38340186913811386 }, { - "observation_id": "28425eec-6a02-4ee8-8391-3212b39f4ada", + "observation_id": "0158054c-8039-4fe8-bf93-1c4d5b51cb9a", "type": "aruco", "marker_id": 84, "marker_size_m": 0.025, @@ -316,7 +316,7 @@ "confidence": 0.3490767193505014 }, { - "observation_id": "4f5f6472-2400-4d72-8c48-de0dc598ceba", + "observation_id": "b2868068-7a33-4055-962f-8ad70c2439d6", "type": "aruco", "marker_id": 229, "marker_size_m": 0.025, @@ -370,7 +370,7 @@ "confidence": 0.519411428244808 }, { - "observation_id": "ad1dc23c-80b8-4819-ad61-9322ebb0a5a9", + "observation_id": "dc3aa998-b11c-4272-af8f-328c20594a7c", "type": "aruco", "marker_id": 64, "marker_size_m": 0.025, @@ -424,7 +424,7 @@ "confidence": 0.5331747682067169 }, { - "observation_id": "a28006e2-c3d6-478d-8ad5-3940e02a39bb", + "observation_id": "2ce54a24-7f6b-4a72-83e3-9ba74b4f24fa", "type": "aruco", "marker_id": 72, "marker_size_m": 0.025, @@ -478,7 +478,7 @@ "confidence": 0.43254677700170213 }, { - "observation_id": "a6c694ad-032f-4f0a-9840-aee9c25bd503", + "observation_id": "b8dce317-8fb8-4d1c-853b-dde40976b4eb", "type": "aruco", "marker_id": 53, "marker_size_m": 0.025, @@ -532,7 +532,7 @@ "confidence": 0.27711751756945874 }, { - "observation_id": "dddcac92-c4c6-43a0-9c25-8b34e395541b", + "observation_id": "2a5d127b-9e70-42ae-a37f-2a5b410b46fb", "type": "aruco", "marker_id": 58, "marker_size_m": 0.025, @@ -586,7 +586,7 @@ "confidence": 0.48073279309443956 }, { - "observation_id": "66c77a54-3225-48a8-8a6d-e3183fc4e81d", + "observation_id": "8bb73504-d7e8-42af-9bbc-417e3942a415", "type": "aruco", "marker_id": 69, "marker_size_m": 0.025, @@ -640,7 +640,7 @@ "confidence": 0.45515519100712953 }, { - "observation_id": "53d1a0bc-e5d4-4cf3-be69-295924628ea5", + "observation_id": "0ee6ae9c-7b3a-41b6-a509-f3f773bf5988", "type": "aruco", "marker_id": 215, "marker_size_m": 0.025, @@ -694,7 +694,7 @@ "confidence": 0.3775515964613595 }, { - "observation_id": "cbc62475-dfcd-4c67-8e54-8369537e7572", + "observation_id": "ff8672af-624a-47d4-96d9-f092e8c07b0f", "type": "aruco", "marker_id": 103, "marker_size_m": 0.025, @@ -748,7 +748,7 @@ "confidence": 0.47991555158957017 }, { - "observation_id": "51248c4a-490a-4c71-a1ea-8ef7aa482bc8", + "observation_id": "02341e81-2489-4562-a583-dd2862f99122", "type": "aruco", "marker_id": 56, "marker_size_m": 0.025, @@ -802,7 +802,7 @@ "confidence": 0.39662908657084783 }, { - "observation_id": "b2c38058-ad76-476d-bd62-ba4b0d10c5a5", + "observation_id": "8aeba79d-60ed-4a1a-acde-c580c0b8c6cf", "type": "aruco", "marker_id": 46, "marker_size_m": 0.025, @@ -856,7 +856,7 @@ "confidence": 0.1698001278724927 }, { - "observation_id": "2cb22b64-02eb-4b44-a93a-c54480b1764c", + "observation_id": "cf7809e9-5ba6-4e0c-a38b-a5d76bcf569d", "type": "aruco", "marker_id": 68, "marker_size_m": 0.025, @@ -910,7 +910,7 @@ "confidence": 0.07718187630567852 }, { - "observation_id": "bb0e791c-c2bb-4e2c-babe-39499252cc8f", + "observation_id": "764eb60f-1d17-499c-9427-9cb5c2db92b1", "type": "aruco", "marker_id": 208, "marker_size_m": 0.025, @@ -964,7 +964,7 @@ "confidence": 0.4316478958478293 }, { - "observation_id": "29729935-8dc8-4cf3-92da-5ed3843fb7e1", + "observation_id": "7aaeb7b4-8d20-4014-9ed6-5a55205a2629", "type": "aruco", "marker_id": 95, "marker_size_m": 0.025, @@ -1018,7 +1018,7 @@ "confidence": 0.4181682027393045 }, { - "observation_id": "b9beccd2-bd85-4d2d-8338-3203732ac7d8", + "observation_id": "fa3d307f-7f23-4859-b767-283b1b95dd42", "type": "aruco", "marker_id": 55, "marker_size_m": 0.025, @@ -1072,7 +1072,7 @@ "confidence": 0.39668368657567366 }, { - "observation_id": "eecb3e0c-bde3-4c3c-a702-d4cd4d4b387b", + "observation_id": "f9ac1566-65e7-43f3-bfa7-485b539d6b17", "type": "aruco", "marker_id": 66, "marker_size_m": 0.025, @@ -1126,7 +1126,7 @@ "confidence": 0.3829765144945479 }, { - "observation_id": "3d2b8d4d-e439-41e2-b923-0ed75029a06f", + "observation_id": "7de918ad-3e0f-4ea9-9564-b319fe8ce9fb", "type": "aruco", "marker_id": 217, "marker_size_m": 0.025, @@ -1180,7 +1180,7 @@ "confidence": 0.3382587531306593 }, { - "observation_id": "49c5b670-96e8-4772-bf98-4d06f77e10df", + "observation_id": "6cd56bf7-5973-40ff-99fb-efd29788b837", "type": "aruco", "marker_id": 47, "marker_size_m": 0.025, @@ -1234,7 +1234,7 @@ "confidence": 0.36403279165733554 }, { - "observation_id": "f12f85ae-6f1e-4cd4-8951-d076422cb15b", + "observation_id": "9d8d38b9-4391-4555-afbc-cd742450ce4d", "type": "aruco", "marker_id": 97, "marker_size_m": 0.025, @@ -1288,7 +1288,7 @@ "confidence": 0.3623898971459892 }, { - "observation_id": "5a2f96b7-c8b9-4813-82aa-32320577bef0", + "observation_id": "8ce583bf-7992-4460-a271-7999f0b05f66", "type": "aruco", "marker_id": 54, "marker_size_m": 0.025, @@ -1342,7 +1342,7 @@ "confidence": 0.3590718541167963 }, { - "observation_id": "c26b07cd-3aa7-4917-9a1a-63c1c2c82b22", + "observation_id": "31392ce5-c1c3-43cd-a4d6-702882dd4cb0", "type": "aruco", "marker_id": 205, "marker_size_m": 0.025, @@ -1396,7 +1396,7 @@ "confidence": 0.29591817114314195 }, { - "observation_id": "eab76f23-7107-423b-9733-89070c839d04", + "observation_id": "540621e7-11c2-447f-9af6-85da0fa814d1", "type": "aruco", "marker_id": 92, "marker_size_m": 0.025, @@ -1450,7 +1450,7 @@ "confidence": 0.3158166687011719 }, { - "observation_id": "85b5f13d-a334-4fb8-9fa2-4b807bb8c267", + "observation_id": "53f7ed02-9fcd-4636-bf28-22720365bcc7", "type": "aruco", "marker_id": 105, "marker_size_m": 0.025, @@ -1504,7 +1504,7 @@ "confidence": 0.31800273344664126 }, { - "observation_id": "672e06ea-7c56-40aa-8be3-cf961d988ffd", + "observation_id": "08e7e727-f310-4a30-b191-9a0607d3d4db", "type": "aruco", "marker_id": 85, "marker_size_m": 0.025, @@ -1558,7 +1558,7 @@ "confidence": 0.2969848480224609 }, { - "observation_id": "c602d90f-ecd1-4461-b853-4c567acff182", + "observation_id": "f21f961e-6810-4cc5-b430-52f55642571a", "type": "aruco", "marker_id": 102, "marker_size_m": 0.025, @@ -1612,7 +1612,7 @@ "confidence": 0.3170967427530611 }, { - "observation_id": "7e09caf1-df00-430f-8968-74a250ef5ae5", + "observation_id": "ac237e04-6dd7-4482-bb6e-3ccf7fb43922", "type": "aruco", "marker_id": 59, "marker_size_m": 0.025, @@ -1666,7 +1666,7 @@ "confidence": 0.3170967427530611 }, { - "observation_id": "0d5607ae-ab1e-4ec9-9a47-9156f41fa455", + "observation_id": "e40794bd-8340-4fb3-862e-9dff823eb60b", "type": "aruco", "marker_id": 48, "marker_size_m": 0.025, @@ -1720,7 +1720,7 @@ "confidence": 0.17828567290874034 }, { - "observation_id": "0aa5ea22-8d6e-482b-9ec4-153da2440946", + "observation_id": "8aad007b-d6f5-4e2e-a4e1-596898987ff1", "type": "aruco", "marker_id": 57, "marker_size_m": 0.025, @@ -1774,7 +1774,7 @@ "confidence": 0.3167426670523156 }, { - "observation_id": "92ab2264-370a-4da6-a098-20b8f7d24f39", + "observation_id": "28663746-d22f-454d-9000-e0f73d5c4cc3", "type": "aruco", "marker_id": 63, "marker_size_m": 0.025, @@ -1828,7 +1828,7 @@ "confidence": 0.15449597168691093 }, { - "observation_id": "f0ce9f3d-29a5-4f86-bab2-b66e1776a8d2", + "observation_id": "fc521ee6-446a-4161-b748-24e45449b633", "type": "aruco", "marker_id": 71, "marker_size_m": 0.025, @@ -1882,7 +1882,7 @@ "confidence": 0.08171792300897739 }, { - "observation_id": "f78cf4fe-e5b9-4756-b01f-e4e0005622cb", + "observation_id": "766e02aa-cba1-44ca-9a61-c670c3a5c305", "type": "aruco", "marker_id": 120, "marker_size_m": 0.025, diff --git a/data/evaluations/Scene9/render_g_camera_pose.json b/data/evaluations/Scene9/render_g_camera_pose.json index b403419..b95e216 100644 --- a/data/evaluations/Scene9/render_g_camera_pose.json +++ b/data/evaluations/Scene9/render_g_camera_pose.json @@ -1,6 +1,6 @@ { "schema_version": "1.0", - "created_utc": "2026-06-01T16:29:15Z", + "created_utc": "2026-06-01T17:39:29Z", "source": { "detection_json": "C:\\Users\\kech\\SynologyDrive\\2026-AppServer-AppRobot\\appRobotRendering\\data\\evaluations\\Scene9\\render_g_aruco_detection.json", "robot_json": "C:\\Users\\kech\\SynologyDrive\\2026-AppServer-AppRobot\\appRobotRendering\\data\\robot\\robot.json" diff --git a/data/evaluations/Scene9/render_g_camera_pose_v8.json b/data/evaluations/Scene9/render_g_camera_pose_v8.json new file mode 100644 index 0000000..1810bc9 --- /dev/null +++ b/data/evaluations/Scene9/render_g_camera_pose_v8.json @@ -0,0 +1,629 @@ +{ + "schema_version": "1.0", + "created_utc": "2026-06-01T17:39:38Z", + "source": { + "detection_json": "C:\\Users\\kech\\SynologyDrive\\2026-AppServer-AppRobot\\appRobotRendering\\data\\evaluations\\Scene9\\render_g_aruco_detection.json", + "robot_json": "C:\\Users\\kech\\SynologyDrive\\2026-AppServer-AppRobot\\appRobotRendering\\data\\robot\\robot.json" + }, + "camera": { + "camera_id": "g", + "camera_matrix": [ + [ + 1777.77783203125, + 0.0, + 640.0 + ], + [ + 0.0, + 1500.0, + 360.0 + ], + [ + 0.0, + 0.0, + 1.0 + ] + ], + "distortion_coefficients": [ + 0.0, + 0.0, + 0.0, + 0.0, + 0.0 + ] + }, + "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": 29, + "used_marker_ids": [ + 84, + 64, + 72, + 53, + 58, + 69, + 215, + 103, + 56, + 46, + 68, + 208, + 95, + 55, + 66, + 217, + 47, + 97, + 54, + 205, + 92, + 105, + 85, + 102, + 59, + 48, + 57, + 63, + 71 + ], + "history": { + "iters": [ + 0, + 1, + 2, + 3, + 4, + 5, + 6, + 7, + 8, + 9, + 10 + ], + "rms": [ + 0.02200940579566412, + 0.012492719601123106, + 0.006103430044278538, + 0.0055115399329895825, + 0.005096973387838219, + 0.005079213955287144, + 0.005078265280046825, + 0.0050782114556132685, + 0.005078208229684019, + 0.005078208035428635, + 0.005078208023787546 + ], + "lambda": [ + 0.001, + 0.0005, + 0.00025, + 0.000125, + 6.25e-05, + 3.125e-05, + 1.5625e-05, + 7.8125e-06, + 3.90625e-06, + 1.953125e-06, + 9.765625e-07 + ] + }, + "residual_rms_px": 11.755561902657986, + "residual_median_px": 7.179568755770828, + "residual_max_px": 23.328064176759177, + "sigma2_normalized": 2.8763757886605642e-05 + }, + "camera_pose": { + "world_to_camera": { + "rotation_matrix": [ + [ + -0.6559104919433594, + -0.7190011739730835, + -0.22982333600521088 + ], + [ + -0.6814113259315491, + 0.6949824094772339, + -0.22951699793338776 + ], + [ + 0.32474616169929504, + 0.006061616353690624, + -0.9457817673683167 + ] + ], + "translation_m": [ + -0.008546736769005471, + 0.37453688654771516, + 1.3456171779786519 + ], + "rvec_rad": [ + 1.106264639889024, + -2.6042289186417977, + 0.1765199787946084 + ] + }, + "camera_in_world": { + "position_m": [ + -0.18737624801245722, + -0.274598287157779, + 1.3566585817626364 + ], + "position_mm": [ + -187.3762480124572, + -274.598287157779, + 1356.6585817626365 + ], + "orientation_deg": { + "roll": 179.63278198242188, + "pitch": -18.950197219848633, + "yaw": -133.90757751464844 + } + }, + "uncertainty": { + "pose_covariance_6x6": [ + [ + 0.00015713177460004805, + -0.00024204502628152495, + 1.7758625437526932e-05, + 1.720048535412467e-05, + 2.8695667094934284e-05, + 0.00018562673513110555 + ], + [ + -0.00024204502628152386, + 0.0005917462265111596, + -3.912138084668765e-05, + -7.209370121885013e-05, + -5.030004382328941e-05, + -0.00041584570195426346 + ], + [ + 1.775862543752117e-05, + -3.912138084668026e-05, + 0.0005937501659202497, + 1.2121327837238821e-05, + -5.034321601349462e-05, + -6.556933985800179e-05 + ], + [ + 1.720048535412448e-05, + -7.209370121884996e-05, + 1.2121327837239306e-05, + 1.4244784832818947e-05, + 3.7543773536765624e-06, + 4.016671598390895e-05 + ], + [ + 2.8695667094934772e-05, + -5.030004382329021e-05, + -5.034321601349331e-05, + 3.7543773536766378e-06, + 1.2415433456772226e-05, + 4.562655960014969e-05 + ], + [ + 0.0001856267351311054, + -0.00041584570195426487, + -6.556933985799604e-05, + 4.0166715983909274e-05, + 4.5626559600149246e-05, + 0.0003640957163529654 + ] + ], + "parameter_std": { + "rvec_std_deg": [ + 0.7182152793178741, + 1.393767652798099, + 1.3961256444186971 + ], + "tvec_std_m": [ + 0.003774226388654892, + 0.00352355409448645, + 0.019081292313492957 + ] + }, + "camera_center_std_m": [ + 0.03068643829839299, + 0.02772854307784112, + 0.02576136304504991 + ], + "camera_center_std_mm": [ + 30.68643829839299, + 27.72854307784112, + 25.76136304504991 + ], + "orientation_std_deg": { + "roll": 0.8527509678295315, + "pitch": 1.3876188137550685, + "yaw": 0.4456641826828775 + } + } + }, + "observations": { + "markers": [ + { + "marker_id": 84, + "observed_center_px": [ + 65.25, + 662.0 + ], + "projected_center_px": [ + 67.64344787597656, + 638.7950439453125 + ], + "reprojection_error_px": 23.328064176759177, + "confidence": 0.3490767193505014 + }, + { + "marker_id": 64, + "observed_center_px": [ + 819.5, + 647.0 + ], + "projected_center_px": [ + 822.2017211914062, + 648.09375 + ], + "reprojection_error_px": 2.9147189330351573, + "confidence": 0.5331747682067169 + }, + { + "marker_id": 72, + "observed_center_px": [ + 102.25, + 581.0 + ], + "projected_center_px": [ + 101.0286865234375, + 567.763916015625 + ], + "reprojection_error_px": 13.29231077914828, + "confidence": 0.43254677700170213 + }, + { + "marker_id": 53, + "observed_center_px": [ + 52.0, + 559.0 + ], + "projected_center_px": [ + 55.246952056884766, + 547.0332641601562 + ], + "reprojection_error_px": 12.399413870030676, + "confidence": 0.27711751756945874 + }, + { + "marker_id": 58, + "observed_center_px": [ + 781.0, + 564.0 + ], + "projected_center_px": [ + 785.330322265625, + 565.1350708007812 + ], + "reprojection_error_px": 4.476614417945086, + "confidence": 0.48073279309443956 + }, + { + "marker_id": 69, + "observed_center_px": [ + 868.75, + 547.5 + ], + "projected_center_px": [ + 885.4929809570312, + 550.4025268554688 + ], + "reprojection_error_px": 16.99270647878755, + "confidence": 0.45515519100712953 + }, + { + "marker_id": 215, + "observed_center_px": [ + 504.75, + 495.25 + ], + "projected_center_px": [ + 484.1275939941406, + 500.800537109375 + ], + "reprojection_error_px": 21.35631268906348, + "confidence": 0.3775515964613595 + }, + { + "marker_id": 103, + "observed_center_px": [ + 708.0, + 543.5 + ], + "projected_center_px": [ + 706.70263671875, + 543.7702026367188 + ], + "reprojection_error_px": 1.3252022292561734, + "confidence": 0.47991555158957017 + }, + { + "marker_id": 56, + "observed_center_px": [ + 84.25, + 514.75 + ], + "projected_center_px": [ + 84.52336120605469, + 507.3511657714844 + ], + "reprojection_error_px": 7.403882379537784, + "confidence": 0.39662908657084783 + }, + { + "marker_id": 46, + "observed_center_px": [ + 41.5, + 498.0 + ], + "projected_center_px": [ + 45.149391174316406, + 491.8171081542969 + ], + "reprojection_error_px": 7.179568755770828, + "confidence": 0.1698001278724927 + }, + { + "marker_id": 68, + "observed_center_px": [ + 29.25, + 458.0 + ], + "projected_center_px": [ + 33.76746368408203, + 455.4254150390625 + ], + "reprojection_error_px": 5.199612087270121, + "confidence": 0.07718187630567852 + }, + { + "marker_id": 208, + "observed_center_px": [ + 424.5, + 417.75 + ], + "projected_center_px": [ + 404.8271179199219, + 424.88427734375 + ], + "reprojection_error_px": 20.926543014893873, + "confidence": 0.4316478958478293 + }, + { + "marker_id": 95, + "observed_center_px": [ + 710.75, + 415.25 + ], + "projected_center_px": [ + 717.5942993164062, + 415.47711181640625 + ], + "reprojection_error_px": 6.848066362829029, + "confidence": 0.4181682027393045 + }, + { + "marker_id": 55, + "observed_center_px": [ + 622.75, + 351.75 + ], + "projected_center_px": [ + 624.6567993164062, + 351.91876220703125 + ], + "reprojection_error_px": 1.914252939287126, + "confidence": 0.39668368657567366 + }, + { + "marker_id": 66, + "observed_center_px": [ + 761.5, + 332.5 + ], + "projected_center_px": [ + 779.4948120117188, + 330.6138916015625 + ], + "reprojection_error_px": 18.093387306630948, + "confidence": 0.3829765144945479 + }, + { + "marker_id": 217, + "observed_center_px": [ + 201.5, + 202.0 + ], + "projected_center_px": [ + 187.4725341796875, + 216.80555725097656 + ], + "reprojection_error_px": 20.395448581778734, + "confidence": 0.3382587531306593 + }, + { + "marker_id": 47, + "observed_center_px": [ + 594.25, + 292.0 + ], + "projected_center_px": [ + 596.9345703125, + 291.29638671875 + ], + "reprojection_error_px": 2.7752458291668036, + "confidence": 0.36403279165733554 + }, + { + "marker_id": 97, + "observed_center_px": [ + 682.75, + 268.75 + ], + "projected_center_px": [ + 695.365234375, + 265.5987243652344 + ], + "reprojection_error_px": 13.002871854419283, + "confidence": 0.3623898971459892 + }, + { + "marker_id": 54, + "observed_center_px": [ + 630.25, + 262.5 + ], + "projected_center_px": [ + 637.9163818359375, + 260.5142517089844 + ], + "reprojection_error_px": 7.919381713850135, + "confidence": 0.3590718541167963 + }, + { + "marker_id": 205, + "observed_center_px": [ + 133.0, + 135.0 + ], + "projected_center_px": [ + 121.14615631103516, + 153.30975341796875 + ], + "reprojection_error_px": 21.811938942451448, + "confidence": 0.29591817114314195 + }, + { + "marker_id": 92, + "observed_center_px": [ + 291.0, + 157.0 + ], + "projected_center_px": [ + 285.0270690917969, + 163.84591674804688 + ], + "reprojection_error_px": 9.085289194921476, + "confidence": 0.3158166687011719 + }, + { + "marker_id": 105, + "observed_center_px": [ + 442.5, + 182.75 + ], + "projected_center_px": [ + 439.7162170410156, + 184.19300842285156 + ], + "reprojection_error_px": 3.1355575056363354, + "confidence": 0.31800273344664126 + }, + { + "marker_id": 85, + "observed_center_px": [ + 494.0, + 166.0 + ], + "projected_center_px": [ + 494.85260009765625, + 164.6371307373047 + ], + "reprojection_error_px": 1.6075881169388855, + "confidence": 0.2969848480224609 + }, + { + "marker_id": 102, + "observed_center_px": [ + 318.5, + 130.0 + ], + "projected_center_px": [ + 313.7091064453125, + 134.91958618164062 + ], + "reprojection_error_px": 6.866949049682517, + "confidence": 0.3170967427530611 + }, + { + "marker_id": 59, + "observed_center_px": [ + 379.75, + 109.0 + ], + "projected_center_px": [ + 376.8421630859375, + 111.31359100341797 + ], + "reprojection_error_px": 3.715941179550759, + "confidence": 0.3170967427530611 + }, + { + "marker_id": 48, + "observed_center_px": [ + 369.5, + 44.25 + ], + "projected_center_px": [ + 367.8004455566406, + 44.72565841674805 + ], + "reprojection_error_px": 1.7648615343323264, + "confidence": 0.17828567290874034 + }, + { + "marker_id": 57, + "observed_center_px": [ + 463.0, + 70.5 + ], + "projected_center_px": [ + 465.4833679199219, + 66.98860931396484 + ], + "reprojection_error_px": 4.300811641501118, + "confidence": 0.3167426670523156 + }, + { + "marker_id": 63, + "observed_center_px": [ + 243.0, + 42.0 + ], + "projected_center_px": [ + 238.1956024169922, + 49.013179779052734 + ], + "reprojection_error_px": 8.5009956328024, + "confidence": 0.15449597168691093 + }, + { + "marker_id": 71, + "observed_center_px": [ + 299.25, + 29.5 + ], + "projected_center_px": [ + 295.6414489746094, + 33.31275177001953 + ], + "reprojection_error_px": 5.249639660265721, + "confidence": 0.08171792300897739 + } + ] + }, + "qa": { + "sanity_notes": [] + }, + "v8_z_correction_mm": 54.81633454946478 +} \ No newline at end of file diff --git a/data/evaluations/Scene9/v8/aruco_positions_initial.json b/data/evaluations/Scene9/v8/aruco_positions_initial.json new file mode 100644 index 0000000..d0384f6 --- /dev/null +++ b/data/evaluations/Scene9/v8/aruco_positions_initial.json @@ -0,0 +1,924 @@ +{ + "schema_version": "1.2", + "stage": "initial_triangulation", + "created_utc": "2026-06-01T17:39:38Z", + "summary": { + "num_cameras": 7, + "num_markers": 48, + "num_constraints": 163 + }, + "markers": [ + { + "marker_id": 41, + "position_m": [ + 0.16615727451861995, + -0.2569709369298692, + 0.5273902361525619 + ], + "position_mm": [ + 166.15727451861994, + -256.9709369298692, + 527.3902361525619 + ], + "link": "FingerA", + "normal": [ + 0.0, + -0.9375276894468237, + 0.34791066600565723 + ] + }, + { + "marker_id": 42, + "position_m": [ + 0.22320111288772435, + -0.03540687759999497, + 0.4838957992116264 + ], + "position_mm": [ + 223.20111288772435, + -35.406877599994964, + 483.8957992116264 + ], + "link": "FingerA", + "normal": [ + 0.8830215713766957, + -0.3090575499818435, + 0.3532086285506783 + ] + }, + { + "marker_id": 43, + "position_m": [ + 0.27347246065780045, + -0.03699468475307568, + 0.48519133860425057 + ], + "position_mm": [ + 273.47246065780047, + -36.99468475307568, + 485.1913386042506 + ], + "link": "FingerB", + "normal": [ + 0.4224220616915755, + 0.0, + 0.9063992507699015 + ] + }, + { + "marker_id": 46, + "position_m": [ + 0.53671, + 0.18544, + -0.0273 + ], + "position_mm": [ + 536.71, + 185.44, + -27.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 47, + "position_m": [ + 0.34423000000000004, + -0.28654, + -0.0273 + ], + "position_mm": [ + 344.23, + -286.54, + -27.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 51, + "position_m": [ + 0.1678, + -0.17208, + -0.0273 + ], + "position_mm": [ + 167.8, + -172.08, + -27.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 53, + "position_m": [ + 0.48625, + 0.21224, + -0.0273 + ], + "position_mm": [ + 486.25, + 212.24, + -27.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 54, + "position_m": [ + 0.34226999999999996, + -0.33059, + -0.0273 + ], + "position_mm": [ + 342.27, + -330.59, + -27.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 55, + "position_m": [ + 0.28372, + -0.26258, + -0.0273 + ], + "position_mm": [ + 283.72, + -262.58, + -27.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 56, + "position_m": [ + 0.49868, + 0.16867, + -0.0273 + ], + "position_mm": [ + 498.68, + 168.67, + -27.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 58, + "position_m": [ + 0.05009, + -0.21811000000000003, + -0.0273 + ], + "position_mm": [ + 50.09, + -218.11, + -27.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 60, + "position_m": [ + 0.43436, + 0.28381, + -0.0273 + ], + "position_mm": [ + 434.36, + 283.81, + -27.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 61, + "position_m": [ + -0.022420000000000002, + 0.33583, + -0.0273 + ], + "position_mm": [ + -22.42, + 335.83000000000004, + -27.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 62, + "position_m": [ + 0.4047, + -0.1751, + -0.0273 + ], + "position_mm": [ + 404.7, + -175.1, + -27.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 63, + "position_m": [ + 0.7774, + -0.23615, + -0.0273 + ], + "position_mm": [ + 777.4, + -236.15, + -27.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 64, + "position_m": [ + -0.02127, + -0.18822999999999998, + -0.0273 + ], + "position_mm": [ + -21.27, + -188.23, + -27.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 66, + "position_m": [ + 0.20975, + -0.36323000000000005, + -0.0273 + ], + "position_mm": [ + 209.75, + -363.2300000000001, + -27.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 68, + "position_m": [ + 0.5737300000000001, + 0.17064, + -0.0273 + ], + "position_mm": [ + 573.73, + 170.64, + -27.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 69, + "position_m": [ + 0.0076100000000000004, + -0.28120999999999996, + -0.0273 + ], + "position_mm": [ + 7.61, + -281.21, + -27.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 72, + "position_m": [ + 0.44099, + 0.19432, + -0.0273 + ], + "position_mm": [ + 440.99, + 194.32, + -27.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 75, + "position_m": [ + -0.0257, + 0.19458, + -0.0273 + ], + "position_mm": [ + -25.7, + 194.58, + -27.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 79, + "position_m": [ + 0.3123, + -0.15911000000000003, + -0.0273 + ], + "position_mm": [ + 312.3, + -159.11000000000004, + -27.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 83, + "position_m": [ + 0.04416, + 0.33922, + -0.0273 + ], + "position_mm": [ + 44.16, + 339.22, + -27.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 84, + "position_m": [ + 0.40749, + 0.25842000000000004, + -0.0273 + ], + "position_mm": [ + 407.49, + 258.42, + -27.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 85, + "position_m": [ + 0.50458, + -0.31275000000000003, + -0.0273 + ], + "position_mm": [ + 504.58000000000004, + -312.75, + -27.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 86, + "position_m": [ + 0.36289, + 0.29201, + -0.0273 + ], + "position_mm": [ + 362.89, + 292.01, + -27.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 92, + "position_m": [ + 0.64509, + -0.18484, + -0.0273 + ], + "position_mm": [ + 645.09, + -184.84, + -27.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 95, + "position_m": [ + 0.18603999999999998, + -0.27407, + -0.0273 + ], + "position_mm": [ + 186.04, + -274.07, + -27.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 96, + "position_m": [ + 0.36977, + -0.18649000000000002, + -0.0273 + ], + "position_mm": [ + 369.77, + -186.49, + -27.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 97, + "position_m": [ + 0.30435, + -0.35967000000000005, + -0.0273 + ], + "position_mm": [ + 304.35, + -359.6700000000001, + -27.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 102, + "position_m": [ + 0.6496900000000001, + -0.223, + -0.0273 + ], + "position_mm": [ + 649.69, + -223.0, + -27.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 103, + "position_m": [ + 0.10571, + -0.18771000000000002, + -0.0273 + ], + "position_mm": [ + 105.71, + -187.71, + -27.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 105, + "position_m": [ + 0.5248400000000001, + -0.26625, + -0.0273 + ], + "position_mm": [ + 524.84, + -266.25, + -27.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 113, + "position_m": [ + 0.2694708516578215, + -0.15011642419156548, + 0.34691969770643616 + ], + "position_mm": [ + 269.47085165782147, + -150.11642419156547, + 346.9196977064362 + ], + "link": "Arm2", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 124, + "position_m": [ + 0.29578800946767647, + -0.1209209714342455, + 0.3765147591842985 + ], + "position_mm": [ + 295.7880094676765, + -120.9209714342455, + 376.5147591842985 + ], + "link": "Arm2", + "normal": [ + -1.0, + 0.0, + 0.0 + ] + }, + { + "marker_id": 198, + "position_m": [ + 0.16478637412390795, + -0.10119446515296303, + 0.17947137223688692 + ], + "position_mm": [ + 164.78637412390796, + -101.19446515296303, + 179.4713722368869 + ], + "link": "Arm1", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 205, + "position_m": [ + 0.75, + -0.09, + 0.0003 + ], + "position_mm": [ + 750.0, + -90.0, + 0.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 206, + "position_m": [ + 0.65, + -0.01, + 0.0003 + ], + "position_mm": [ + 650.0, + -10.0, + 0.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 207, + "position_m": [ + 0.75, + -0.01, + 0.0003 + ], + "position_mm": [ + 750.0, + -10.0, + 0.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 208, + "position_m": [ + 0.35000000000000003, + -0.09, + 0.0003 + ], + "position_mm": [ + 350.00000000000006, + -90.0, + 0.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 210, + "position_m": [ + 0.02, + -0.02, + 0.0003 + ], + "position_mm": [ + 20.0, + -20.0, + 0.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 211, + "position_m": [ + 0.25, + -0.01, + 0.0003 + ], + "position_mm": [ + 250.0, + -10.0, + 0.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 214, + "position_m": [ + 0.35000000000000003, + -0.01, + 0.0003 + ], + "position_mm": [ + 350.00000000000006, + -10.0, + 0.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 217, + "position_m": [ + 0.65, + -0.09, + 0.0003 + ], + "position_mm": [ + 650.0, + -90.0, + 0.3 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 229, + "position_m": [ + 0.1737760166288558, + -0.17353002815715318, + 0.16586522788104938 + ], + "position_mm": [ + 173.7760166288558, + -173.53002815715317, + 165.86522788104938 + ], + "link": "Arm1", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 243, + "position_m": [ + 0.16999694264536128, + -0.17289188362654234, + 0.12239180756247413 + ], + "position_mm": [ + 169.9969426453613, + -172.89188362654235, + 122.39180756247413 + ], + "link": "Arm1", + "normal": [ + 0.0, + -1.0, + 0.0 + ] + }, + { + "marker_id": 244, + "position_m": [ + 0.29747044415204926, + -0.14422109269184957, + 0.12130647190634913 + ], + "position_mm": [ + 297.47044415204925, + -144.22109269184958, + 121.30647190634913 + ], + "link": "Ellbow", + "normal": [ + 1.0, + 0.0, + 0.0 + ] + }, + { + "marker_id": 245, + "position_m": [ + 0.2598978225932781, + -0.17314602406328936, + 0.12638420028984224 + ], + "position_mm": [ + 259.8978225932781, + -173.14602406328936, + 126.38420028984224 + ], + "link": "Ellbow", + "normal": [ + 0.0, + 0.0, + -1.0 + ] + } + ] +} \ No newline at end of file diff --git a/data/evaluations/Scene9/v8/aruco_positions_optimized.json b/data/evaluations/Scene9/v8/aruco_positions_optimized.json new file mode 100644 index 0000000..0b49f91 --- /dev/null +++ b/data/evaluations/Scene9/v8/aruco_positions_optimized.json @@ -0,0 +1,923 @@ +{ + "schema_version": "1.2", + "created_utc": "2026-06-01T17:39:45Z", + "summary": { + "num_cameras": 7, + "num_markers": 48, + "num_constraints": 163 + }, + "markers": [ + { + "marker_id": 41, + "position_m": [ + 0.15713392862090453, + -0.2416989061052508, + 0.5552827001989805 + ], + "position_mm": [ + 157.13392862090453, + -241.69890610525079, + 555.2827001989805 + ], + "link": "FingerA", + "normal": [ + 0.0, + -0.9375276894468237, + 0.34791066600565723 + ] + }, + { + "marker_id": 42, + "position_m": [ + 0.1479206585855855, + -0.19726420703716735, + 0.5690351925925898 + ], + "position_mm": [ + 147.9206585855855, + -197.26420703716735, + 569.0351925925899 + ], + "link": "FingerA", + "normal": [ + 0.8830215713766957, + -0.3090575499818435, + 0.3532086285506783 + ] + }, + { + "marker_id": 43, + "position_m": [ + 0.19954393633774076, + -0.17868114374099459, + 0.5441410607893239 + ], + "position_mm": [ + 199.54393633774075, + -178.6811437409946, + 544.1410607893239 + ], + "link": "FingerB", + "normal": [ + 0.4224220616915755, + 0.0, + 0.9063992507699015 + ] + }, + { + "marker_id": 46, + "position_m": [ + 0.5367100000929597, + 0.18544000008392653, + -0.027299999925764113 + ], + "position_mm": [ + 536.7100000929597, + 185.44000008392652, + -27.299999925764112 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 47, + "position_m": [ + 0.34423000004138743, + -0.28653999991663465, + -0.02729999984725271 + ], + "position_mm": [ + 344.2300000413874, + -286.53999991663466, + -27.29999984725271 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 51, + "position_m": [ + 0.16779999996393855, + -0.17207999996353737, + -0.027299999917780163 + ], + "position_mm": [ + 167.79999996393855, + -172.07999996353738, + -27.299999917780163 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 53, + "position_m": [ + 0.4862500000517348, + 0.21224000012342684, + -0.0272999998529145 + ], + "position_mm": [ + 486.2500000517348, + 212.24000012342682, + -27.2999998529145 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 54, + "position_m": [ + 0.3422700000437526, + -0.33058999996416577, + -0.027299999980765946 + ], + "position_mm": [ + 342.2700000437526, + -330.58999996416577, + -27.299999980765946 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 55, + "position_m": [ + 0.28371999999534064, + -0.2625799999426046, + -0.027299999890894776 + ], + "position_mm": [ + 283.71999999534063, + -262.5799999426046, + -27.299999890894778 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 56, + "position_m": [ + 0.49868000007035296, + 0.16867000005226573, + -0.027299999952448827 + ], + "position_mm": [ + 498.68000007035295, + 168.67000005226572, + -27.299999952448825 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 58, + "position_m": [ + 0.05008999994519926, + -0.21810999987817428, + -0.02729999984143486 + ], + "position_mm": [ + 50.08999994519926, + -218.10999987817428, + -27.29999984143486 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 60, + "position_m": [ + 0.4343599999899137, + 0.2838100000510186, + -0.02729999991307023 + ], + "position_mm": [ + 434.3599999899137, + 283.81000005101856, + -27.29999991307023 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 61, + "position_m": [ + -0.022419999971302798, + 0.3358300000719934, + -0.02729999993911315 + ], + "position_mm": [ + -22.419999971302797, + 335.83000007199337, + -27.29999993911315 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 62, + "position_m": [ + 0.4047000000289361, + -0.17509999991515432, + -0.027299999853498125 + ], + "position_mm": [ + 404.7000000289361, + -175.0999999151543, + -27.299999853498125 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 63, + "position_m": [ + 0.7774000000739654, + -0.2361500000173091, + -0.027299999964334062 + ], + "position_mm": [ + 777.4000000739653, + -236.1500000173091, + -27.299999964334063 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 64, + "position_m": [ + -0.02127000007871142, + -0.18822999986024366, + -0.027299999770135076 + ], + "position_mm": [ + -21.27000007871142, + -188.22999986024365, + -27.299999770135077 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 66, + "position_m": [ + 0.20975000000209715, + -0.363229999906965, + -0.027299999886950692 + ], + "position_mm": [ + 209.75000000209715, + -363.22999990696496, + -27.29999988695069 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 68, + "position_m": [ + 0.5737300000365086, + 0.17064000005345875, + -0.027299999959023245 + ], + "position_mm": [ + 573.7300000365086, + 170.64000005345875, + -27.299999959023246 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 69, + "position_m": [ + 0.00761000004242595, + -0.2812099999289154, + -0.02729999998318098 + ], + "position_mm": [ + 7.61000004242595, + -281.20999992891535, + -27.299999983180978 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 72, + "position_m": [ + 0.4409900000354066, + 0.19432000020221737, + -0.027299999713418663 + ], + "position_mm": [ + 440.99000003540664, + 194.3200002022174, + -27.299999713418664 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 75, + "position_m": [ + -0.02570000001322527, + 0.19458000011081336, + -0.027299999917136667 + ], + "position_mm": [ + -25.700000013225267, + 194.58000011081336, + -27.299999917136667 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 79, + "position_m": [ + 0.312300000016258, + -0.15910999989937752, + -0.027299999860245398 + ], + "position_mm": [ + 312.300000016258, + -159.10999989937753, + -27.299999860245396 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 83, + "position_m": [ + 0.044159999992374944, + 0.33922000010889536, + -0.027299999906729017 + ], + "position_mm": [ + 44.15999999237494, + 339.22000010889536, + -27.299999906729017 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 84, + "position_m": [ + 0.4074900000152712, + 0.25842000018675926, + -0.027299999735366415 + ], + "position_mm": [ + 407.49000001527116, + 258.42000018675924, + -27.299999735366416 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 85, + "position_m": [ + 0.5045800000185344, + -0.3127499999345801, + -0.027299999823630846 + ], + "position_mm": [ + 504.5800000185344, + -312.7499999345801, + -27.299999823630845 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 86, + "position_m": [ + 0.3628899999968834, + 0.2920100001214097, + -0.02729999977788188 + ], + "position_mm": [ + 362.8899999968834, + 292.0100001214097, + -27.29999977788188 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 92, + "position_m": [ + 0.6450900000418279, + -0.18483999992149241, + -0.027299999804719477 + ], + "position_mm": [ + 645.0900000418279, + -184.83999992149242, + -27.299999804719477 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 95, + "position_m": [ + 0.1860399999967906, + -0.27406999993259007, + -0.02729999989753723 + ], + "position_mm": [ + 186.0399999967906, + -274.06999993259006, + -27.29999989753723 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 96, + "position_m": [ + 0.36977000002277416, + -0.18648999991230544, + -0.02729999985668438 + ], + "position_mm": [ + 369.7700000227742, + -186.48999991230545, + -27.29999985668438 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 97, + "position_m": [ + 0.3043499999947372, + -0.35966999991822723, + -0.027299999877075903 + ], + "position_mm": [ + 304.34999999473723, + -359.66999991822723, + -27.299999877075905 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 102, + "position_m": [ + 0.6496900000995376, + -0.22299999998754086, + -0.02729999992976496 + ], + "position_mm": [ + 649.6900000995375, + -222.99999998754086, + -27.29999992976496 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 103, + "position_m": [ + 0.10570999992031617, + -0.18770999986209555, + -0.02729999976984459 + ], + "position_mm": [ + 105.70999992031616, + -187.70999986209554, + -27.29999976984459 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 105, + "position_m": [ + 0.5248400000183366, + -0.2662499999346213, + -0.027299999824223993 + ], + "position_mm": [ + 524.8400000183367, + -266.24999993462126, + -27.299999824223992 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 113, + "position_m": [ + 0.2804165953039367, + -0.19872244751640883, + 0.3505887458428963 + ], + "position_mm": [ + 280.4165953039367, + -198.72244751640883, + 350.5887458428963 + ], + "link": "Arm2", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 124, + "position_m": [ + 0.3179512440276115, + -0.23900721775693098, + 0.3721039418447169 + ], + "position_mm": [ + 317.9512440276115, + -239.00721775693097, + 372.1039418447169 + ], + "link": "Arm2", + "normal": [ + -1.0, + 0.0, + 0.0 + ] + }, + { + "marker_id": 198, + "position_m": [ + 0.1305694369342163, + -0.0738931537004449, + 0.19069456152916994 + ], + "position_mm": [ + 130.5694369342163, + -73.8931537004449, + 190.69456152916993 + ], + "link": "Arm1", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 205, + "position_m": [ + 0.7500000000651522, + -0.08999999999118834, + 0.00030000004390770064 + ], + "position_mm": [ + 750.0000000651522, + -89.99999999118833, + 0.30000004390770063 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 206, + "position_m": [ + 0.6500000000075417, + -0.009999999882410456, + 0.0003000001917369764 + ], + "position_mm": [ + 650.0000000075416, + -9.999999882410457, + 0.3000001917369764 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 207, + "position_m": [ + 0.7500000000486273, + -0.009999999939664835, + 0.00030000006839689885 + ], + "position_mm": [ + 750.0000000486273, + -9.999999939664834, + 0.30000006839689886 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 208, + "position_m": [ + 0.3499999999386543, + -0.08999999975261576, + 0.00030000042723117164 + ], + "position_mm": [ + 349.99999993865435, + -89.99999975261576, + 0.30000042723117165 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 210, + "position_m": [ + 0.019999999971557846, + -0.019999999802751654, + 0.00030000020400658975 + ], + "position_mm": [ + 19.999999971557845, + -19.999999802751653, + 0.3000002040065898 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 211, + "position_m": [ + 0.24999999993167737, + -0.009999999908451308, + 0.00030000022431341585 + ], + "position_mm": [ + 249.99999993167737, + -9.999999908451308, + 0.30000022431341583 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 214, + "position_m": [ + 0.34999999993241016, + -0.009999999774234655, + 0.00030000038849146895 + ], + "position_mm": [ + 349.99999993241016, + -9.999999774234654, + 0.30000038849146893 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 217, + "position_m": [ + 0.650000000043315, + -0.08999999989818294, + 0.000300000219976508 + ], + "position_mm": [ + 650.000000043315, + -89.99999989818293, + 0.300000219976508 + ], + "link": "Board", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 229, + "position_m": [ + 0.16640168506027175, + -0.15182653993183387, + 0.16344669721760172 + ], + "position_mm": [ + 166.40168506027175, + -151.82653993183388, + 163.44669721760172 + ], + "link": "Arm1", + "normal": [ + 0.0, + 0.0, + 1.0 + ] + }, + { + "marker_id": 243, + "position_m": [ + 0.1684798904699227, + -0.17155983163860805, + 0.11809996732683645 + ], + "position_mm": [ + 168.4798904699227, + -171.55983163860805, + 118.09996732683645 + ], + "link": "Arm1", + "normal": [ + 0.0, + -1.0, + 0.0 + ] + }, + { + "marker_id": 244, + "position_m": [ + 0.25553896045148, + -0.02006453590532172, + 0.06102532438145439 + ], + "position_mm": [ + 255.53896045148, + -20.06453590532172, + 61.02532438145439 + ], + "link": "Ellbow", + "normal": [ + 1.0, + 0.0, + 0.0 + ] + }, + { + "marker_id": 245, + "position_m": [ + 0.2406129407047614, + -0.06726361904699338, + 0.060863852611482507 + ], + "position_mm": [ + 240.6129407047614, + -67.26361904699338, + 60.86385261148251 + ], + "link": "Ellbow", + "normal": [ + 0.0, + 0.0, + -1.0 + ] + } + ] +} \ No newline at end of file diff --git a/data/evaluations/Scene9/v8/robot_state_v8.json b/data/evaluations/Scene9/v8/robot_state_v8.json new file mode 100644 index 0000000..c78d134 --- /dev/null +++ b/data/evaluations/Scene9/v8/robot_state_v8.json @@ -0,0 +1,4785 @@ +{ + "schema_version": "1.0", + "method": "deterministic_geometric_sequential_prefix", + "created_utc": "2026-06-01T17:39:45Z", + "root_pose": { + "translation_m": [ + 1.4877377108035716e-11, + 1.1336950128670864e-10, + 1.5748348805577628e-10 + ], + "rotation_matrix": [ + [ + 0.9999999999999994, + 5.149932722752071e-11, + 2.498400176726485e-11 + ], + [ + -5.149936365031433e-11, + 0.9999999999999992, + -2.008679784119613e-11 + ], + [ + -2.498400728867953e-11, + 2.0086907675339685e-11, + 1.0000000000000002 + ] + ], + "euler_xyz_deg": [ + 1.1508950332659035e-09, + 1.4314781729654247e-09, + -2.950696184772458e-09 + ] + }, + "movements": { + "x": { + "value_m": 0.06270235665096582, + "value_mm": 62.702356650965825, + "joint_type": "linear", + "link": "Base" + }, + "y": { + "value_rad": -0.2287079652555155, + "value_deg": -13.10400115016571, + "joint_type": "revolute", + "link": "Arm1" + }, + "z": { + "value_rad": 1.5266209153694081, + "value_deg": 87.46893536706551, + "joint_type": "revolute", + "link": "Ellbow" + }, + "a": { + "value_rad": 0.4456159985371926, + "value_deg": 25.531915999689, + "joint_type": "revolute", + "link": "Arm2" + }, + "b": { + "value_rad": 0.0, + "value_deg": 0.0, + "joint_type": "revolute", + "link": "Hand" + }, + "c": { + "value_rad": 0.0, + "value_deg": 0.0, + "joint_type": "revolute", + "link": "Palm" + }, + "e": { + "value_m": 0.0, + "value_mm": 0.0, + "joint_type": "linear", + "link": "FingerB" + } + }, + "link_poses": { + "Board": { + "translation_m": [ + 1.4877377108035716e-11, + 1.1336950128670864e-10, + 1.5748348805577628e-10 + ], + "rotation_matrix": [ + [ + 0.9999999999999994, + 5.149932722752071e-11, + 2.498400176726485e-11 + ], + [ + -5.149936365031433e-11, + 0.9999999999999992, + -2.008679784119613e-11 + ], + [ + -2.498400728867953e-11, + 2.0086907675339685e-11, + 1.0000000000000002 + ] + ] + }, + "Base": { + "translation_m": [ + 0.06270235666618021, + 1.0981898105435294e-10, + 0.016000000155916936 + ], + "rotation_matrix": [ + [ + 0.9999999999999994, + 5.149932722752071e-11, + 2.498400176726485e-11 + ], + [ + -5.149936365031433e-11, + 0.9999999999999992, + -2.008679784119613e-11 + ], + [ + -2.498400728867953e-11, + 2.0086907675339685e-11, + 1.0000000000000002 + ] + ] + }, + "Arm1": { + "translation_m": [ + 0.17270235667286638, + 0.10800000010325007, + 0.06100000015533809 + ], + "rotation_matrix": [ + [ + 0.9999999999999474, + 5.582264776863633e-11, + 1.2657529193818764e-11 + ], + [ + -5.149936365031165e-11, + 0.9739601371035105, + -0.2267193228051082 + ], + [ + -2.4984007288678227e-11, + 0.22671932280510854, + 0.9739601371035114 + ] + ] + }, + "Ellbow": { + "translation_m": [ + 0.1727023566589107, + -0.13549003417262756, + 0.004320169454060954 + ], + "rotation_matrix": [ + [ + 0.9999999999980358, + -1.0179994365889807e-11, + 5.6327158315483346e-11 + ], + [ + -5.14993636502132e-11, + 0.26950923860226234, + 0.9629978038946551 + ], + [ + -2.4984007288630467e-11, + -0.962997803894656, + 0.2695092386022627 + ] + ] + }, + "Arm2": { + "translation_m": [ + 0.2627023566587339, + -0.1354900341772625, + 0.0043201694518123935 + ], + "rotation_matrix": [ + [ + 0.902345332761121, + -1.0179994365887819e-11, + -0.4310138053936577 + ], + [ + 0.41506534804566153, + 0.2695092386022097, + 0.8689565738040755 + ], + [ + 0.11616220251009071, + -0.9629978038944679, + 0.24319040359345817 + ] + ] + }, + "Hand": { + "translation_m": [ + 0.26270235666127895, + -0.2028673438278149, + 0.24506962042542937 + ], + "rotation_matrix": [ + [ + 0.902345332761121, + -1.0179994365887819e-11, + -0.4310138053936577 + ], + [ + 0.41506534804566153, + 0.2695092386022097, + 0.8689565738040755 + ], + [ + 0.11616220251009071, + -0.9629978038944679, + 0.24319040359345817 + ] + ] + }, + "Palm": { + "translation_m": [ + 0.26270235666127895, + -0.2028673438278149, + 0.24506962042542937 + ], + "rotation_matrix": [ + [ + 0.902345332761121, + -1.0179994365887819e-11, + -0.4310138053936577 + ], + [ + 0.41506534804566153, + 0.2695092386022097, + 0.8689565738040755 + ], + [ + 0.11616220251009071, + -0.9629978038944679, + 0.24319040359345817 + ] + ] + }, + "FingerA": { + "translation_m": [ + 0.2663117379926797, + -0.2106399057867096, + 0.27923919237177613 + ], + "rotation_matrix": [ + [ + 0.902345332761121, + -1.0179994365887819e-11, + -0.4310138053936577 + ], + [ + 0.41506534804566153, + 0.2695092386022097, + 0.8689565738040755 + ], + [ + 0.11616220251009071, + -0.9629978038944679, + 0.24319040359345817 + ] + ] + }, + "FingerB": { + "translation_m": [ + 0.2590929753305908, + -0.2139604285710749, + 0.2783098947516954 + ], + "rotation_matrix": [ + [ + 0.902345332761121, + -1.0179994365887819e-11, + -0.4310138053936577 + ], + [ + 0.41506534804566153, + 0.2695092386022097, + 0.8689565738040755 + ], + [ + 0.11616220251009071, + -0.9629978038944679, + 0.24319040359345817 + ] + ] + } + }, + "stage_reports": [ + { + "method": "deterministic_geometric_prefix", + "active_links": [ + "Board", + "Base", + "Arm1" + ], + "active_observations": 41, + "joint_updates": [ + { + "pass": 0, + "updates": [ + { + "link": "Base", + "joint_variable": "x", + "joint_type": "linear", + "old": 0.0, + "new": 0.0451503374761015, + "info": { + "reason": "weighted_projection", + "used_markers": 3, + "axis_world": [ + 0.999999999999, + -5.149936365026286e-11, + -2.498400728865456e-11 + ], + "per_marker": [ + { + "marker_id": 198, + "q_i": 0.020569436918359538, + "weight": 1.0 + }, + { + "marker_id": 229, + "q_i": 0.05640168504907343, + "weight": 1.0 + }, + { + "marker_id": 243, + "q_i": 0.05847989046087151, + "weight": 1.0 + } + ] + } + }, + { + "link": "Arm1", + "joint_variable": "y", + "joint_type": "revolute", + "old": 0.0, + "new": -0.2538156107860967, + "info": { + "reason": "2d_alignment+normal_tiebreak", + "used_markers": 3, + "axis_world": [ + -0.999999999999, + 5.149936365026286e-11, + 2.498400728865456e-11 + ], + "axis_id": 0, + "theta_rad": -0.25381561078609666, + "theta_alt_rad": 2.8877770428036964, + "score_theta": 0.05683912935603255, + "score_theta_alt": 0.9071779737412696, + "best_score": 0.05683912935603255, + "per_marker": [ + { + "marker_id": 198, + "weight": 1.0 + }, + { + "marker_id": 229, + "weight": 1.0 + }, + { + "marker_id": 243, + "weight": 1.0 + } + ] + } + } + ] + }, + { + "pass": 1, + "updates": [ + { + "link": "Base", + "joint_variable": "x", + "joint_type": "linear", + "old": 0.0451503374761015, + "new": 0.0451503374761015, + "info": { + "reason": "weighted_projection", + "used_markers": 3, + "axis_world": [ + 0.999999999999, + -5.149936365026286e-11, + -2.498400728865456e-11 + ], + "per_marker": [ + { + "marker_id": 198, + "q_i": 0.020569436918359534, + "weight": 1.0 + }, + { + "marker_id": 229, + "q_i": 0.05640168504907344, + "weight": 1.0 + }, + { + "marker_id": 243, + "q_i": 0.05847989046087151, + "weight": 1.0 + } + ] + } + }, + { + "link": "Arm1", + "joint_variable": "y", + "joint_type": "revolute", + "old": -0.2538156107860967, + "new": -0.2538156107860967, + "info": { + "reason": "2d_alignment+normal_tiebreak", + "used_markers": 3, + "axis_world": [ + -0.999999999999, + 5.149936365026286e-11, + 2.498400728865456e-11 + ], + "axis_id": 0, + "theta_rad": -0.25381561078609666, + "theta_alt_rad": 2.8877770428036964, + "score_theta": 0.05683912935603255, + "score_theta_alt": 0.9071779737412696, + "best_score": 0.05683912935603255, + "per_marker": [ + { + "marker_id": 198, + "weight": 1.0 + }, + { + "marker_id": 229, + "weight": 1.0 + }, + { + "marker_id": 243, + "weight": 1.0 + } + ] + } + } + ] + } + ], + "root_link": "Board", + "root_pose": { + "reason": "kabsch", + "used_markers": [ + 210, + 211, + 214, + 208, + 206, + 205, + 207, + 217, + 46, + 47, + 51, + 53, + 54, + 55, + 56, + 58, + 60, + 61, + 62, + 63, + 64, + 66, + 68, + 69, + 72, + 75, + 79, + 83, + 84, + 85, + 86, + 92, + 95, + 96, + 97, + 102, + 103, + 105 + ] + }, + "marker_stats": { + "num_markers_used": 41, + "mean_error_m": 0.009778811887384822, + "rms_error_m": 0.03616873286539232, + "median_error_m": 1.0103337431238005e-10, + "worst_error_m": 0.139392783964287 + }, + "marker_reports": [ + { + "marker_id": 46, + "link": "Board", + "error_m": [ + -6.921452300190367e-11, + 2.350980521370616e-12, + 7.356334291719335e-11 + ], + "error_norm_m": 1.0103337431238005e-10, + "predicted_m": [ + 0.5367100000237451, + 0.1854400000862775, + -0.02729999985220077 + ], + "observed_m": [ + 0.5367100000929597, + 0.18544000008392653, + -0.027299999925764113 + ] + }, + { + "marker_id": 47, + "link": "Board", + "error_m": [ + -4.194888880704184e-11, + 1.2825074335864883e-11, + -9.619756380363498e-12 + ], + "error_norm_m": 4.490803398818038e-11, + "predicted_m": [ + 0.34422999999943854, + -0.2865399999038096, + -0.027299999856872467 + ], + "observed_m": [ + 0.34423000004138743, + -0.28653999991663465, + -0.02729999984725271 + ] + }, + { + "marker_id": 51, + "link": "Board", + "error_m": [ + 4.139469322872458e-11, + 6.881378800116522e-11, + 6.761477142069872e-11 + ], + "error_norm_m": 1.0497911868958923e-10, + "predicted_m": [ + 0.16780000000533324, + -0.17207999989472358, + -0.02729999985016539 + ], + "observed_m": [ + 0.16779999996393855, + -0.17207999996353737, + -0.027299999917780163 + ] + }, + { + "marker_id": 53, + "link": "Board", + "error_m": [ + -2.6609547898459596e-11, + -3.455066788227157e-11, + 2.512753893846309e-12 + ], + "error_norm_m": 4.3682154509621976e-11, + "predicted_m": [ + 0.48625000002512525, + 0.21224000008887617, + -0.027299999850401747 + ], + "observed_m": [ + 0.4862500000517348, + 0.21224000012342684, + -0.0272999998529145 + ] + }, + { + "marker_id": 54, + "link": "Board", + "error_m": [ + -4.6582626644919856e-11, + 6.04571948059629e-11, + 1.2305761618036648e-10 + ], + "error_norm_m": 1.4480397235207513e-10, + "predicted_m": [ + 0.34226999999716995, + -0.3305899999037086, + -0.02729999985770833 + ], + "observed_m": [ + 0.3422700000437526, + -0.33058999996416577, + -0.027299999980765946 + ] + }, + { + "marker_id": 55, + "link": "Board", + "error_m": [ + 5.331846075762314e-12, + 4.191130775765828e-11, + 3.601537471031868e-11 + ], + "error_norm_m": 5.551660576852147e-11, + "predicted_m": [ + 0.2837200000006725, + -0.2625799999006933, + -0.027299999854879402 + ], + "observed_m": [ + 0.28371999999534064, + -0.2625799999426046, + -0.027299999890894776 + ] + }, + { + "marker_id": 56, + "link": "Board", + "error_m": [ + -4.747152670958599e-11, + 3.597028230828414e-11, + 1.0086134011322301e-10 + ], + "error_norm_m": 1.1713418368227034e-10, + "predicted_m": [ + 0.49868000002288143, + 0.16867000008823602, + -0.027299999851587486 + ], + "observed_m": [ + 0.49868000007035296, + 0.16867000005226573, + -0.027299999952448827 + ] + }, + { + "marker_id": 58, + "link": "Board", + "error_m": [ + 5.776350925357221e-11, + -1.0487305468487307e-11, + -6.714264561002992e-12 + ], + "error_norm_m": 5.909050622453684e-11, + "predicted_m": [ + 0.05009000000296277, + -0.2181099998886616, + -0.027299999848149126 + ], + "observed_m": [ + 0.05008999994519926, + -0.21810999987817428, + -0.02729999984143486 + ] + }, + { + "marker_id": 60, + "link": "Board", + "error_m": [ + 3.88974408238596e-11, + 4.0529801736965965e-11, + 6.540252367459587e-11 + ], + "error_norm_m": 8.621580965512939e-11, + "predicted_m": [ + 0.43436000002881114, + 0.2838100000915484, + -0.027299999847667705 + ], + "observed_m": [ + 0.4343599999899137, + 0.2838100000510186, + -0.02729999991307023 + ] + }, + { + "marker_id": 61, + "link": "Board", + "error_m": [ + 2.7931441881623442e-12, + 4.307881829035409e-11, + 1.0390255669734394e-10 + ], + "error_norm_m": 1.1251367707080763e-10, + "predicted_m": [ + -0.022419999968509654, + 0.3358300001150722, + -0.027299999835210594 + ], + "observed_m": [ + -0.022419999971302798, + 0.3358300000719934, + -0.02729999993911315 + ] + }, + { + "marker_id": 62, + "link": "Board", + "error_m": [ + -2.3758495171222194e-11, + 8.230527370756135e-12, + -2.646639851722199e-12 + ], + "error_norm_m": 2.528264970501467e-11, + "predicted_m": [ + 0.4047000000051776, + -0.1750999999069238, + -0.027299999856144765 + ], + "observed_m": [ + 0.4047000000289361, + -0.17509999991515432, + -0.027299999853498125 + ] + }, + { + "marker_id": 63, + "link": "Board", + "error_m": [ + -7.193201589927867e-11, + 9.119155430781234e-11, + 9.76514528960859e-11 + ], + "error_norm_m": 1.5174294296976465e-10, + "predicted_m": [ + 0.7774000000020334, + -0.23614999992611754, + -0.02729999986668261 + ], + "observed_m": [ + 0.7774000000739654, + -0.2361500000173091, + -0.027299999964334062 + ] + }, + { + "marker_id": 64, + "link": "Board", + "error_m": [ + 8.32130267469644e-11, + -2.4742902171581704e-11, + -7.563099452267963e-11 + ], + "error_norm_m": 1.1513759751164288e-10, + "predicted_m": [ + -0.021269999995498393, + -0.18822999988498657, + -0.02729999984576607 + ], + "observed_m": [ + -0.02127000007871142, + -0.18822999986024366, + -0.027299999770135076 + ] + }, + { + "marker_id": 66, + "link": "Board", + "error_m": [ + -6.608047442568932e-12, + 1.0081047108201346e-11, + 3.1897609553688255e-11 + ], + "error_norm_m": 3.409913924193044e-11, + "predicted_m": [ + 0.2097499999954891, + -0.3632299998968839, + -0.027299999855053082 + ], + "observed_m": [ + 0.20975000000209715, + -0.363229999906965, + -0.027299999886950692 + ] + }, + { + "marker_id": 68, + "link": "Board", + "error_m": [ + -1.352573608670582e-11, + 3.0912244985970005e-11, + 1.0560027852157816e-10 + ], + "error_norm_m": 1.1085996234256408e-10, + "predicted_m": [ + 0.5737300000229829, + 0.170640000084371, + -0.027299999853422966 + ], + "observed_m": [ + 0.5737300000365086, + 0.17064000005345875, + -0.027299999959023245 + ] + }, + { + "marker_id": 69, + "link": "Board", + "error_m": [ + -4.271276561607085e-11, + 4.2441605785370484e-11, + 1.3482569227729613e-10 + ], + "error_norm_m": 1.476605483745281e-10, + "predicted_m": [ + 0.007609999999713185, + -0.28120999988647377, + -0.027299999848355287 + ], + "observed_m": [ + 0.00761000004242595, + -0.2812099999289154, + -0.02729999998318098 + ] + }, + { + "marker_id": 72, + "link": "Board", + "error_m": [ + -1.1204204231063386e-11, + -1.1101033980942532e-10, + -1.3621226715998525e-10 + ], + "error_norm_m": 1.760755845139202e-10, + "predicted_m": [ + 0.4409900000242024, + 0.19432000009120703, + -0.02729999984963093 + ], + "observed_m": [ + 0.4409900000354066, + 0.19432000020221737, + -0.027299999713418663 + ] + }, + { + "marker_id": 75, + "link": "Board", + "error_m": [ + 3.744133475480638e-11, + 4.427902489112512e-12, + 7.917074634766763e-11 + ], + "error_norm_m": 8.768960568916528e-11, + "predicted_m": [ + -0.025699999975783934, + 0.19458000011524126, + -0.02729999983796592 + ], + "observed_m": [ + -0.02570000001322527, + 0.19458000011081336, + -0.027299999917136667 + ] + }, + { + "marker_id": 79, + "link": "Board", + "error_m": [ + -1.0256906435301971e-11, + -2.787770014833768e-12, + 6.730345447625297e-12 + ], + "error_norm_m": 1.2580673317534154e-11, + "predicted_m": [ + 0.3123000000060011, + -0.1591099999021653, + -0.027299999853515052 + ], + "observed_m": [ + 0.312300000016258, + -0.15910999989937752, + -0.027299999860245398 + ] + }, + { + "marker_id": 83, + "link": "Board", + "error_m": [ + 3.928993935753411e-11, + 2.7480240305521875e-12, + 6.992308121400725e-11 + ], + "error_norm_m": 8.025265264931655e-11, + "predicted_m": [ + 0.044160000031664884, + 0.3392200001116434, + -0.027299999836805935 + ], + "observed_m": [ + 0.044159999992374944, + 0.33922000010889536, + -0.027299999906729017 + ] + }, + { + "marker_id": 84, + "link": "Board", + "error_m": [ + 1.2232381774168744e-11, + -9.382705723481877e-11, + -1.1213998132864056e-10 + ], + "error_norm_m": 1.467260142088063e-10, + "predicted_m": [ + 0.4074900000275036, + 0.2584200000929322, + -0.027299999847506397 + ], + "observed_m": [ + 0.4074900000152712, + 0.25842000018675926, + -0.027299999735366415 + ] + }, + { + "marker_id": 85, + "link": "Board", + "error_m": [ + -2.044575619919442e-11, + 2.2512602892987843e-11, + -3.777428370099756e-11 + ], + "error_norm_m": 4.849477028193567e-11, + "predicted_m": [ + 0.5045799999980887, + -0.3127499999120675, + -0.02729999986140513 + ], + "observed_m": [ + 0.5045800000185344, + -0.3127499999345801, + -0.027299999823630846 + ] + }, + { + "marker_id": 86, + "link": "Board", + "error_m": [ + 3.23500115584352e-11, + -2.6180668744046898e-11, + -6.783550804412286e-11 + ], + "error_norm_m": 7.958396079186222e-11, + "predicted_m": [ + 0.3628900000292334, + 0.29201000009522904, + -0.027299999845717387 + ], + "observed_m": [ + 0.3628899999968834, + 0.2920100001214097, + -0.02729999977788188 + ] + }, + { + "marker_id": 92, + "link": "Board", + "error_m": [ + -3.7151948184543926e-11, + 2.1886936707460336e-12, + -5.762684079924085e-11 + ], + "error_norm_m": 6.859963858791422e-11, + "predicted_m": [ + 0.645090000004676, + -0.18483999991930372, + -0.027299999862346318 + ], + "observed_m": [ + 0.6450900000418279, + -0.18483999992149241, + -0.027299999804719477 + ] + }, + { + "marker_id": 95, + "link": "Board", + "error_m": [ + 3.2901459334766514e-12, + 3.6927239044359794e-11, + 4.4867467380305115e-11 + ], + "error_norm_m": 5.820254008911988e-11, + "predicted_m": [ + 0.18604000000008075, + -0.27406999989566283, + -0.027299999852669763 + ], + "observed_m": [ + 0.1860399999967906, + -0.27406999993259007, + -0.02729999989753723 + ] + }, + { + "marker_id": 96, + "link": "Board", + "error_m": [ + -1.8183177186159583e-11, + 7.180533945216894e-12, + 1.1835185609321286e-12 + ], + "error_norm_m": 1.9585421019364308e-11, + "predicted_m": [ + 0.369770000004591, + -0.1864899999051249, + -0.027299999855500863 + ], + "observed_m": [ + 0.36977000002277416, + -0.18648999991230544, + -0.02729999985668438 + ] + }, + { + "marker_id": 97, + "link": "Board", + "error_m": [ + 9.351963647930006e-13, + 1.6471490837943747e-11, + 1.973084196027486e-11 + ], + "error_norm_m": 2.5719462030270577e-11, + "predicted_m": [ + 0.3043499999956724, + -0.35966999990175574, + -0.02729999985734506 + ], + "observed_m": [ + 0.3043499999947372, + -0.35966999991822723, + -0.027299999877075903 + ] + }, + { + "marker_id": 102, + "link": "Board", + "error_m": [ + -9.682676882505348e-11, + 6.800027207987114e-11, + 6.65371993613384e-11 + ], + "error_norm_m": 1.3574483070410947e-10, + "predicted_m": [ + 0.6496900000027108, + -0.2229999999195406, + -0.027299999863227762 + ], + "observed_m": [ + 0.6496900000995376, + -0.22299999998754086, + -0.02729999992976496 + ] + }, + { + "marker_id": 103, + "link": "Board", + "error_m": [ + 8.42121511412941e-11, + -2.9430458070578425e-11, + -7.908350710406076e-11 + ], + "error_norm_m": 1.192142581991192e-10, + "predicted_m": [ + 0.10571000000452832, + -0.187709999891526, + -0.027299999848928096 + ], + "observed_m": [ + 0.10570999992031617, + -0.18770999986209555, + -0.02729999976984459 + ] + }, + { + "marker_id": 105, + "link": "Board", + "error_m": [ + -1.7853163392089755e-11, + 2.1510460079809945e-11, + -3.6753270565847984e-11 + ], + "error_norm_m": 4.617616520713017e-11, + "predicted_m": [ + 0.5248400000004835, + -0.2662499999131108, + -0.027299999860977264 + ], + "observed_m": [ + 0.5248400000183366, + -0.2662499999346213, + -0.027299999824223993 + ] + }, + { + "marker_id": 198, + "link": "Arm1", + "error_m": [ + 0.024580900555217472, + 0.018230864050100173, + -0.13599177602044787 + ], + "error_norm_m": 0.139392783964287, + "predicted_m": [ + 0.15515033748943377, + -0.055662289650344726, + 0.054702785508722075 + ], + "observed_m": [ + 0.1305694369342163, + -0.0738931537004449, + 0.19069456152916994 + ] + }, + { + "marker_id": 205, + "link": "Board", + "error_m": [ + -5.490263799146078e-11, + 6.59273607928057e-11, + 9.302996030859448e-11 + ], + "error_norm_m": 1.2655153130067147e-10, + "predicted_m": [ + 0.7500000000102496, + -0.08999999992526098, + 0.00030000013693766095 + ], + "observed_m": [ + 0.7500000000651522, + -0.08999999999118834, + 0.00030000004390770064 + ] + }, + { + "marker_id": 206, + "link": "Board", + "error_m": [ + 6.827982623747175e-12, + -3.7700648158889294e-11, + -5.069396210319668e-11 + ], + "error_norm_m": 6.354398486112511e-11, + "predicted_m": [ + 0.6500000000143696, + -0.009999999920111104, + 0.0003000001410430143 + ], + "observed_m": [ + 0.6500000000075417, + -0.009999999882410456, + 0.0003000001917369764 + ] + }, + { + "marker_id": 207, + "link": "Board", + "error_m": [ + -3.425781880395107e-11, + 1.4403794129647096e-11, + 7.014771473108986e-11 + ], + "error_norm_m": 7.938368419598551e-11, + "predicted_m": [ + 0.7500000000143695, + -0.00999999992526104, + 0.0003000001385446136 + ], + "observed_m": [ + 0.7500000000486273, + -0.009999999939664835, + 0.00030000006839689885 + ] + }, + { + "marker_id": 208, + "link": "Board", + "error_m": [ + 7.159539627821232e-11, + -1.5204547343383723e-10, + -2.8029990779615196e-10 + ], + "error_norm_m": 3.268206925371851e-10, + "predicted_m": [ + 0.3500000000102497, + -0.08999999990466123, + 0.00030000014693126384 + ], + "observed_m": [ + 0.3499999999386543, + -0.08999999975261576, + 0.00030000042723117164 + ] + }, + { + "marker_id": 210, + "link": "Board", + "error_m": [ + 4.2297030461435625e-11, + -8.491484598804888e-11, + -4.74245199859856e-11 + ], + "error_norm_m": 1.0605967636633078e-10, + "predicted_m": [ + 0.020000000013854876, + -0.0199999998876665, + 0.00030000015658206977 + ], + "observed_m": [ + 0.019999999971557846, + -0.019999999802751654, + 0.00030000020400658975 + ] + }, + { + "marker_id": 211, + "link": "Board", + "error_m": [ + 8.269240847624815e-11, + 8.939949475150755e-12, + -7.327679863713618e-11 + ], + "error_norm_m": 1.1084875432195134e-10, + "predicted_m": [ + 0.2500000000143698, + -0.009999999899511358, + 0.0003000001510366172 + ], + "observed_m": [ + 0.24999999993167737, + -0.009999999908451308, + 0.00030000022431341585 + ] + }, + { + "marker_id": 214, + "link": "Board", + "error_m": [ + 8.195955025769308e-11, + -1.3042663997431259e-10, + -2.399532524717182e-10 + ], + "error_norm_m": 2.851421394062765e-10, + "predicted_m": [ + 0.3500000000143697, + -0.009999999904661295, + 0.0003000001485382165 + ], + "observed_m": [ + 0.34999999993241016, + -0.009999999774234655, + 0.00030000038849146895 + ] + }, + { + "marker_id": 217, + "link": "Board", + "error_m": [ + -3.306532825320119e-11, + -2.1928098226098314e-11, + -8.054044632827342e-11 + ], + "error_norm_m": 8.97826314999892e-11, + "predicted_m": [ + 0.6500000000102497, + -0.08999999992011104, + 0.0003000001394360617 + ], + "observed_m": [ + 0.650000000043315, + -0.08999999989818294, + 0.000300000219976508 + ] + }, + { + "marker_id": 229, + "link": "Arm1", + "error_m": [ + -0.011251347575889026, + 0.00904772665328557, + -0.13134283449151735 + ], + "error_norm_m": 0.1321340014989789, + "predicted_m": [ + 0.15515033748438273, + -0.1427788132785483, + 0.032103862726084356 + ], + "observed_m": [ + 0.16640168506027175, + -0.15182653993183387, + 0.16344669721760172 + ] + }, + { + "marker_id": 243, + "link": "Arm1", + "error_m": [ + -0.013329552987898119, + 0.0036908402534508444, + -0.12866322264941263 + ], + "error_norm_m": 0.12940449817207283, + "predicted_m": [ + 0.1551503374820246, + -0.1678689913851572, + -0.010563255322576182 + ], + "observed_m": [ + 0.1684798904699227, + -0.17155983163860805, + 0.11809996732683645 + ] + } + ], + "stage_idx": 0, + "num_active_links": 3 + }, + { + "method": "deterministic_geometric_prefix", + "active_links": [ + "Board", + "Base", + "Arm1", + "Ellbow" + ], + "active_observations": 43, + "joint_updates": [ + { + "pass": 0, + "updates": [ + { + "link": "Base", + "joint_variable": "x", + "joint_type": "linear", + "old": 0.0451503374761015, + "new": 0.03932058271123921, + "info": { + "reason": "weighted_projection", + "used_markers": 5, + "axis_world": [ + 0.999999999999, + -5.149936365026286e-11, + -2.498400728865456e-11 + ], + "per_marker": [ + { + "marker_id": 198, + "q_i": 0.020569436918359534, + "weight": 1.0 + }, + { + "marker_id": 229, + "q_i": 0.05640168504907344, + "weight": 1.0 + }, + { + "marker_id": 243, + "q_i": 0.05847989046087151, + "weight": 1.0 + }, + { + "marker_id": 244, + "q_i": 0.020538960436098878, + "weight": 1.0 + }, + { + "marker_id": 245, + "q_i": 0.0406129406917927, + "weight": 1.0 + } + ] + } + }, + { + "link": "Arm1", + "joint_variable": "y", + "joint_type": "revolute", + "old": -0.2538156107860967, + "new": -0.20389236799324362, + "info": { + "reason": "2d_alignment+normal_tiebreak", + "used_markers": 5, + "axis_world": [ + -0.999999999999, + 5.149936365026286e-11, + 2.498400728865456e-11 + ], + "axis_id": 0, + "theta_rad": -0.20389236799324342, + "theta_alt_rad": 2.9377002855965495, + "score_theta": 0.07474104815568895, + "score_theta_alt": 1.2368745717459415, + "best_score": 0.07474104815568895, + "per_marker": [ + { + "marker_id": 198, + "weight": 1.0 + }, + { + "marker_id": 229, + "weight": 1.0 + }, + { + "marker_id": 243, + "weight": 1.0 + }, + { + "marker_id": 244, + "weight": 1.0 + }, + { + "marker_id": 245, + "weight": 1.0 + } + ] + } + }, + { + "link": "Ellbow", + "joint_variable": "z", + "joint_type": "revolute", + "old": 0.0, + "new": -1.1468618192585254, + "info": { + "reason": "2d_alignment+normal_tiebreak", + "used_markers": 1, + "axis_world": [ + -0.999999999999, + 5.149936365026286e-11, + 2.498400728865456e-11 + ], + "axis_id": 0, + "theta_rad": 1.9947308343312669, + "theta_alt_rad": -1.1468618192585254, + "score_theta": 0.09005742853002957, + "score_theta_alt": 0.060269758536891226, + "best_score": 0.060269758536891226, + "per_marker": [ + { + "marker_id": 245, + "weight": 1.0 + } + ] + } + } + ] + }, + { + "pass": 1, + "updates": [ + { + "link": "Base", + "joint_variable": "x", + "joint_type": "linear", + "old": 0.03932058271123921, + "new": 0.03932058271128886, + "info": { + "reason": "weighted_projection", + "used_markers": 5, + "axis_world": [ + 0.999999999999, + -5.149936365026286e-11, + -2.498400728865456e-11 + ], + "per_marker": [ + { + "marker_id": 198, + "q_i": 0.02056943691835953, + "weight": 1.0 + }, + { + "marker_id": 229, + "q_i": 0.05640168504907343, + "weight": 1.0 + }, + { + "marker_id": 243, + "q_i": 0.0584798904608715, + "weight": 1.0 + }, + { + "marker_id": 244, + "q_i": 0.02053896043624319, + "weight": 1.0 + }, + { + "marker_id": 245, + "q_i": 0.04061294069189662, + "weight": 1.0 + } + ] + } + }, + { + "link": "Arm1", + "joint_variable": "y", + "joint_type": "revolute", + "old": -0.20389236799324362, + "new": -0.19455509564487805, + "info": { + "reason": "2d_alignment+normal_tiebreak", + "used_markers": 5, + "axis_world": [ + -0.999999999999, + 5.149936365026286e-11, + 2.498400728865456e-11 + ], + "axis_id": 0, + "theta_rad": -0.1945550956448781, + "theta_alt_rad": 2.947037557944915, + "score_theta": 0.06626009051985911, + "score_theta_alt": 1.2134538154671959, + "best_score": 0.06626009051985911, + "per_marker": [ + { + "marker_id": 198, + "weight": 1.0 + }, + { + "marker_id": 229, + "weight": 1.0 + }, + { + "marker_id": 243, + "weight": 1.0 + }, + { + "marker_id": 244, + "weight": 1.0 + }, + { + "marker_id": 245, + "weight": 1.0 + } + ] + } + }, + { + "link": "Ellbow", + "joint_variable": "z", + "joint_type": "revolute", + "old": -1.1468618192585254, + "new": -1.1625044027189215, + "info": { + "reason": "2d_alignment+normal_tiebreak", + "used_markers": 1, + "axis_world": [ + -0.999999999999, + 5.149936365026286e-11, + 2.498400728865456e-11 + ], + "axis_id": 0, + "theta_rad": 1.979088250870872, + "theta_alt_rad": -1.1625044027189215, + "score_theta": 0.08956373772482298, + "score_theta_alt": 0.06020393790864231, + "best_score": 0.06020393790864231, + "per_marker": [ + { + "marker_id": 245, + "weight": 1.0 + } + ] + } + } + ] + } + ], + "root_link": "Board", + "root_pose": { + "reason": "kabsch", + "used_markers": [ + 210, + 211, + 214, + 208, + 206, + 205, + 207, + 217, + 46, + 47, + 51, + 53, + 54, + 55, + 56, + 58, + 60, + 61, + 62, + 63, + 64, + 66, + 68, + 69, + 72, + 75, + 79, + 83, + 84, + 85, + 86, + 92, + 95, + 96, + 97, + 102, + 103, + 105 + ] + }, + "marker_stats": { + "num_markers_used": 43, + "mean_error_m": 0.012908680273136798, + "rms_error_m": 0.03867128518692191, + "median_error_m": 1.0497911868958923e-10, + "worst_error_m": 0.1289551600402737 + }, + "marker_reports": [ + { + "marker_id": 46, + "link": "Board", + "error_m": [ + -6.921452300190367e-11, + 2.350980521370616e-12, + 7.356334291719335e-11 + ], + "error_norm_m": 1.0103337431238005e-10, + "predicted_m": [ + 0.5367100000237451, + 0.1854400000862775, + -0.02729999985220077 + ], + "observed_m": [ + 0.5367100000929597, + 0.18544000008392653, + -0.027299999925764113 + ] + }, + { + "marker_id": 47, + "link": "Board", + "error_m": [ + -4.194888880704184e-11, + 1.2825074335864883e-11, + -9.619756380363498e-12 + ], + "error_norm_m": 4.490803398818038e-11, + "predicted_m": [ + 0.34422999999943854, + -0.2865399999038096, + -0.027299999856872467 + ], + "observed_m": [ + 0.34423000004138743, + -0.28653999991663465, + -0.02729999984725271 + ] + }, + { + "marker_id": 51, + "link": "Board", + "error_m": [ + 4.139469322872458e-11, + 6.881378800116522e-11, + 6.761477142069872e-11 + ], + "error_norm_m": 1.0497911868958923e-10, + "predicted_m": [ + 0.16780000000533324, + -0.17207999989472358, + -0.02729999985016539 + ], + "observed_m": [ + 0.16779999996393855, + -0.17207999996353737, + -0.027299999917780163 + ] + }, + { + "marker_id": 53, + "link": "Board", + "error_m": [ + -2.6609547898459596e-11, + -3.455066788227157e-11, + 2.512753893846309e-12 + ], + "error_norm_m": 4.3682154509621976e-11, + "predicted_m": [ + 0.48625000002512525, + 0.21224000008887617, + -0.027299999850401747 + ], + "observed_m": [ + 0.4862500000517348, + 0.21224000012342684, + -0.0272999998529145 + ] + }, + { + "marker_id": 54, + "link": "Board", + "error_m": [ + -4.6582626644919856e-11, + 6.04571948059629e-11, + 1.2305761618036648e-10 + ], + "error_norm_m": 1.4480397235207513e-10, + "predicted_m": [ + 0.34226999999716995, + -0.3305899999037086, + -0.02729999985770833 + ], + "observed_m": [ + 0.3422700000437526, + -0.33058999996416577, + -0.027299999980765946 + ] + }, + { + "marker_id": 55, + "link": "Board", + "error_m": [ + 5.331846075762314e-12, + 4.191130775765828e-11, + 3.601537471031868e-11 + ], + "error_norm_m": 5.551660576852147e-11, + "predicted_m": [ + 0.2837200000006725, + -0.2625799999006933, + -0.027299999854879402 + ], + "observed_m": [ + 0.28371999999534064, + -0.2625799999426046, + -0.027299999890894776 + ] + }, + { + "marker_id": 56, + "link": "Board", + "error_m": [ + -4.747152670958599e-11, + 3.597028230828414e-11, + 1.0086134011322301e-10 + ], + "error_norm_m": 1.1713418368227034e-10, + "predicted_m": [ + 0.49868000002288143, + 0.16867000008823602, + -0.027299999851587486 + ], + "observed_m": [ + 0.49868000007035296, + 0.16867000005226573, + -0.027299999952448827 + ] + }, + { + "marker_id": 58, + "link": "Board", + "error_m": [ + 5.776350925357221e-11, + -1.0487305468487307e-11, + -6.714264561002992e-12 + ], + "error_norm_m": 5.909050622453684e-11, + "predicted_m": [ + 0.05009000000296277, + -0.2181099998886616, + -0.027299999848149126 + ], + "observed_m": [ + 0.05008999994519926, + -0.21810999987817428, + -0.02729999984143486 + ] + }, + { + "marker_id": 60, + "link": "Board", + "error_m": [ + 3.88974408238596e-11, + 4.0529801736965965e-11, + 6.540252367459587e-11 + ], + "error_norm_m": 8.621580965512939e-11, + "predicted_m": [ + 0.43436000002881114, + 0.2838100000915484, + -0.027299999847667705 + ], + "observed_m": [ + 0.4343599999899137, + 0.2838100000510186, + -0.02729999991307023 + ] + }, + { + "marker_id": 61, + "link": "Board", + "error_m": [ + 2.7931441881623442e-12, + 4.307881829035409e-11, + 1.0390255669734394e-10 + ], + "error_norm_m": 1.1251367707080763e-10, + "predicted_m": [ + -0.022419999968509654, + 0.3358300001150722, + -0.027299999835210594 + ], + "observed_m": [ + -0.022419999971302798, + 0.3358300000719934, + -0.02729999993911315 + ] + }, + { + "marker_id": 62, + "link": "Board", + "error_m": [ + -2.3758495171222194e-11, + 8.230527370756135e-12, + -2.646639851722199e-12 + ], + "error_norm_m": 2.528264970501467e-11, + "predicted_m": [ + 0.4047000000051776, + -0.1750999999069238, + -0.027299999856144765 + ], + "observed_m": [ + 0.4047000000289361, + -0.17509999991515432, + -0.027299999853498125 + ] + }, + { + "marker_id": 63, + "link": "Board", + "error_m": [ + -7.193201589927867e-11, + 9.119155430781234e-11, + 9.76514528960859e-11 + ], + "error_norm_m": 1.5174294296976465e-10, + "predicted_m": [ + 0.7774000000020334, + -0.23614999992611754, + -0.02729999986668261 + ], + "observed_m": [ + 0.7774000000739654, + -0.2361500000173091, + -0.027299999964334062 + ] + }, + { + "marker_id": 64, + "link": "Board", + "error_m": [ + 8.32130267469644e-11, + -2.4742902171581704e-11, + -7.563099452267963e-11 + ], + "error_norm_m": 1.1513759751164288e-10, + "predicted_m": [ + -0.021269999995498393, + -0.18822999988498657, + -0.02729999984576607 + ], + "observed_m": [ + -0.02127000007871142, + -0.18822999986024366, + -0.027299999770135076 + ] + }, + { + "marker_id": 66, + "link": "Board", + "error_m": [ + -6.608047442568932e-12, + 1.0081047108201346e-11, + 3.1897609553688255e-11 + ], + "error_norm_m": 3.409913924193044e-11, + "predicted_m": [ + 0.2097499999954891, + -0.3632299998968839, + -0.027299999855053082 + ], + "observed_m": [ + 0.20975000000209715, + -0.363229999906965, + -0.027299999886950692 + ] + }, + { + "marker_id": 68, + "link": "Board", + "error_m": [ + -1.352573608670582e-11, + 3.0912244985970005e-11, + 1.0560027852157816e-10 + ], + "error_norm_m": 1.1085996234256408e-10, + "predicted_m": [ + 0.5737300000229829, + 0.170640000084371, + -0.027299999853422966 + ], + "observed_m": [ + 0.5737300000365086, + 0.17064000005345875, + -0.027299999959023245 + ] + }, + { + "marker_id": 69, + "link": "Board", + "error_m": [ + -4.271276561607085e-11, + 4.2441605785370484e-11, + 1.3482569227729613e-10 + ], + "error_norm_m": 1.476605483745281e-10, + "predicted_m": [ + 0.007609999999713185, + -0.28120999988647377, + -0.027299999848355287 + ], + "observed_m": [ + 0.00761000004242595, + -0.2812099999289154, + -0.02729999998318098 + ] + }, + { + "marker_id": 72, + "link": "Board", + "error_m": [ + -1.1204204231063386e-11, + -1.1101033980942532e-10, + -1.3621226715998525e-10 + ], + "error_norm_m": 1.760755845139202e-10, + "predicted_m": [ + 0.4409900000242024, + 0.19432000009120703, + -0.02729999984963093 + ], + "observed_m": [ + 0.4409900000354066, + 0.19432000020221737, + -0.027299999713418663 + ] + }, + { + "marker_id": 75, + "link": "Board", + "error_m": [ + 3.744133475480638e-11, + 4.427902489112512e-12, + 7.917074634766763e-11 + ], + "error_norm_m": 8.768960568916528e-11, + "predicted_m": [ + -0.025699999975783934, + 0.19458000011524126, + -0.02729999983796592 + ], + "observed_m": [ + -0.02570000001322527, + 0.19458000011081336, + -0.027299999917136667 + ] + }, + { + "marker_id": 79, + "link": "Board", + "error_m": [ + -1.0256906435301971e-11, + -2.787770014833768e-12, + 6.730345447625297e-12 + ], + "error_norm_m": 1.2580673317534154e-11, + "predicted_m": [ + 0.3123000000060011, + -0.1591099999021653, + -0.027299999853515052 + ], + "observed_m": [ + 0.312300000016258, + -0.15910999989937752, + -0.027299999860245398 + ] + }, + { + "marker_id": 83, + "link": "Board", + "error_m": [ + 3.928993935753411e-11, + 2.7480240305521875e-12, + 6.992308121400725e-11 + ], + "error_norm_m": 8.025265264931655e-11, + "predicted_m": [ + 0.044160000031664884, + 0.3392200001116434, + -0.027299999836805935 + ], + "observed_m": [ + 0.044159999992374944, + 0.33922000010889536, + -0.027299999906729017 + ] + }, + { + "marker_id": 84, + "link": "Board", + "error_m": [ + 1.2232381774168744e-11, + -9.382705723481877e-11, + -1.1213998132864056e-10 + ], + "error_norm_m": 1.467260142088063e-10, + "predicted_m": [ + 0.4074900000275036, + 0.2584200000929322, + -0.027299999847506397 + ], + "observed_m": [ + 0.4074900000152712, + 0.25842000018675926, + -0.027299999735366415 + ] + }, + { + "marker_id": 85, + "link": "Board", + "error_m": [ + -2.044575619919442e-11, + 2.2512602892987843e-11, + -3.777428370099756e-11 + ], + "error_norm_m": 4.849477028193567e-11, + "predicted_m": [ + 0.5045799999980887, + -0.3127499999120675, + -0.02729999986140513 + ], + "observed_m": [ + 0.5045800000185344, + -0.3127499999345801, + -0.027299999823630846 + ] + }, + { + "marker_id": 86, + "link": "Board", + "error_m": [ + 3.23500115584352e-11, + -2.6180668744046898e-11, + -6.783550804412286e-11 + ], + "error_norm_m": 7.958396079186222e-11, + "predicted_m": [ + 0.3628900000292334, + 0.29201000009522904, + -0.027299999845717387 + ], + "observed_m": [ + 0.3628899999968834, + 0.2920100001214097, + -0.02729999977788188 + ] + }, + { + "marker_id": 92, + "link": "Board", + "error_m": [ + -3.7151948184543926e-11, + 2.1886936707460336e-12, + -5.762684079924085e-11 + ], + "error_norm_m": 6.859963858791422e-11, + "predicted_m": [ + 0.645090000004676, + -0.18483999991930372, + -0.027299999862346318 + ], + "observed_m": [ + 0.6450900000418279, + -0.18483999992149241, + -0.027299999804719477 + ] + }, + { + "marker_id": 95, + "link": "Board", + "error_m": [ + 3.2901459334766514e-12, + 3.6927239044359794e-11, + 4.4867467380305115e-11 + ], + "error_norm_m": 5.820254008911988e-11, + "predicted_m": [ + 0.18604000000008075, + -0.27406999989566283, + -0.027299999852669763 + ], + "observed_m": [ + 0.1860399999967906, + -0.27406999993259007, + -0.02729999989753723 + ] + }, + { + "marker_id": 96, + "link": "Board", + "error_m": [ + -1.8183177186159583e-11, + 7.180533945216894e-12, + 1.1835185609321286e-12 + ], + "error_norm_m": 1.9585421019364308e-11, + "predicted_m": [ + 0.369770000004591, + -0.1864899999051249, + -0.027299999855500863 + ], + "observed_m": [ + 0.36977000002277416, + -0.18648999991230544, + -0.02729999985668438 + ] + }, + { + "marker_id": 97, + "link": "Board", + "error_m": [ + 9.351963647930006e-13, + 1.6471490837943747e-11, + 1.973084196027486e-11 + ], + "error_norm_m": 2.5719462030270577e-11, + "predicted_m": [ + 0.3043499999956724, + -0.35966999990175574, + -0.02729999985734506 + ], + "observed_m": [ + 0.3043499999947372, + -0.35966999991822723, + -0.027299999877075903 + ] + }, + { + "marker_id": 102, + "link": "Board", + "error_m": [ + -9.682676882505348e-11, + 6.800027207987114e-11, + 6.65371993613384e-11 + ], + "error_norm_m": 1.3574483070410947e-10, + "predicted_m": [ + 0.6496900000027108, + -0.2229999999195406, + -0.027299999863227762 + ], + "observed_m": [ + 0.6496900000995376, + -0.22299999998754086, + -0.02729999992976496 + ] + }, + { + "marker_id": 103, + "link": "Board", + "error_m": [ + 8.42121511412941e-11, + -2.9430458070578425e-11, + -7.908350710406076e-11 + ], + "error_norm_m": 1.192142581991192e-10, + "predicted_m": [ + 0.10571000000452832, + -0.187709999891526, + -0.027299999848928096 + ], + "observed_m": [ + 0.10570999992031617, + -0.18770999986209555, + -0.02729999976984459 + ] + }, + { + "marker_id": 105, + "link": "Board", + "error_m": [ + -1.7853163392089755e-11, + 2.1510460079809945e-11, + -3.6753270565847984e-11 + ], + "error_norm_m": 4.617616520713017e-11, + "predicted_m": [ + 0.5248400000004835, + -0.2662499999131108, + -0.027299999860977264 + ], + "observed_m": [ + 0.5248400000183366, + -0.2662499999346213, + -0.027299999824223993 + ] + }, + { + "marker_id": 198, + "link": "Arm1", + "error_m": [ + 0.018751145790648738, + 0.018145197480727182, + -0.12628768602257245 + ], + "error_norm_m": 0.1289551600402737, + "predicted_m": [ + 0.14932058272486504, + -0.05574795621971772, + 0.06440687550659747 + ], + "observed_m": [ + 0.1305694369342163, + -0.0738931537004449, + 0.19069456152916994 + ] + }, + { + "marker_id": 205, + "link": "Board", + "error_m": [ + -5.490263799146078e-11, + 6.59273607928057e-11, + 9.302996030859448e-11 + ], + "error_norm_m": 1.2655153130067147e-10, + "predicted_m": [ + 0.7500000000102496, + -0.08999999992526098, + 0.00030000013693766095 + ], + "observed_m": [ + 0.7500000000651522, + -0.08999999999118834, + 0.00030000004390770064 + ] + }, + { + "marker_id": 206, + "link": "Board", + "error_m": [ + 6.827982623747175e-12, + -3.7700648158889294e-11, + -5.069396210319668e-11 + ], + "error_norm_m": 6.354398486112511e-11, + "predicted_m": [ + 0.6500000000143696, + -0.009999999920111104, + 0.0003000001410430143 + ], + "observed_m": [ + 0.6500000000075417, + -0.009999999882410456, + 0.0003000001917369764 + ] + }, + { + "marker_id": 207, + "link": "Board", + "error_m": [ + -3.425781880395107e-11, + 1.4403794129647096e-11, + 7.014771473108986e-11 + ], + "error_norm_m": 7.938368419598551e-11, + "predicted_m": [ + 0.7500000000143695, + -0.00999999992526104, + 0.0003000001385446136 + ], + "observed_m": [ + 0.7500000000486273, + -0.009999999939664835, + 0.00030000006839689885 + ] + }, + { + "marker_id": 208, + "link": "Board", + "error_m": [ + 7.159539627821232e-11, + -1.5204547343383723e-10, + -2.8029990779615196e-10 + ], + "error_norm_m": 3.268206925371851e-10, + "predicted_m": [ + 0.3500000000102497, + -0.08999999990466123, + 0.00030000014693126384 + ], + "observed_m": [ + 0.3499999999386543, + -0.08999999975261576, + 0.00030000042723117164 + ] + }, + { + "marker_id": 210, + "link": "Board", + "error_m": [ + 4.2297030461435625e-11, + -8.491484598804888e-11, + -4.74245199859856e-11 + ], + "error_norm_m": 1.0605967636633078e-10, + "predicted_m": [ + 0.020000000013854876, + -0.0199999998876665, + 0.00030000015658206977 + ], + "observed_m": [ + 0.019999999971557846, + -0.019999999802751654, + 0.00030000020400658975 + ] + }, + { + "marker_id": 211, + "link": "Board", + "error_m": [ + 8.269240847624815e-11, + 8.939949475150755e-12, + -7.327679863713618e-11 + ], + "error_norm_m": 1.1084875432195134e-10, + "predicted_m": [ + 0.2500000000143698, + -0.009999999899511358, + 0.0003000001510366172 + ], + "observed_m": [ + 0.24999999993167737, + -0.009999999908451308, + 0.00030000022431341585 + ] + }, + { + "marker_id": 214, + "link": "Board", + "error_m": [ + 8.195955025769308e-11, + -1.3042663997431259e-10, + -2.399532524717182e-10 + ], + "error_norm_m": 2.851421394062765e-10, + "predicted_m": [ + 0.3500000000143697, + -0.009999999904661295, + 0.0003000001485382165 + ], + "observed_m": [ + 0.34999999993241016, + -0.009999999774234655, + 0.00030000038849146895 + ] + }, + { + "marker_id": 217, + "link": "Board", + "error_m": [ + -3.306532825320119e-11, + -2.1928098226098314e-11, + -8.054044632827342e-11 + ], + "error_norm_m": 8.97826314999892e-11, + "predicted_m": [ + 0.6500000000102497, + -0.08999999992011104, + 0.0003000001394360617 + ], + "observed_m": [ + 0.650000000043315, + -0.08999999989818294, + 0.000300000219976508 + ] + }, + { + "marker_id": 229, + "link": "Arm1", + "error_m": [ + -0.017081102340388954, + 0.007776543509965095, + -0.11643952562047 + ], + "error_norm_m": 0.11794236648823574, + "predicted_m": [ + 0.1493205827198828, + -0.14404999642186878, + 0.04700717159713171 + ], + "observed_m": [ + 0.16640168506027175, + -0.15182653993183387, + 0.16344669721760172 + ] + }, + { + "marker_id": 243, + "link": "Arm1", + "error_m": [ + -0.019159307752486893, + -6.329556374951029e-05, + -0.11219902955088909 + ], + "error_norm_m": 0.1138231317089992, + "predicted_m": [ + 0.1493205827174358, + -0.17162312720235756, + 0.00590093777594735 + ], + "observed_m": [ + 0.1684798904699227, + -0.17155983163860805, + 0.11809996732683645 + ] + }, + { + "marker_id": 244, + "link": "Ellbow", + "error_m": [ + 0.018781622267737774, + -0.11721890900263672, + -0.04835783508828224 + ], + "error_norm_m": 0.12818542107900538, + "predicted_m": [ + 0.2743205827192178, + -0.13728344490795844, + 0.012667489293172152 + ], + "observed_m": [ + 0.25553896045148, + -0.02006453590532172, + 0.06102532438145439 + ] + }, + { + "marker_id": 245, + "link": "Ellbow", + "error_m": [ + -0.0012923579839241028, + -0.03581624704026484, + -0.05562032425330392 + ], + "error_norm_m": 0.06616716868092937, + "predicted_m": [ + 0.2393205827208373, + -0.10307986608725822, + 0.005243528358178585 + ], + "observed_m": [ + 0.2406129407047614, + -0.06726361904699338, + 0.060863852611482507 + ] + } + ], + "stage_idx": 1, + "num_active_links": 4 + }, + { + "method": "deterministic_geometric_prefix", + "active_links": [ + "Board", + "Base", + "Arm1", + "Ellbow", + "Arm2" + ], + "active_observations": 45, + "joint_updates": [ + { + "pass": 0, + "updates": [ + { + "link": "Base", + "joint_variable": "x", + "joint_type": "linear", + "old": 0.03932058271128886, + "new": 0.061424393266096756, + "info": { + "reason": "weighted_projection", + "used_markers": 7, + "axis_world": [ + 0.999999999999, + -5.149936365026286e-11, + -2.498400728865456e-11 + ], + "per_marker": [ + { + "marker_id": 198, + "q_i": 0.020569436918359538, + "weight": 1.0 + }, + { + "marker_id": 229, + "q_i": 0.05640168504907344, + "weight": 1.0 + }, + { + "marker_id": 243, + "q_i": 0.05847989046087151, + "weight": 1.0 + }, + { + "marker_id": 244, + "q_i": 0.020538960436246312, + "weight": 1.0 + }, + { + "marker_id": 245, + "q_i": 0.040612940691898886, + "weight": 1.0 + }, + { + "marker_id": 113, + "q_i": 0.08041659529056591, + "weight": 1.0 + }, + { + "marker_id": 124, + "q_i": 0.1529512440156617, + "weight": 1.0 + } + ] + } + }, + { + "link": "Arm1", + "joint_variable": "y", + "joint_type": "revolute", + "old": -0.19455509564487805, + "new": -0.7910842723533982, + "info": { + "reason": "2d_alignment+normal_tiebreak", + "used_markers": 7, + "axis_world": [ + -0.999999999999, + 5.149936365026286e-11, + 2.498400728865456e-11 + ], + "axis_id": 0, + "theta_rad": -0.7910842723533981, + "theta_alt_rad": 2.350508381236395, + "score_theta": 1.2880497008950933, + "score_theta_alt": 1.4048023209131617, + "best_score": 1.2880497008950933, + "per_marker": [ + { + "marker_id": 198, + "weight": 1.0 + }, + { + "marker_id": 229, + "weight": 1.0 + }, + { + "marker_id": 243, + "weight": 1.0 + }, + { + "marker_id": 244, + "weight": 1.0 + }, + { + "marker_id": 245, + "weight": 1.0 + }, + { + "marker_id": 113, + "weight": 1.0 + }, + { + "marker_id": 124, + "weight": 1.0 + } + ] + } + }, + { + "link": "Ellbow", + "joint_variable": "z", + "joint_type": "revolute", + "old": -1.1625044027189215, + "new": 1.1318079310686837, + "info": { + "reason": "2d_alignment+normal_tiebreak", + "used_markers": 3, + "axis_world": [ + -0.999999999999, + 5.149936365026286e-11, + 2.498400728865456e-11 + ], + "axis_id": 0, + "theta_rad": -2.00978472252111, + "theta_alt_rad": 1.1318079310686837, + "score_theta": 1.0166317982331423, + "score_theta_alt": 0.4101893718122774, + "best_score": 0.4101893718122774, + "per_marker": [ + { + "marker_id": 245, + "weight": 1.0 + }, + { + "marker_id": 113, + "weight": 1.0 + }, + { + "marker_id": 124, + "weight": 1.0 + } + ] + } + }, + { + "link": "Arm2", + "joint_variable": "a", + "joint_type": "revolute", + "old": 0.0, + "new": 1.0153860392028387, + "info": { + "reason": "2d_alignment+normal_tiebreak", + "used_markers": 2, + "axis_world": [ + -4.0189905110185184e-11, + -0.9425130878626945, + 0.3341692373716179 + ], + "axis_id": 1, + "theta_rad": 1.0153860392028389, + "theta_alt_rad": -2.1262066143869545, + "score_theta": 0.3863100111606848, + "score_theta_alt": 0.4069970169228545, + "best_score": 0.3863100111606848, + "per_marker": [ + { + "marker_id": 113, + "weight": 1.0 + }, + { + "marker_id": 124, + "weight": 1.0 + } + ] + } + } + ] + }, + { + "pass": 1, + "updates": [ + { + "link": "Base", + "joint_variable": "x", + "joint_type": "linear", + "old": 0.061424393266096756, + "new": 0.06270235665096582, + "info": { + "reason": "weighted_projection", + "used_markers": 7, + "axis_world": [ + 0.999999999999, + -5.149936365026286e-11, + -2.498400728865456e-11 + ], + "per_marker": [ + { + "marker_id": 198, + "q_i": 0.020569436918359524, + "weight": 1.0 + }, + { + "marker_id": 229, + "q_i": 0.056401685049073426, + "weight": 1.0 + }, + { + "marker_id": 243, + "q_i": 0.058479890460871514, + "weight": 1.0 + }, + { + "marker_id": 244, + "q_i": 0.020538960436308828, + "weight": 1.0 + }, + { + "marker_id": 245, + "q_i": 0.040612940691943884, + "weight": 1.0 + }, + { + "marker_id": 113, + "q_i": 0.10590712040382723, + "weight": 1.0 + }, + { + "marker_id": 124, + "q_i": 0.13640646259637637, + "weight": 1.0 + } + ] + } + }, + { + "link": "Arm1", + "joint_variable": "y", + "joint_type": "revolute", + "old": -0.7910842723533982, + "new": -0.2287079652555155, + "info": { + "reason": "2d_alignment+normal_tiebreak", + "used_markers": 7, + "axis_world": [ + -0.999999999999, + 5.149936365026286e-11, + 2.498400728865456e-11 + ], + "axis_id": 0, + "theta_rad": -0.22870796525551543, + "theta_alt_rad": 2.9128846883342776, + "score_theta": 0.18186566319216765, + "score_theta_alt": 2.569250446108988, + "best_score": 0.18186566319216765, + "per_marker": [ + { + "marker_id": 198, + "weight": 1.0 + }, + { + "marker_id": 229, + "weight": 1.0 + }, + { + "marker_id": 243, + "weight": 1.0 + }, + { + "marker_id": 244, + "weight": 1.0 + }, + { + "marker_id": 245, + "weight": 1.0 + }, + { + "marker_id": 113, + "weight": 1.0 + }, + { + "marker_id": 124, + "weight": 1.0 + } + ] + } + }, + { + "link": "Ellbow", + "joint_variable": "z", + "joint_type": "revolute", + "old": 1.1318079310686837, + "new": 1.5266209153694081, + "info": { + "reason": "2d_alignment+normal_tiebreak", + "used_markers": 3, + "axis_world": [ + -0.999999999999, + 5.149936365026286e-11, + 2.498400728865456e-11 + ], + "axis_id": 0, + "theta_rad": -1.6149717382203848, + "theta_alt_rad": 1.5266209153694081, + "score_theta": 0.7410795027983774, + "score_theta_alt": 0.13348211091489365, + "best_score": 0.13348211091489365, + "per_marker": [ + { + "marker_id": 245, + "weight": 1.0 + }, + { + "marker_id": 113, + "weight": 1.0 + }, + { + "marker_id": 124, + "weight": 1.0 + } + ] + } + }, + { + "link": "Arm2", + "joint_variable": "a", + "joint_type": "revolute", + "old": 1.0153860392028387, + "new": 0.4456159985371926, + "info": { + "reason": "2d_alignment+normal_tiebreak", + "used_markers": 2, + "axis_world": [ + 1.017999436589031e-11, + -0.26950923860227566, + 0.9629978038947035 + ], + "axis_id": 2, + "theta_rad": -2.6959766550526005, + "theta_alt_rad": 0.4456159985371926, + "score_theta": 0.12151226922327332, + "score_theta_alt": 0.1015432472034222, + "best_score": 0.1015432472034222, + "per_marker": [ + { + "marker_id": 113, + "weight": 1.0 + }, + { + "marker_id": 124, + "weight": 1.0 + } + ] + } + } + ] + } + ], + "root_link": "Board", + "root_pose": { + "reason": "kabsch", + "used_markers": [ + 210, + 211, + 214, + 208, + 206, + 205, + 207, + 217, + 46, + 47, + 51, + 53, + 54, + 55, + 56, + 58, + 60, + 61, + 62, + 63, + 64, + 66, + 68, + 69, + 72, + 75, + 79, + 83, + 84, + 85, + 86, + 92, + 95, + 96, + 97, + 102, + 103, + 105 + ] + }, + "marker_stats": { + "num_markers_used": 45, + "mean_error_m": 0.02227395365630121, + "rms_error_m": 0.05721833765327737, + "median_error_m": 1.0605967636633078e-10, + "worst_error_m": 0.18532001325970596 + }, + "marker_reports": [ + { + "marker_id": 46, + "link": "Board", + "error_m": [ + -6.921452300190367e-11, + 2.350980521370616e-12, + 7.356334291719335e-11 + ], + "error_norm_m": 1.0103337431238005e-10, + "predicted_m": [ + 0.5367100000237451, + 0.1854400000862775, + -0.02729999985220077 + ], + "observed_m": [ + 0.5367100000929597, + 0.18544000008392653, + -0.027299999925764113 + ] + }, + { + "marker_id": 47, + "link": "Board", + "error_m": [ + -4.194888880704184e-11, + 1.2825074335864883e-11, + -9.619756380363498e-12 + ], + "error_norm_m": 4.490803398818038e-11, + "predicted_m": [ + 0.34422999999943854, + -0.2865399999038096, + -0.027299999856872467 + ], + "observed_m": [ + 0.34423000004138743, + -0.28653999991663465, + -0.02729999984725271 + ] + }, + { + "marker_id": 51, + "link": "Board", + "error_m": [ + 4.139469322872458e-11, + 6.881378800116522e-11, + 6.761477142069872e-11 + ], + "error_norm_m": 1.0497911868958923e-10, + "predicted_m": [ + 0.16780000000533324, + -0.17207999989472358, + -0.02729999985016539 + ], + "observed_m": [ + 0.16779999996393855, + -0.17207999996353737, + -0.027299999917780163 + ] + }, + { + "marker_id": 53, + "link": "Board", + "error_m": [ + -2.6609547898459596e-11, + -3.455066788227157e-11, + 2.512753893846309e-12 + ], + "error_norm_m": 4.3682154509621976e-11, + "predicted_m": [ + 0.48625000002512525, + 0.21224000008887617, + -0.027299999850401747 + ], + "observed_m": [ + 0.4862500000517348, + 0.21224000012342684, + -0.0272999998529145 + ] + }, + { + "marker_id": 54, + "link": "Board", + "error_m": [ + -4.6582626644919856e-11, + 6.04571948059629e-11, + 1.2305761618036648e-10 + ], + "error_norm_m": 1.4480397235207513e-10, + "predicted_m": [ + 0.34226999999716995, + -0.3305899999037086, + -0.02729999985770833 + ], + "observed_m": [ + 0.3422700000437526, + -0.33058999996416577, + -0.027299999980765946 + ] + }, + { + "marker_id": 55, + "link": "Board", + "error_m": [ + 5.331846075762314e-12, + 4.191130775765828e-11, + 3.601537471031868e-11 + ], + "error_norm_m": 5.551660576852147e-11, + "predicted_m": [ + 0.2837200000006725, + -0.2625799999006933, + -0.027299999854879402 + ], + "observed_m": [ + 0.28371999999534064, + -0.2625799999426046, + -0.027299999890894776 + ] + }, + { + "marker_id": 56, + "link": "Board", + "error_m": [ + -4.747152670958599e-11, + 3.597028230828414e-11, + 1.0086134011322301e-10 + ], + "error_norm_m": 1.1713418368227034e-10, + "predicted_m": [ + 0.49868000002288143, + 0.16867000008823602, + -0.027299999851587486 + ], + "observed_m": [ + 0.49868000007035296, + 0.16867000005226573, + -0.027299999952448827 + ] + }, + { + "marker_id": 58, + "link": "Board", + "error_m": [ + 5.776350925357221e-11, + -1.0487305468487307e-11, + -6.714264561002992e-12 + ], + "error_norm_m": 5.909050622453684e-11, + "predicted_m": [ + 0.05009000000296277, + -0.2181099998886616, + -0.027299999848149126 + ], + "observed_m": [ + 0.05008999994519926, + -0.21810999987817428, + -0.02729999984143486 + ] + }, + { + "marker_id": 60, + "link": "Board", + "error_m": [ + 3.88974408238596e-11, + 4.0529801736965965e-11, + 6.540252367459587e-11 + ], + "error_norm_m": 8.621580965512939e-11, + "predicted_m": [ + 0.43436000002881114, + 0.2838100000915484, + -0.027299999847667705 + ], + "observed_m": [ + 0.4343599999899137, + 0.2838100000510186, + -0.02729999991307023 + ] + }, + { + "marker_id": 61, + "link": "Board", + "error_m": [ + 2.7931441881623442e-12, + 4.307881829035409e-11, + 1.0390255669734394e-10 + ], + "error_norm_m": 1.1251367707080763e-10, + "predicted_m": [ + -0.022419999968509654, + 0.3358300001150722, + -0.027299999835210594 + ], + "observed_m": [ + -0.022419999971302798, + 0.3358300000719934, + -0.02729999993911315 + ] + }, + { + "marker_id": 62, + "link": "Board", + "error_m": [ + -2.3758495171222194e-11, + 8.230527370756135e-12, + -2.646639851722199e-12 + ], + "error_norm_m": 2.528264970501467e-11, + "predicted_m": [ + 0.4047000000051776, + -0.1750999999069238, + -0.027299999856144765 + ], + "observed_m": [ + 0.4047000000289361, + -0.17509999991515432, + -0.027299999853498125 + ] + }, + { + "marker_id": 63, + "link": "Board", + "error_m": [ + -7.193201589927867e-11, + 9.119155430781234e-11, + 9.76514528960859e-11 + ], + "error_norm_m": 1.5174294296976465e-10, + "predicted_m": [ + 0.7774000000020334, + -0.23614999992611754, + -0.02729999986668261 + ], + "observed_m": [ + 0.7774000000739654, + -0.2361500000173091, + -0.027299999964334062 + ] + }, + { + "marker_id": 64, + "link": "Board", + "error_m": [ + 8.32130267469644e-11, + -2.4742902171581704e-11, + -7.563099452267963e-11 + ], + "error_norm_m": 1.1513759751164288e-10, + "predicted_m": [ + -0.021269999995498393, + -0.18822999988498657, + -0.02729999984576607 + ], + "observed_m": [ + -0.02127000007871142, + -0.18822999986024366, + -0.027299999770135076 + ] + }, + { + "marker_id": 66, + "link": "Board", + "error_m": [ + -6.608047442568932e-12, + 1.0081047108201346e-11, + 3.1897609553688255e-11 + ], + "error_norm_m": 3.409913924193044e-11, + "predicted_m": [ + 0.2097499999954891, + -0.3632299998968839, + -0.027299999855053082 + ], + "observed_m": [ + 0.20975000000209715, + -0.363229999906965, + -0.027299999886950692 + ] + }, + { + "marker_id": 68, + "link": "Board", + "error_m": [ + -1.352573608670582e-11, + 3.0912244985970005e-11, + 1.0560027852157816e-10 + ], + "error_norm_m": 1.1085996234256408e-10, + "predicted_m": [ + 0.5737300000229829, + 0.170640000084371, + -0.027299999853422966 + ], + "observed_m": [ + 0.5737300000365086, + 0.17064000005345875, + -0.027299999959023245 + ] + }, + { + "marker_id": 69, + "link": "Board", + "error_m": [ + -4.271276561607085e-11, + 4.2441605785370484e-11, + 1.3482569227729613e-10 + ], + "error_norm_m": 1.476605483745281e-10, + "predicted_m": [ + 0.007609999999713185, + -0.28120999988647377, + -0.027299999848355287 + ], + "observed_m": [ + 0.00761000004242595, + -0.2812099999289154, + -0.02729999998318098 + ] + }, + { + "marker_id": 72, + "link": "Board", + "error_m": [ + -1.1204204231063386e-11, + -1.1101033980942532e-10, + -1.3621226715998525e-10 + ], + "error_norm_m": 1.760755845139202e-10, + "predicted_m": [ + 0.4409900000242024, + 0.19432000009120703, + -0.02729999984963093 + ], + "observed_m": [ + 0.4409900000354066, + 0.19432000020221737, + -0.027299999713418663 + ] + }, + { + "marker_id": 75, + "link": "Board", + "error_m": [ + 3.744133475480638e-11, + 4.427902489112512e-12, + 7.917074634766763e-11 + ], + "error_norm_m": 8.768960568916528e-11, + "predicted_m": [ + -0.025699999975783934, + 0.19458000011524126, + -0.02729999983796592 + ], + "observed_m": [ + -0.02570000001322527, + 0.19458000011081336, + -0.027299999917136667 + ] + }, + { + "marker_id": 79, + "link": "Board", + "error_m": [ + -1.0256906435301971e-11, + -2.787770014833768e-12, + 6.730345447625297e-12 + ], + "error_norm_m": 1.2580673317534154e-11, + "predicted_m": [ + 0.3123000000060011, + -0.1591099999021653, + -0.027299999853515052 + ], + "observed_m": [ + 0.312300000016258, + -0.15910999989937752, + -0.027299999860245398 + ] + }, + { + "marker_id": 83, + "link": "Board", + "error_m": [ + 3.928993935753411e-11, + 2.7480240305521875e-12, + 6.992308121400725e-11 + ], + "error_norm_m": 8.025265264931655e-11, + "predicted_m": [ + 0.044160000031664884, + 0.3392200001116434, + -0.027299999836805935 + ], + "observed_m": [ + 0.044159999992374944, + 0.33922000010889536, + -0.027299999906729017 + ] + }, + { + "marker_id": 84, + "link": "Board", + "error_m": [ + 1.2232381774168744e-11, + -9.382705723481877e-11, + -1.1213998132864056e-10 + ], + "error_norm_m": 1.467260142088063e-10, + "predicted_m": [ + 0.4074900000275036, + 0.2584200000929322, + -0.027299999847506397 + ], + "observed_m": [ + 0.4074900000152712, + 0.25842000018675926, + -0.027299999735366415 + ] + }, + { + "marker_id": 85, + "link": "Board", + "error_m": [ + -2.044575619919442e-11, + 2.2512602892987843e-11, + -3.777428370099756e-11 + ], + "error_norm_m": 4.849477028193567e-11, + "predicted_m": [ + 0.5045799999980887, + -0.3127499999120675, + -0.02729999986140513 + ], + "observed_m": [ + 0.5045800000185344, + -0.3127499999345801, + -0.027299999823630846 + ] + }, + { + "marker_id": 86, + "link": "Board", + "error_m": [ + 3.23500115584352e-11, + -2.6180668744046898e-11, + -6.783550804412286e-11 + ], + "error_norm_m": 7.958396079186222e-11, + "predicted_m": [ + 0.3628900000292334, + 0.29201000009522904, + -0.027299999845717387 + ], + "observed_m": [ + 0.3628899999968834, + 0.2920100001214097, + -0.02729999977788188 + ] + }, + { + "marker_id": 92, + "link": "Board", + "error_m": [ + -3.7151948184543926e-11, + 2.1886936707460336e-12, + -5.762684079924085e-11 + ], + "error_norm_m": 6.859963858791422e-11, + "predicted_m": [ + 0.645090000004676, + -0.18483999991930372, + -0.027299999862346318 + ], + "observed_m": [ + 0.6450900000418279, + -0.18483999992149241, + -0.027299999804719477 + ] + }, + { + "marker_id": 95, + "link": "Board", + "error_m": [ + 3.2901459334766514e-12, + 3.6927239044359794e-11, + 4.4867467380305115e-11 + ], + "error_norm_m": 5.820254008911988e-11, + "predicted_m": [ + 0.18604000000008075, + -0.27406999989566283, + -0.027299999852669763 + ], + "observed_m": [ + 0.1860399999967906, + -0.27406999993259007, + -0.02729999989753723 + ] + }, + { + "marker_id": 96, + "link": "Board", + "error_m": [ + -1.8183177186159583e-11, + 7.180533945216894e-12, + 1.1835185609321286e-12 + ], + "error_norm_m": 1.9585421019364308e-11, + "predicted_m": [ + 0.369770000004591, + -0.1864899999051249, + -0.027299999855500863 + ], + "observed_m": [ + 0.36977000002277416, + -0.18648999991230544, + -0.02729999985668438 + ] + }, + { + "marker_id": 97, + "link": "Board", + "error_m": [ + 9.351963647930006e-13, + 1.6471490837943747e-11, + 1.973084196027486e-11 + ], + "error_norm_m": 2.5719462030270577e-11, + "predicted_m": [ + 0.3043499999956724, + -0.35966999990175574, + -0.02729999985734506 + ], + "observed_m": [ + 0.3043499999947372, + -0.35966999991822723, + -0.027299999877075903 + ] + }, + { + "marker_id": 102, + "link": "Board", + "error_m": [ + -9.682676882505348e-11, + 6.800027207987114e-11, + 6.65371993613384e-11 + ], + "error_norm_m": 1.3574483070410947e-10, + "predicted_m": [ + 0.6496900000027108, + -0.2229999999195406, + -0.027299999863227762 + ], + "observed_m": [ + 0.6496900000995376, + -0.22299999998754086, + -0.02729999992976496 + ] + }, + { + "marker_id": 103, + "link": "Board", + "error_m": [ + 8.42121511412941e-11, + -2.9430458070578425e-11, + -7.908350710406076e-11 + ], + "error_norm_m": 1.192142581991192e-10, + "predicted_m": [ + 0.10571000000452832, + -0.187709999891526, + -0.027299999848928096 + ], + "observed_m": [ + 0.10570999992031617, + -0.18770999986209555, + -0.02729999976984459 + ] + }, + { + "marker_id": 105, + "link": "Board", + "error_m": [ + -1.7853163392089755e-11, + 2.1510460079809945e-11, + -3.6753270565847984e-11 + ], + "error_norm_m": 4.617616520713017e-11, + "predicted_m": [ + 0.5248400000004835, + -0.2662499999131108, + -0.027299999860977264 + ], + "observed_m": [ + 0.5248400000183366, + -0.2662499999346213, + -0.027299999824223993 + ] + }, + { + "marker_id": 113, + "link": "Arm2", + "error_m": [ + -0.030644652805159767, + 0.04025042912766644, + -0.16370726397448698 + ], + "error_norm_m": 0.17134544075791, + "predicted_m": [ + 0.24977194249877693, + -0.1584720183887424, + 0.1868814818684093 + ], + "observed_m": [ + 0.2804165953039367, + -0.19872244751640883, + 0.3505887458428963 + ] + }, + { + "marker_id": 124, + "link": "Arm2", + "error_m": [ + -0.08683097401328738, + 0.029967373144186404, + -0.1609529304278692 + ], + "error_norm_m": 0.18532001325970596, + "predicted_m": [ + 0.23112027001432411, + -0.20903984461274458, + 0.2111510114168477 + ], + "observed_m": [ + 0.3179512440276115, + -0.23900721775693098, + 0.3721039418447169 + ] + }, + { + "marker_id": 198, + "link": "Arm1", + "error_m": [ + 0.04213291973016145, + 0.018124355568954517, + -0.13188104822402633 + ], + "error_norm_m": 0.1396291018034782, + "predicted_m": [ + 0.17270235666437775, + -0.05576879813149038, + 0.05881351330514362 + ], + "observed_m": [ + 0.1305694369342163, + -0.0738931537004449, + 0.19069456152916994 + ] + }, + { + "marker_id": 205, + "link": "Board", + "error_m": [ + -5.490263799146078e-11, + 6.59273607928057e-11, + 9.302996030859448e-11 + ], + "error_norm_m": 1.2655153130067147e-10, + "predicted_m": [ + 0.7500000000102496, + -0.08999999992526098, + 0.00030000013693766095 + ], + "observed_m": [ + 0.7500000000651522, + -0.08999999999118834, + 0.00030000004390770064 + ] + }, + { + "marker_id": 206, + "link": "Board", + "error_m": [ + 6.827982623747175e-12, + -3.7700648158889294e-11, + -5.069396210319668e-11 + ], + "error_norm_m": 6.354398486112511e-11, + "predicted_m": [ + 0.6500000000143696, + -0.009999999920111104, + 0.0003000001410430143 + ], + "observed_m": [ + 0.6500000000075417, + -0.009999999882410456, + 0.0003000001917369764 + ] + }, + { + "marker_id": 207, + "link": "Board", + "error_m": [ + -3.425781880395107e-11, + 1.4403794129647096e-11, + 7.014771473108986e-11 + ], + "error_norm_m": 7.938368419598551e-11, + "predicted_m": [ + 0.7500000000143695, + -0.00999999992526104, + 0.0003000001385446136 + ], + "observed_m": [ + 0.7500000000486273, + -0.009999999939664835, + 0.00030000006839689885 + ] + }, + { + "marker_id": 208, + "link": "Board", + "error_m": [ + 7.159539627821232e-11, + -1.5204547343383723e-10, + -2.8029990779615196e-10 + ], + "error_norm_m": 3.268206925371851e-10, + "predicted_m": [ + 0.3500000000102497, + -0.08999999990466123, + 0.00030000014693126384 + ], + "observed_m": [ + 0.3499999999386543, + -0.08999999975261576, + 0.00030000042723117164 + ] + }, + { + "marker_id": 210, + "link": "Board", + "error_m": [ + 4.2297030461435625e-11, + -8.491484598804888e-11, + -4.74245199859856e-11 + ], + "error_norm_m": 1.0605967636633078e-10, + "predicted_m": [ + 0.020000000013854876, + -0.0199999998876665, + 0.00030000015658206977 + ], + "observed_m": [ + 0.019999999971557846, + -0.019999999802751654, + 0.00030000020400658975 + ] + }, + { + "marker_id": 211, + "link": "Board", + "error_m": [ + 8.269240847624815e-11, + 8.939949475150755e-12, + -7.327679863713618e-11 + ], + "error_norm_m": 1.1084875432195134e-10, + "predicted_m": [ + 0.2500000000143698, + -0.009999999899511358, + 0.0003000001510366172 + ], + "observed_m": [ + 0.24999999993167737, + -0.009999999908451308, + 0.00030000022431341585 + ] + }, + { + "marker_id": 214, + "link": "Board", + "error_m": [ + 8.195955025769308e-11, + -1.3042663997431259e-10, + -2.399532524717182e-10 + ], + "error_norm_m": 2.851421394062765e-10, + "predicted_m": [ + 0.3500000000143697, + -0.009999999904661295, + 0.0003000001485382165 + ], + "observed_m": [ + 0.34999999993241016, + -0.009999999774234655, + 0.00030000038849146895 + ] + }, + { + "marker_id": 217, + "link": "Board", + "error_m": [ + -3.306532825320119e-11, + -2.1928098226098314e-11, + -8.054044632827342e-11 + ], + "error_norm_m": 8.97826314999892e-11, + "predicted_m": [ + 0.6500000000102497, + -0.08999999992011104, + 0.0003000001394360617 + ], + "observed_m": [ + 0.650000000043315, + -0.08999999989818294, + 0.000300000219976508 + ] + }, + { + "marker_id": 229, + "link": "Arm1", + "error_m": [ + 0.006300671599081958, + 0.008401329461027535, + -0.12503792296491786 + ], + "error_norm_m": 0.12547813745307562, + "predicted_m": [ + 0.1727023566593537, + -0.14342521047080634, + 0.03840877425268385 + ], + "observed_m": [ + 0.16640168506027175, + -0.15182653993183387, + 0.16344669721760172 + ] + }, + { + "marker_id": 243, + "link": "Arm1", + "error_m": [ + 0.004222466187034202, + 0.0019811926673575786, + -0.1217149741709543 + ], + "error_norm_m": 0.12180430732335336, + "predicted_m": [ + 0.1727023566569569, + -0.16957863897125047, + -0.003615006844117849 + ], + "observed_m": [ + 0.1684798904699227, + -0.17155983163860805, + 0.11809996732683645 + ] + }, + { + "marker_id": 244, + "link": "Ellbow", + "error_m": [ + 0.04216339620718518, + -0.11542549827374328, + -0.056705154930516435 + ], + "error_norm_m": 0.13533762310296374, + "predicted_m": [ + 0.2977023566586652, + -0.135490034179065, + 0.004320169450937953 + ], + "observed_m": [ + 0.25553896045148, + -0.02006453590532172, + 0.06102532438145439 + ] + }, + { + "marker_id": 245, + "link": "Ellbow", + "error_m": [ + 0.022089415952001035, + -0.10193133826658204, + -0.06597650651074931 + ], + "error_norm_m": 0.12341328708562882, + "predicted_m": [ + 0.26270235665676245, + -0.16919495731357542, + -0.005112653899266803 + ], + "observed_m": [ + 0.2406129407047614, + -0.06726361904699338, + 0.060863852611482507 + ] + } + ], + "stage_idx": 2, + "num_active_links": 5 + } + ], + "markers": [ + { + "marker_id": 41, + "link": "FingerA", + "observed_position_m": [ + 0.15713392862090453, + -0.2416989061052508, + 0.5552827001989805 + ], + "predicted_position_m": [ + 0.2565450998126874, + -0.18819114848542082, + 0.2878063432568203 + ], + "error_m": [ + 0.09941117119178289, + 0.05350775761982998, + -0.2674763569421602 + ], + "error_norm_m": 0.29032613145611663 + }, + { + "marker_id": 42, + "link": "FingerA", + "observed_position_m": [ + 0.1479206585855855, + -0.19726420703716735, + 0.5690351925925898 + ], + "predicted_position_m": [ + 0.2788543381184665, + -0.2156508669929633, + 0.3193737591424451 + ], + "error_m": [ + 0.130933679532881, + -0.018386659955795942, + -0.24966143345014474 + ], + "error_norm_m": 0.2825111131490765 + }, + { + "marker_id": 43, + "link": "FingerB", + "observed_position_m": [ + 0.19954393633774076, + -0.17868114374099459, + 0.5441410607893239 + ], + "predicted_position_m": [ + 0.24089449526547008, + -0.21055027706202617, + 0.30418645151648965 + ], + "error_m": [ + 0.04135055892772932, + -0.031869133321031584, + -0.23995460927283424 + ], + "error_norm_m": 0.2455681675086326 + }, + { + "marker_id": 46, + "link": "Board", + "observed_position_m": [ + 0.5367100000929597, + 0.18544000008392653, + -0.027299999925764113 + ], + "predicted_position_m": [ + 0.5367100000237451, + 0.1854400000862775, + -0.02729999985220077 + ], + "error_m": [ + -6.921452300190367e-11, + 2.350980521370616e-12, + 7.356334291719335e-11 + ], + "error_norm_m": 1.0103337431238005e-10 + }, + { + "marker_id": 47, + "link": "Board", + "observed_position_m": [ + 0.34423000004138743, + -0.28653999991663465, + -0.02729999984725271 + ], + "predicted_position_m": [ + 0.34422999999943854, + -0.2865399999038096, + -0.027299999856872467 + ], + "error_m": [ + -4.194888880704184e-11, + 1.2825074335864883e-11, + -9.619756380363498e-12 + ], + "error_norm_m": 4.490803398818038e-11 + }, + { + "marker_id": 51, + "link": "Board", + "observed_position_m": [ + 0.16779999996393855, + -0.17207999996353737, + -0.027299999917780163 + ], + "predicted_position_m": [ + 0.16780000000533324, + -0.17207999989472358, + -0.02729999985016539 + ], + "error_m": [ + 4.139469322872458e-11, + 6.881378800116522e-11, + 6.761477142069872e-11 + ], + "error_norm_m": 1.0497911868958923e-10 + }, + { + "marker_id": 53, + "link": "Board", + "observed_position_m": [ + 0.4862500000517348, + 0.21224000012342684, + -0.0272999998529145 + ], + "predicted_position_m": [ + 0.48625000002512525, + 0.21224000008887617, + -0.027299999850401747 + ], + "error_m": [ + -2.6609547898459596e-11, + -3.455066788227157e-11, + 2.512753893846309e-12 + ], + "error_norm_m": 4.3682154509621976e-11 + }, + { + "marker_id": 54, + "link": "Board", + "observed_position_m": [ + 0.3422700000437526, + -0.33058999996416577, + -0.027299999980765946 + ], + "predicted_position_m": [ + 0.34226999999716995, + -0.3305899999037086, + -0.02729999985770833 + ], + "error_m": [ + -4.6582626644919856e-11, + 6.04571948059629e-11, + 1.2305761618036648e-10 + ], + "error_norm_m": 1.4480397235207513e-10 + }, + { + "marker_id": 55, + "link": "Board", + "observed_position_m": [ + 0.28371999999534064, + -0.2625799999426046, + -0.027299999890894776 + ], + "predicted_position_m": [ + 0.2837200000006725, + -0.2625799999006933, + -0.027299999854879402 + ], + "error_m": [ + 5.331846075762314e-12, + 4.191130775765828e-11, + 3.601537471031868e-11 + ], + "error_norm_m": 5.551660576852147e-11 + }, + { + "marker_id": 56, + "link": "Board", + "observed_position_m": [ + 0.49868000007035296, + 0.16867000005226573, + -0.027299999952448827 + ], + "predicted_position_m": [ + 0.49868000002288143, + 0.16867000008823602, + -0.027299999851587486 + ], + "error_m": [ + -4.747152670958599e-11, + 3.597028230828414e-11, + 1.0086134011322301e-10 + ], + "error_norm_m": 1.1713418368227034e-10 + }, + { + "marker_id": 58, + "link": "Board", + "observed_position_m": [ + 0.05008999994519926, + -0.21810999987817428, + -0.02729999984143486 + ], + "predicted_position_m": [ + 0.05009000000296277, + -0.2181099998886616, + -0.027299999848149126 + ], + "error_m": [ + 5.776350925357221e-11, + -1.0487305468487307e-11, + -6.714264561002992e-12 + ], + "error_norm_m": 5.909050622453684e-11 + }, + { + "marker_id": 60, + "link": "Board", + "observed_position_m": [ + 0.4343599999899137, + 0.2838100000510186, + -0.02729999991307023 + ], + "predicted_position_m": [ + 0.43436000002881114, + 0.2838100000915484, + -0.027299999847667705 + ], + "error_m": [ + 3.88974408238596e-11, + 4.0529801736965965e-11, + 6.540252367459587e-11 + ], + "error_norm_m": 8.621580965512939e-11 + }, + { + "marker_id": 61, + "link": "Board", + "observed_position_m": [ + -0.022419999971302798, + 0.3358300000719934, + -0.02729999993911315 + ], + "predicted_position_m": [ + -0.022419999968509654, + 0.3358300001150722, + -0.027299999835210594 + ], + "error_m": [ + 2.7931441881623442e-12, + 4.307881829035409e-11, + 1.0390255669734394e-10 + ], + "error_norm_m": 1.1251367707080763e-10 + }, + { + "marker_id": 62, + "link": "Board", + "observed_position_m": [ + 0.4047000000289361, + -0.17509999991515432, + -0.027299999853498125 + ], + "predicted_position_m": [ + 0.4047000000051776, + -0.1750999999069238, + -0.027299999856144765 + ], + "error_m": [ + -2.3758495171222194e-11, + 8.230527370756135e-12, + -2.646639851722199e-12 + ], + "error_norm_m": 2.528264970501467e-11 + }, + { + "marker_id": 63, + "link": "Board", + "observed_position_m": [ + 0.7774000000739654, + -0.2361500000173091, + -0.027299999964334062 + ], + "predicted_position_m": [ + 0.7774000000020334, + -0.23614999992611754, + -0.02729999986668261 + ], + "error_m": [ + -7.193201589927867e-11, + 9.119155430781234e-11, + 9.76514528960859e-11 + ], + "error_norm_m": 1.5174294296976465e-10 + }, + { + "marker_id": 64, + "link": "Board", + "observed_position_m": [ + -0.02127000007871142, + -0.18822999986024366, + -0.027299999770135076 + ], + "predicted_position_m": [ + -0.021269999995498393, + -0.18822999988498657, + -0.02729999984576607 + ], + "error_m": [ + 8.32130267469644e-11, + -2.4742902171581704e-11, + -7.563099452267963e-11 + ], + "error_norm_m": 1.1513759751164288e-10 + }, + { + "marker_id": 66, + "link": "Board", + "observed_position_m": [ + 0.20975000000209715, + -0.363229999906965, + -0.027299999886950692 + ], + "predicted_position_m": [ + 0.2097499999954891, + -0.3632299998968839, + -0.027299999855053082 + ], + "error_m": [ + -6.608047442568932e-12, + 1.0081047108201346e-11, + 3.1897609553688255e-11 + ], + "error_norm_m": 3.409913924193044e-11 + }, + { + "marker_id": 68, + "link": "Board", + "observed_position_m": [ + 0.5737300000365086, + 0.17064000005345875, + -0.027299999959023245 + ], + "predicted_position_m": [ + 0.5737300000229829, + 0.170640000084371, + -0.027299999853422966 + ], + "error_m": [ + -1.352573608670582e-11, + 3.0912244985970005e-11, + 1.0560027852157816e-10 + ], + "error_norm_m": 1.1085996234256408e-10 + }, + { + "marker_id": 69, + "link": "Board", + "observed_position_m": [ + 0.00761000004242595, + -0.2812099999289154, + -0.02729999998318098 + ], + "predicted_position_m": [ + 0.007609999999713185, + -0.28120999988647377, + -0.027299999848355287 + ], + "error_m": [ + -4.271276561607085e-11, + 4.2441605785370484e-11, + 1.3482569227729613e-10 + ], + "error_norm_m": 1.476605483745281e-10 + }, + { + "marker_id": 72, + "link": "Board", + "observed_position_m": [ + 0.4409900000354066, + 0.19432000020221737, + -0.027299999713418663 + ], + "predicted_position_m": [ + 0.4409900000242024, + 0.19432000009120703, + -0.02729999984963093 + ], + "error_m": [ + -1.1204204231063386e-11, + -1.1101033980942532e-10, + -1.3621226715998525e-10 + ], + "error_norm_m": 1.760755845139202e-10 + }, + { + "marker_id": 75, + "link": "Board", + "observed_position_m": [ + -0.02570000001322527, + 0.19458000011081336, + -0.027299999917136667 + ], + "predicted_position_m": [ + -0.025699999975783934, + 0.19458000011524126, + -0.02729999983796592 + ], + "error_m": [ + 3.744133475480638e-11, + 4.427902489112512e-12, + 7.917074634766763e-11 + ], + "error_norm_m": 8.768960568916528e-11 + }, + { + "marker_id": 79, + "link": "Board", + "observed_position_m": [ + 0.312300000016258, + -0.15910999989937752, + -0.027299999860245398 + ], + "predicted_position_m": [ + 0.3123000000060011, + -0.1591099999021653, + -0.027299999853515052 + ], + "error_m": [ + -1.0256906435301971e-11, + -2.787770014833768e-12, + 6.730345447625297e-12 + ], + "error_norm_m": 1.2580673317534154e-11 + }, + { + "marker_id": 83, + "link": "Board", + "observed_position_m": [ + 0.044159999992374944, + 0.33922000010889536, + -0.027299999906729017 + ], + "predicted_position_m": [ + 0.044160000031664884, + 0.3392200001116434, + -0.027299999836805935 + ], + "error_m": [ + 3.928993935753411e-11, + 2.7480240305521875e-12, + 6.992308121400725e-11 + ], + "error_norm_m": 8.025265264931655e-11 + }, + { + "marker_id": 84, + "link": "Board", + "observed_position_m": [ + 0.4074900000152712, + 0.25842000018675926, + -0.027299999735366415 + ], + "predicted_position_m": [ + 0.4074900000275036, + 0.2584200000929322, + -0.027299999847506397 + ], + "error_m": [ + 1.2232381774168744e-11, + -9.382705723481877e-11, + -1.1213998132864056e-10 + ], + "error_norm_m": 1.467260142088063e-10 + }, + { + "marker_id": 85, + "link": "Board", + "observed_position_m": [ + 0.5045800000185344, + -0.3127499999345801, + -0.027299999823630846 + ], + "predicted_position_m": [ + 0.5045799999980887, + -0.3127499999120675, + -0.02729999986140513 + ], + "error_m": [ + -2.044575619919442e-11, + 2.2512602892987843e-11, + -3.777428370099756e-11 + ], + "error_norm_m": 4.849477028193567e-11 + }, + { + "marker_id": 86, + "link": "Board", + "observed_position_m": [ + 0.3628899999968834, + 0.2920100001214097, + -0.02729999977788188 + ], + "predicted_position_m": [ + 0.3628900000292334, + 0.29201000009522904, + -0.027299999845717387 + ], + "error_m": [ + 3.23500115584352e-11, + -2.6180668744046898e-11, + -6.783550804412286e-11 + ], + "error_norm_m": 7.958396079186222e-11 + }, + { + "marker_id": 92, + "link": "Board", + "observed_position_m": [ + 0.6450900000418279, + -0.18483999992149241, + -0.027299999804719477 + ], + "predicted_position_m": [ + 0.645090000004676, + -0.18483999991930372, + -0.027299999862346318 + ], + "error_m": [ + -3.7151948184543926e-11, + 2.1886936707460336e-12, + -5.762684079924085e-11 + ], + "error_norm_m": 6.859963858791422e-11 + }, + { + "marker_id": 95, + "link": "Board", + "observed_position_m": [ + 0.1860399999967906, + -0.27406999993259007, + -0.02729999989753723 + ], + "predicted_position_m": [ + 0.18604000000008075, + -0.27406999989566283, + -0.027299999852669763 + ], + "error_m": [ + 3.2901459334766514e-12, + 3.6927239044359794e-11, + 4.4867467380305115e-11 + ], + "error_norm_m": 5.820254008911988e-11 + }, + { + "marker_id": 96, + "link": "Board", + "observed_position_m": [ + 0.36977000002277416, + -0.18648999991230544, + -0.02729999985668438 + ], + "predicted_position_m": [ + 0.369770000004591, + -0.1864899999051249, + -0.027299999855500863 + ], + "error_m": [ + -1.8183177186159583e-11, + 7.180533945216894e-12, + 1.1835185609321286e-12 + ], + "error_norm_m": 1.9585421019364308e-11 + }, + { + "marker_id": 97, + "link": "Board", + "observed_position_m": [ + 0.3043499999947372, + -0.35966999991822723, + -0.027299999877075903 + ], + "predicted_position_m": [ + 0.3043499999956724, + -0.35966999990175574, + -0.02729999985734506 + ], + "error_m": [ + 9.351963647930006e-13, + 1.6471490837943747e-11, + 1.973084196027486e-11 + ], + "error_norm_m": 2.5719462030270577e-11 + }, + { + "marker_id": 102, + "link": "Board", + "observed_position_m": [ + 0.6496900000995376, + -0.22299999998754086, + -0.02729999992976496 + ], + "predicted_position_m": [ + 0.6496900000027108, + -0.2229999999195406, + -0.027299999863227762 + ], + "error_m": [ + -9.682676882505348e-11, + 6.800027207987114e-11, + 6.65371993613384e-11 + ], + "error_norm_m": 1.3574483070410947e-10 + }, + { + "marker_id": 103, + "link": "Board", + "observed_position_m": [ + 0.10570999992031617, + -0.18770999986209555, + -0.02729999976984459 + ], + "predicted_position_m": [ + 0.10571000000452832, + -0.187709999891526, + -0.027299999848928096 + ], + "error_m": [ + 8.42121511412941e-11, + -2.9430458070578425e-11, + -7.908350710406076e-11 + ], + "error_norm_m": 1.192142581991192e-10 + }, + { + "marker_id": 105, + "link": "Board", + "observed_position_m": [ + 0.5248400000183366, + -0.2662499999346213, + -0.027299999824223993 + ], + "predicted_position_m": [ + 0.5248400000004835, + -0.2662499999131108, + -0.027299999860977264 + ], + "error_m": [ + -1.7853163392089755e-11, + 2.1510460079809945e-11, + -3.6753270565847984e-11 + ], + "error_norm_m": 4.617616520713017e-11 + }, + { + "marker_id": 113, + "link": "Arm2", + "observed_position_m": [ + 0.2804165953039367, + -0.19872244751640883, + 0.3505887458428963 + ], + "predicted_position_m": [ + 0.24977194249877693, + -0.1584720183887424, + 0.1868814818684093 + ], + "error_m": [ + -0.030644652805159767, + 0.04025042912766644, + -0.16370726397448698 + ], + "error_norm_m": 0.17134544075791 + }, + { + "marker_id": 124, + "link": "Arm2", + "observed_position_m": [ + 0.3179512440276115, + -0.23900721775693098, + 0.3721039418447169 + ], + "predicted_position_m": [ + 0.23112027001432411, + -0.20903984461274458, + 0.2111510114168477 + ], + "error_m": [ + -0.08683097401328738, + 0.029967373144186404, + -0.1609529304278692 + ], + "error_norm_m": 0.18532001325970596 + }, + { + "marker_id": 198, + "link": "Arm1", + "observed_position_m": [ + 0.1305694369342163, + -0.0738931537004449, + 0.19069456152916994 + ], + "predicted_position_m": [ + 0.17270235666437775, + -0.05576879813149038, + 0.05881351330514362 + ], + "error_m": [ + 0.04213291973016145, + 0.018124355568954517, + -0.13188104822402633 + ], + "error_norm_m": 0.1396291018034782 + }, + { + "marker_id": 205, + "link": "Board", + "observed_position_m": [ + 0.7500000000651522, + -0.08999999999118834, + 0.00030000004390770064 + ], + "predicted_position_m": [ + 0.7500000000102496, + -0.08999999992526098, + 0.00030000013693766095 + ], + "error_m": [ + -5.490263799146078e-11, + 6.59273607928057e-11, + 9.302996030859448e-11 + ], + "error_norm_m": 1.2655153130067147e-10 + }, + { + "marker_id": 206, + "link": "Board", + "observed_position_m": [ + 0.6500000000075417, + -0.009999999882410456, + 0.0003000001917369764 + ], + "predicted_position_m": [ + 0.6500000000143696, + -0.009999999920111104, + 0.0003000001410430143 + ], + "error_m": [ + 6.827982623747175e-12, + -3.7700648158889294e-11, + -5.069396210319668e-11 + ], + "error_norm_m": 6.354398486112511e-11 + }, + { + "marker_id": 207, + "link": "Board", + "observed_position_m": [ + 0.7500000000486273, + -0.009999999939664835, + 0.00030000006839689885 + ], + "predicted_position_m": [ + 0.7500000000143695, + -0.00999999992526104, + 0.0003000001385446136 + ], + "error_m": [ + -3.425781880395107e-11, + 1.4403794129647096e-11, + 7.014771473108986e-11 + ], + "error_norm_m": 7.938368419598551e-11 + }, + { + "marker_id": 208, + "link": "Board", + "observed_position_m": [ + 0.3499999999386543, + -0.08999999975261576, + 0.00030000042723117164 + ], + "predicted_position_m": [ + 0.3500000000102497, + -0.08999999990466123, + 0.00030000014693126384 + ], + "error_m": [ + 7.159539627821232e-11, + -1.5204547343383723e-10, + -2.8029990779615196e-10 + ], + "error_norm_m": 3.268206925371851e-10 + }, + { + "marker_id": 210, + "link": "Board", + "observed_position_m": [ + 0.019999999971557846, + -0.019999999802751654, + 0.00030000020400658975 + ], + "predicted_position_m": [ + 0.020000000013854876, + -0.0199999998876665, + 0.00030000015658206977 + ], + "error_m": [ + 4.2297030461435625e-11, + -8.491484598804888e-11, + -4.74245199859856e-11 + ], + "error_norm_m": 1.0605967636633078e-10 + }, + { + "marker_id": 211, + "link": "Board", + "observed_position_m": [ + 0.24999999993167737, + -0.009999999908451308, + 0.00030000022431341585 + ], + "predicted_position_m": [ + 0.2500000000143698, + -0.009999999899511358, + 0.0003000001510366172 + ], + "error_m": [ + 8.269240847624815e-11, + 8.939949475150755e-12, + -7.327679863713618e-11 + ], + "error_norm_m": 1.1084875432195134e-10 + }, + { + "marker_id": 214, + "link": "Board", + "observed_position_m": [ + 0.34999999993241016, + -0.009999999774234655, + 0.00030000038849146895 + ], + "predicted_position_m": [ + 0.3500000000143697, + -0.009999999904661295, + 0.0003000001485382165 + ], + "error_m": [ + 8.195955025769308e-11, + -1.3042663997431259e-10, + -2.399532524717182e-10 + ], + "error_norm_m": 2.851421394062765e-10 + }, + { + "marker_id": 217, + "link": "Board", + "observed_position_m": [ + 0.650000000043315, + -0.08999999989818294, + 0.000300000219976508 + ], + "predicted_position_m": [ + 0.6500000000102497, + -0.08999999992011104, + 0.0003000001394360617 + ], + "error_m": [ + -3.306532825320119e-11, + -2.1928098226098314e-11, + -8.054044632827342e-11 + ], + "error_norm_m": 8.97826314999892e-11 + }, + { + "marker_id": 229, + "link": "Arm1", + "observed_position_m": [ + 0.16640168506027175, + -0.15182653993183387, + 0.16344669721760172 + ], + "predicted_position_m": [ + 0.1727023566593537, + -0.14342521047080634, + 0.03840877425268385 + ], + "error_m": [ + 0.006300671599081958, + 0.008401329461027535, + -0.12503792296491786 + ], + "error_norm_m": 0.12547813745307562 + }, + { + "marker_id": 243, + "link": "Arm1", + "observed_position_m": [ + 0.1684798904699227, + -0.17155983163860805, + 0.11809996732683645 + ], + "predicted_position_m": [ + 0.1727023566569569, + -0.16957863897125047, + -0.003615006844117849 + ], + "error_m": [ + 0.004222466187034202, + 0.0019811926673575786, + -0.1217149741709543 + ], + "error_norm_m": 0.12180430732335336 + }, + { + "marker_id": 244, + "link": "Ellbow", + "observed_position_m": [ + 0.25553896045148, + -0.02006453590532172, + 0.06102532438145439 + ], + "predicted_position_m": [ + 0.2977023566586652, + -0.135490034179065, + 0.004320169450937953 + ], + "error_m": [ + 0.04216339620718518, + -0.11542549827374328, + -0.056705154930516435 + ], + "error_norm_m": 0.13533762310296374 + }, + { + "marker_id": 245, + "link": "Ellbow", + "observed_position_m": [ + 0.2406129407047614, + -0.06726361904699338, + 0.060863852611482507 + ], + "predicted_position_m": [ + 0.26270235665676245, + -0.16919495731357542, + -0.005112653899266803 + ], + "error_m": [ + 0.022089415952001035, + -0.10193133826658204, + -0.06597650651074931 + ], + "error_norm_m": 0.12341328708562882 + } + ] +} \ No newline at end of file diff --git a/data/evaluations/Scene9/v8_ellbow_angle.json b/data/evaluations/Scene9/v8_ellbow_angle.json new file mode 100644 index 0000000..e3a578e --- /dev/null +++ b/data/evaluations/Scene9/v8_ellbow_angle.json @@ -0,0 +1,36 @@ +{ + "status": "ok", + "link": "Ellbow", + "joint": "z", + "joint_origin_world_mm": [ + 110.0, + -142.0, + 61.0 + ], + "joint_axis_world": [ + -1.0, + 0.0, + 0.0 + ], + "mean_angle_deg": 89.81322357423196, + "circular_variance": 0.0, + "circular_std_deg": 0.0, + "num_pairs_used": 1, + "num_markers_matched": 2, + "per_pair": [ + { + "marker_ids": [ + 244, + 245 + ], + "skipped": false, + "angle_deg": 89.81322357423196, + "baseline_model_mm": 35.0, + "baseline_obs_mm": 47.200207318946944, + "weight": 1652.007256163143 + } + ], + "accumulated_state": { + "z": 89.81322357423196 + } +} \ No newline at end of file diff --git a/data/evaluations/Scene9/v8_z_correction.json b/data/evaluations/Scene9/v8_z_correction.json new file mode 100644 index 0000000..9b823b3 --- /dev/null +++ b/data/evaluations/Scene9/v8_z_correction.json @@ -0,0 +1,20 @@ +{ + "schema_version": "1.0", + "created_utc": "2026-06-01T17:39:38Z", + "elbow_link": "Ellbow", + "z_correction_mm": 54.81633454946478, + "n_markers_used": 2, + "z_deltas_mm": [ + 54.79644907884058, + 54.83622002008897 + ], + "corrected_pose_files": [ + "C:\\Users\\kech\\SynologyDrive\\2026-AppServer-AppRobot\\appRobotRendering\\data\\evaluations\\Scene9\\render_a_camera_pose_v8.json", + "C:\\Users\\kech\\SynologyDrive\\2026-AppServer-AppRobot\\appRobotRendering\\data\\evaluations\\Scene9\\render_b_camera_pose_v8.json", + "C:\\Users\\kech\\SynologyDrive\\2026-AppServer-AppRobot\\appRobotRendering\\data\\evaluations\\Scene9\\render_c_camera_pose_v8.json", + "C:\\Users\\kech\\SynologyDrive\\2026-AppServer-AppRobot\\appRobotRendering\\data\\evaluations\\Scene9\\render_d_camera_pose_v8.json", + "C:\\Users\\kech\\SynologyDrive\\2026-AppServer-AppRobot\\appRobotRendering\\data\\evaluations\\Scene9\\render_e_camera_pose_v8.json", + "C:\\Users\\kech\\SynologyDrive\\2026-AppServer-AppRobot\\appRobotRendering\\data\\evaluations\\Scene9\\render_f_camera_pose_v8.json", + "C:\\Users\\kech\\SynologyDrive\\2026-AppServer-AppRobot\\appRobotRendering\\data\\evaluations\\Scene9\\render_g_camera_pose_v8.json" + ] +} \ No newline at end of file diff --git a/data/robot/robot.json b/data/robot/robot.json index a3ff122..a6d5358 100644 --- a/data/robot/robot.json +++ b/data/robot/robot.json @@ -1,26 +1,89 @@ { - "coordinateSystem": {"handedness": "right", "x": "right", "y": "backward", "z": "up"}, - "units": {"length": "mm", "rotation": "degree"}, - "vision_config": {"MarkerType": "DICT_4X4_250", "MarkerSize": 0.025}, + "coordinateSystem": { + "handedness": "right", + "x": "right", + "y": "backward", + "z": "up" + }, + "units": { + "length": "mm", + "rotation": "degree" + }, + "vision_config": { + "MarkerType": "DICT_4X4_250", + "MarkerSize": 0.025 + }, "renderingInfo": { - "width": 4896, - "height": 3264, - "cameraPosition__1": [-10, -800, 500], - "cameraPosition__2": [-500, 300, 1200], - "cameraPosition__3": [-200, -900, 200], - "cameraPosition__4": [1200, 200, 300], - "cameraPosition_a": [-300, -800, 500], - "cameraPosition": [-200, 200, 1400], - "cameraPosition_c": [600, -500, 600], - "cameraTarget": [200, -200, 180], - "cameraUpVector": [0, 0, 1], - "lightPosition": [-500, -500, 500], - "lightTarget": [0, 0, 0], - "lightUpVector": [0, 0, 1], + "width": 1280, + "height": 720, + "cameraPosition__1": [ + -10, + -800, + 500 + ], + "cameraPosition__2": [ + -500, + 300, + 1200 + ], + "cameraPosition__3": [ + -200, + -900, + 200 + ], + "cameraPosition__4": [ + 1200, + 200, + 300 + ], + "cameraPosition_a": [ + -300, + -800, + 500 + ], + "cameraPosition": [ + 500, + -300, + 1400 + ], + "cameraPosition_c": [ + 600, + -500, + 600 + ], + "cameraTarget": [ + 200, + -200, + 180 + ], + "cameraUpVector": [ + 0, + 0, + 1 + ], + "lightPosition": [ + -500, + -500, + 500 + ], + "lightTarget": [ + 0, + 0, + 0 + ], + "lightUpVector": [ + 0, + 0, + 1 + ], "metric": "mm", "showSkeleton": true, "showMarkers": true, - "backgroundColor": [0.7, 0.85, 1.0], + "backgroundColor": [ + 0.7, + 0.85, + 1.0 + ], "backgroundStrength": 0.2, "sunEnergy": 0.35, "areaEnergy": 120, @@ -28,7 +91,7 @@ "lensDirt": true, "lensDirtStrength": 0.08, "dofEnabled": true, - "dofFStop": 5.6, + "dofFStop": 11.0, "arucoDust": false, "arucoDustStrength": 5e-05, "localizedBlur": false, @@ -40,25 +103,141 @@ "lensDistortion": true, "lensDistortionStrength": 0.002, "materials": { - "wood": {"baseColor": [0.72, 0.52, 0.33], "roughness": 0.85, "metallic": 0.0}, - "plaWhite": {"baseColor": [0.95, 0.95, 0.95], "roughness": 0.45, "metallic": 0.0}, - "steel": {"baseColor": [0.72, 0.72, 0.75], "roughness": 0.25, "metallic": 1.0}, - "powderCoatBlue": {"baseColor": [0.15, 0.25, 0.7], "roughness": 0.55, "metallic": 0.0}, - "defaultPlastic": {"baseColor": [0.95, 0.95, 0.95], "roughness": 0.4, "metallic": 0.0}, - "skeletonRed": {"baseColor": [0.85, 0.2, 0.2], "roughness": 0.35, "metallic": 0.0}, - "markerBlack": {"baseColor": [0.04, 0.04, 0.04], "roughness": 0.8, "metallic": 0.0} + "wood": { + "baseColor": [ + 0.72, + 0.52, + 0.33 + ], + "roughness": 0.85, + "metallic": 0.0 + }, + "plaWhite": { + "baseColor": [ + 0.95, + 0.95, + 0.95 + ], + "roughness": 0.45, + "metallic": 0.0 + }, + "steel": { + "baseColor": [ + 0.72, + 0.72, + 0.75 + ], + "roughness": 0.25, + "metallic": 1.0 + }, + "powderCoatBlue": { + "baseColor": [ + 0.15, + 0.25, + 0.7 + ], + "roughness": 0.55, + "metallic": 0.0 + }, + "defaultPlastic": { + "baseColor": [ + 0.95, + 0.95, + 0.95 + ], + "roughness": 0.4, + "metallic": 0.0 + }, + "skeletonRed": { + "baseColor": [ + 0.85, + 0.2, + 0.2 + ], + "roughness": 0.35, + "metallic": 0.0 + }, + "markerBlack": { + "baseColor": [ + 0.04, + 0.04, + 0.04 + ], + "roughness": 0.8, + "metallic": 0.0 + } }, - "skeletonDefaults": {"radius": 4, "color": [0.85, 0.2, 0.2]}, - "markerDefaults": {"size": 25, "thickness": 1, "color": [0.04, 0.04, 0.04]}, - "defaultPosition": {"x": 80, "y": 20, "z": 80, "a": -120, "b": 23, "c": 9, "e": 3} + "skeletonDefaults": { + "radius": 4, + "color": [ + 0.85, + 0.2, + 0.2 + ] + }, + "markerDefaults": { + "size": 25, + "thickness": 1, + "color": [ + 0.04, + 0.04, + 0.04 + ] + }, + "defaultPosition": { + "x": 80, + "y": 20, + "z": 80, + "a": -120, + "b": 23, + "c": 9, + "e": 3 + } + }, + "defaultPosition__": { + "x": 10, + "y": 4, + "z": 20, + "a": 10, + "b": 2, + "c": 9, + "e": 1 + }, + "defaultPosition": { + "x": 30, + "y": -2, + "z": 95, + "a": 20, + "b": 23, + "c": 9, + "e": 9 + }, + "recognized": { + "x": null, + "y": null, + "z": null, + "a": null, + "b": null, + "c": null, + "e": null }, - "defaultPosition__": {"x": 10, "y": 4, "z": 20, "a": 10, "b": 2, "c": 9, "e": 1}, - "defaultPosition": {"x": 60, "y": -2, "z": 95, "a": 200, "b": 60, "c": 9, "e": 8}, - "recognized": {"x": null, "y": null, "z": null, "a": null, "b": null, "c": null, "e": null}, "constraint_rules": { - "rigid_distance": {"enabled": true, "mode": "mst", "weight": 1.0}, - "joint_axis_projection": {"enabled": true, "max_pairs": 2, "weight": 0.35}, - "chain_axis_projection": {"enabled": false, "max_depth": 3, "max_pairs": 2, "weight": 0.15}, + "rigid_distance": { + "enabled": true, + "mode": "mst", + "weight": 1.0 + }, + "joint_axis_projection": { + "enabled": true, + "max_pairs": 2, + "weight": 0.35 + }, + "chain_axis_projection": { + "enabled": false, + "max_depth": 3, + "max_pairs": 2, + "weight": 0.15 + }, "axis_alignment_threshold": 0.95 }, "observation_weighting": { @@ -85,19 +264,199 @@ "weight_floor": 0.3 }, "robot_test_poses": { - "sim04": {"x": 70, "y": 50,"z": -70,"a": 120,"b": 50,"c": 30,"e": 20}, - "sim05": {"x": 180,"y": 86,"z": -120,"a": -60,"b": 22,"c": 91,"e": 10}, - "sim06": {"x": 80, "y": 20, "z": 80, "a": -120, "b": 23, "c": 9, "e": 3}, - "sim07": {"x": 30, "y": -2, "z": 95, "a": 20, "b": 23, "c": 9, "e": 9}, - "sim08": {"x": 50, "y": -2, "z": 95, "a": 20, "b": 60, "c": 9, "e": 3}, - "sim09": {"x": 60, "y": -2, "z": 95, "a": 200, "b": 60, "c": 9, "e": 8}, - "sim09a": {"x": 60, "y": -2, "z": 95, "a": 200, "b": 60, "c": 9, "e": 8}, - "sim09b": {"x": 60, "y": -2, "z": 95, "a": 200, "b": 60, "c": 9, "e": 8}, - "sim010": {"x": 120, "y": 60, "z": -110, "a": 20, "b": 30, "c": 180, "e": 4}, - "sim011": {"x": 50, "y": 4, "z": 176, "a": 20, "b": 60, "c": 9, "e": 5}, - "sim012": {"x": 50, "y": 0, "z": 178, "a": 210, "b": 80, "c": 90, "e": 6} - }, - "movements": {"x": null, "y": null, "z": null, "a": null, "b": null, "c": null, "e": null}, + "4": { + "x": 70, + "y": 50, + "z": -70, + "a": 120, + "b": 50, + "c": 30, + "e": 20 + }, + "5": { + "x": 180, + "y": 86, + "z": -120, + "a": -60, + "b": 22, + "c": 91, + "e": 10 + }, + "6": { + "x": 80, + "y": 20, + "z": 80, + "a": -120, + "b": 23, + "c": 9, + "e": 3 + }, + "7": { + "x": 30, + "y": -2, + "z": 95, + "a": 20, + "b": 23, + "c": 9, + "e": 9 + }, + "8": { + "x": 50, + "y": -2, + "z": 95, + "a": 20, + "b": 60, + "c": 9, + "e": 3 + }, + "9": { + "x": 60, + "y": -2, + "z": 95, + "a": 200, + "b": 60, + "c": 9, + "e": 8 + }, + "9a": { + "x": 60, + "y": -2, + "z": 95, + "a": 200, + "b": 60, + "c": 9, + "e": 8, + "rendering": { + "width": 1440, + "height": 1080, + "dofFStop": 11 + } + }, + "9b": { + "x": 60, + "y": -2, + "z": 95, + "a": 200, + "b": 60, + "c": 9, + "e": 8, + "rendering": { + "width": 4896, + "height": 3264, + "dofFStop": 5.6 + } + }, + "10": { + "x": 120, + "y": 60, + "z": -110, + "a": 20, + "b": 30, + "c": 180, + "e": 4 + }, + "11": { + "x": 50, + "y": 4, + "z": 176, + "a": 20, + "b": 60, + "c": 9, + "e": 5 + }, + "12": { + "x": 50, + "y": 0, + "z": 178, + "a": 210, + "b": 80, + "c": 90, + "e": 6 + } + }, + "test_camera_positions": { + "a": [ + -300, + -800, + 800 + ], + "b": [ + 300, + -900, + 1200 + ], + "c": [ + 300, + -900, + 400 + ], + "d": [ + 700, + -800, + 400 + ], + "e": [ + 1200, + -900, + 400 + ], + "f": [ + 500, + -300, + 1400 + ], + "g": [ + -200, + 200, + 1400 + ] + }, + "test_camera_targets": { + "a": [ + 210, + -100, + 180 + ], + "b": [ + 310, + -80, + 180 + ], + "c": [ + 210, + -100, + 150 + ], + "d": [ + 210, + -100, + 150 + ], + "e": [ + 210, + -100, + 50 + ], + "f": [ + 200, + -200, + 180 + ], + "g": [ + 200, + -200, + 180 + ] + }, + "movements": { + "x": null, + "y": null, + "z": null, + "a": null, + "b": null, + "c": null, + "e": null + }, "state_pose_params": { "numbers_of_Elements_to_consider_start": 3, "numbers_of_Elements_to_consider_final": 5, @@ -113,480 +472,1220 @@ "links": { "Board": { "parent": null, - "size": [1000, 200, 25], - "mountPosition": [0, 0, 0], - "mountRotation": [0, 0, 0], + "size": [ + 1000, + 200, + 25 + ], + "mountPosition": [ + 0, + 0, + 0 + ], + "mountRotation": [ + 0, + 0, + 0 + ], "skeleton": { - "from": [0, 0, 16], - "to": [1000, 0, 16], + "from": [ + 0, + 0, + 16 + ], + "to": [ + 1000, + 0, + 16 + ], "radius": 4, - "color": [0.85, 0.2, 0.2] + "color": [ + 0.85, + 0.2, + 0.2 + ] }, "markers": [ - {"id": 210, "position": [20, -20, 0.3], "normal": [0, 0, 1]}, - {"id": 211, "position": [250, -10, 0.3], "normal": [0, 0, 1]}, - {"id": 215, "position": [250, -90, 0.3], "normal": [0, 0, 1]}, - {"id": 214, "position": [350, -10, 0.3], "normal": [0, 0, 1]}, - {"id": 208, "position": [350, -90, 0.3], "normal": [0, 0, 1]}, - {"id": 206, "position": [650, -10, 0.3], "normal": [0, 0, 1]}, - {"id": 205, "position": [750, -90, 0.3], "normal": [0, 0, 1]}, - {"id": 207, "position": [750, -10, 0.3], "normal": [0, 0, 1]}, - {"id": 217, "position": [650, -90, 0.3], "normal": [0, 0, 1]}, + { + "id": 210, + "position": [ + 20, + -20, + 0.3 + ], + "normal": [ + 0, + 0, + 1 + ] + }, + { + "id": 211, + "position": [ + 250, + -10, + 0.3 + ], + "normal": [ + 0, + 0, + 1 + ] + }, + { + "id": 215, + "position": [ + 250, + -90, + 0.3 + ], + "normal": [ + 0, + 0, + 1 + ] + }, + { + "id": 214, + "position": [ + 350, + -10, + 0.3 + ], + "normal": [ + 0, + 0, + 1 + ] + }, + { + "id": 208, + "position": [ + 350, + -90, + 0.3 + ], + "normal": [ + 0, + 0, + 1 + ] + }, + { + "id": 206, + "position": [ + 650, + -10, + 0.3 + ], + "normal": [ + 0, + 0, + 1 + ] + }, + { + "id": 205, + "position": [ + 750, + -90, + 0.3 + ], + "normal": [ + 0, + 0, + 1 + ] + }, + { + "id": 207, + "position": [ + 750, + -10, + 0.3 + ], + "normal": [ + 0, + 0, + 1 + ] + }, + { + "id": 217, + "position": [ + 650, + -90, + 0.3 + ], + "normal": [ + 0, + 0, + 1 + ] + }, { "id": 46, - "position": [536.71, 185.44, -27.3], - "normal": [0, 0, 1], + "position": [ + 536.71, + 185.44, + -27.3 + ], + "normal": [ + 0, + 0, + 1 + ], "spin": 90, "info": "is placed on a white paper, A0_60Arucos_25mm_Seet223.pdf, with the following marker placements:" }, { "id": 47, - "position": [344.23, -286.54, -27.3], - "normal": [0, 0, 1], + "position": [ + 344.23, + -286.54, + -27.3 + ], + "normal": [ + 0, + 0, + 1 + ], "spin": 90 }, { "id": 48, - "position": [688.69, -320.72, -27.3], - "normal": [0, 0, 1], + "position": [ + 688.69, + -320.72, + -27.3 + ], + "normal": [ + 0, + 0, + 1 + ], "spin": 90 }, { "id": 49, - "position": [1006.0, 158.33, -27.3], - "normal": [0, 0, 1], + "position": [ + 1006.0, + 158.33, + -27.3 + ], + "normal": [ + 0, + 0, + 1 + ], "spin": 90 }, { "id": 50, - "position": [573.41, 211.86, -27.3], - "normal": [0, 0, 1], + "position": [ + 573.41, + 211.86, + -27.3 + ], + "normal": [ + 0, + 0, + 1 + ], "spin": 90 }, { "id": 51, - "position": [167.8, -172.08, -27.3], - "normal": [0, 0, 1], + "position": [ + 167.8, + -172.08, + -27.3 + ], + "normal": [ + 0, + 0, + 1 + ], "spin": 90 }, { "id": 52, - "position": [94.68, 208.66, -27.3], - "normal": [0, 0, 1], + "position": [ + 94.68, + 208.66, + -27.3 + ], + "normal": [ + 0, + 0, + 1 + ], "spin": 90 }, { "id": 53, - "position": [486.25, 212.24, -27.3], - "normal": [0, 0, 1], + "position": [ + 486.25, + 212.24, + -27.3 + ], + "normal": [ + 0, + 0, + 1 + ], "spin": 90 }, { "id": 54, - "position": [342.27, -330.59, -27.3], - "normal": [0, 0, 1], + "position": [ + 342.27, + -330.59, + -27.3 + ], + "normal": [ + 0, + 0, + 1 + ], "spin": 90 }, { "id": 55, - "position": [283.72, -262.58, -27.3], - "normal": [0, 0, 1], + "position": [ + 283.72, + -262.58, + -27.3 + ], + "normal": [ + 0, + 0, + 1 + ], "spin": 90 }, { "id": 56, - "position": [498.68, 168.67, -27.3], - "normal": [0, 0, 1], + "position": [ + 498.68, + 168.67, + -27.3 + ], + "normal": [ + 0, + 0, + 1 + ], "spin": 90 }, { "id": 57, - "position": [602.86, -364.05, -27.3], - "normal": [0, 0, 1], + "position": [ + 602.86, + -364.05, + -27.3 + ], + "normal": [ + 0, + 0, + 1 + ], "spin": 90 }, { "id": 58, - "position": [50.09, -218.11, -27.3], - "normal": [0, 0, 1], + "position": [ + 50.09, + -218.11, + -27.3 + ], + "normal": [ + 0, + 0, + 1 + ], "spin": 90 }, { "id": 59, - "position": [626.21, -278.75, -27.3], - "normal": [0, 0, 1], + "position": [ + 626.21, + -278.75, + -27.3 + ], + "normal": [ + 0, + 0, + 1 + ], "spin": 90 }, { "id": 60, - "position": [434.36, 283.81, -27.3], - "normal": [0, 0, 1], + "position": [ + 434.36, + 283.81, + -27.3 + ], + "normal": [ + 0, + 0, + 1 + ], "spin": 90 }, { "id": 61, - "position": [-22.42, 335.83, -27.3], - "normal": [0, 0, 1], + "position": [ + -22.42, + 335.83, + -27.3 + ], + "normal": [ + 0, + 0, + 1 + ], "spin": 90 }, { "id": 62, - "position": [404.7, -175.1, -27.3], - "normal": [0, 0, 1], + "position": [ + 404.7, + -175.1, + -27.3 + ], + "normal": [ + 0, + 0, + 1 + ], "spin": 90 }, { "id": 63, - "position": [777.4, -236.15, -27.3], - "normal": [0, 0, 1], + "position": [ + 777.4, + -236.15, + -27.3 + ], + "normal": [ + 0, + 0, + 1 + ], "spin": 90 }, { "id": 64, - "position": [-21.27, -188.23, -27.3], - "normal": [0, 0, 1], + "position": [ + -21.27, + -188.23, + -27.3 + ], + "normal": [ + 0, + 0, + 1 + ], "spin": 90 }, { "id": 65, - "position": [803.39, -297.37, -27.3], - "normal": [0, 0, 1], + "position": [ + 803.39, + -297.37, + -27.3 + ], + "normal": [ + 0, + 0, + 1 + ], "spin": 90 }, { "id": 66, - "position": [209.75, -363.23, -27.3], - "normal": [0, 0, 1], + "position": [ + 209.75, + -363.23, + -27.3 + ], + "normal": [ + 0, + 0, + 1 + ], "spin": 90 }, { "id": 67, - "position": [523.07, 267.04, -27.3], - "normal": [0, 0, 1], + "position": [ + 523.07, + 267.04, + -27.3 + ], + "normal": [ + 0, + 0, + 1 + ], "spin": 90 }, { "id": 68, - "position": [573.73, 170.64, -27.3], - "normal": [0, 0, 1], + "position": [ + 573.73, + 170.64, + -27.3 + ], + "normal": [ + 0, + 0, + 1 + ], "spin": 90 }, { "id": 69, - "position": [7.61, -281.21, -27.3], - "normal": [0, 0, 1], + "position": [ + 7.61, + -281.21, + -27.3 + ], + "normal": [ + 0, + 0, + 1 + ], "spin": 90 }, { "id": 70, - "position": [601.87, 300.33, -27.3], - "normal": [0, 0, 1], + "position": [ + 601.87, + 300.33, + -27.3 + ], + "normal": [ + 0, + 0, + 1 + ], "spin": 90 }, { "id": 71, - "position": [749.75, -284.01, -27.3], - "normal": [0, 0, 1], + "position": [ + 749.75, + -284.01, + -27.3 + ], + "normal": [ + 0, + 0, + 1 + ], "spin": 90 }, { "id": 72, - "position": [440.99, 194.32, -27.3], - "normal": [0, 0, 1], + "position": [ + 440.99, + 194.32, + -27.3 + ], + "normal": [ + 0, + 0, + 1 + ], "spin": 90 }, { "id": 73, - "position": [221.73, 333.11, -27.3], - "normal": [0, 0, 1], + "position": [ + 221.73, + 333.11, + -27.3 + ], + "normal": [ + 0, + 0, + 1 + ], "spin": 90 }, { "id": 74, - "position": [93.78, 144.5, -27.3], - "normal": [0, 0, 1], + "position": [ + 93.78, + 144.5, + -27.3 + ], + "normal": [ + 0, + 0, + 1 + ], "spin": 90 }, { "id": 75, - "position": [-25.7, 194.58, -27.3], - "normal": [0, 0, 1], + "position": [ + -25.7, + 194.58, + -27.3 + ], + "normal": [ + 0, + 0, + 1 + ], "spin": 90 }, { "id": 76, - "position": [685.21, 166.8, -27.3], - "normal": [0, 0, 1], + "position": [ + 685.21, + 166.8, + -27.3 + ], + "normal": [ + 0, + 0, + 1 + ], "spin": 90 }, { "id": 77, - "position": [18.19, 191.57, -27.3], - "normal": [0, 0, 1], + "position": [ + 18.19, + 191.57, + -27.3 + ], + "normal": [ + 0, + 0, + 1 + ], "spin": 90 }, { "id": 78, - "position": [823.11, -344.38, -27.3], - "normal": [0, 0, 1], + "position": [ + 823.11, + -344.38, + -27.3 + ], + "normal": [ + 0, + 0, + 1 + ], "spin": 90 }, { "id": 79, - "position": [312.3, -159.11, -27.3], - "normal": [0, 0, 1], + "position": [ + 312.3, + -159.11, + -27.3 + ], + "normal": [ + 0, + 0, + 1 + ], "spin": 90 }, { "id": 80, - "position": [863.59, -335.92, -27.3], - "normal": [0, 0, 1], + "position": [ + 863.59, + -335.92, + -27.3 + ], + "normal": [ + 0, + 0, + 1 + ], "spin": 90 }, { "id": 81, - "position": [132.14, 169.03, -27.3], - "normal": [0, 0, 1], + "position": [ + 132.14, + 169.03, + -27.3 + ], + "normal": [ + 0, + 0, + 1 + ], "spin": 90 }, { "id": 82, - "position": [219.16, 297.24, -27.3], - "normal": [0, 0, 1], + "position": [ + 219.16, + 297.24, + -27.3 + ], + "normal": [ + 0, + 0, + 1 + ], "spin": 90 }, { "id": 83, - "position": [44.16, 339.22, -27.3], - "normal": [0, 0, 1], + "position": [ + 44.16, + 339.22, + -27.3 + ], + "normal": [ + 0, + 0, + 1 + ], "spin": 90 }, { "id": 84, - "position": [407.49, 258.42, -27.3], - "normal": [0, 0, 1], + "position": [ + 407.49, + 258.42, + -27.3 + ], + "normal": [ + 0, + 0, + 1 + ], "spin": 90 }, { "id": 85, - "position": [504.58, -312.75, -27.3], - "normal": [0, 0, 1], + "position": [ + 504.58, + -312.75, + -27.3 + ], + "normal": [ + 0, + 0, + 1 + ], "spin": 90 }, { "id": 86, - "position": [362.89, 292.01, -27.3], - "normal": [0, 0, 1], + "position": [ + 362.89, + 292.01, + -27.3 + ], + "normal": [ + 0, + 0, + 1 + ], "spin": 90 }, { "id": 87, - "position": [943.63, -245.76, -27.3], - "normal": [0, 0, 1], + "position": [ + 943.63, + -245.76, + -27.3 + ], + "normal": [ + 0, + 0, + 1 + ], "spin": 90 }, { "id": 88, - "position": [765.87, 316.04, -27.3], - "normal": [0, 0, 1], + "position": [ + 765.87, + 316.04, + -27.3 + ], + "normal": [ + 0, + 0, + 1 + ], "spin": 90 }, { "id": 89, - "position": [988.02, -369.14, -27.3], - "normal": [0, 0, 1], + "position": [ + 988.02, + -369.14, + -27.3 + ], + "normal": [ + 0, + 0, + 1 + ], "spin": 90 }, { "id": 90, - "position": [643.17, 316.43, -27.3], - "normal": [0, 0, 1], + "position": [ + 643.17, + 316.43, + -27.3 + ], + "normal": [ + 0, + 0, + 1 + ], "spin": 90 }, { "id": 91, - "position": [723.35, 328.05, -27.3], - "normal": [0, 0, 1], + "position": [ + 723.35, + 328.05, + -27.3 + ], + "normal": [ + 0, + 0, + 1 + ], "spin": 90 }, { "id": 92, - "position": [645.09, -184.84, -27.3], - "normal": [0, 0, 1], + "position": [ + 645.09, + -184.84, + -27.3 + ], + "normal": [ + 0, + 0, + 1 + ], "spin": 90 }, { "id": 93, - "position": [934.88, 143.6, -27.3], - "normal": [0, 0, 1], + "position": [ + 934.88, + 143.6, + -27.3 + ], + "normal": [ + 0, + 0, + 1 + ], "spin": 90 }, { "id": 94, - "position": [875.7, 173.65, -27.3], - "normal": [0, 0, 1], + "position": [ + 875.7, + 173.65, + -27.3 + ], + "normal": [ + 0, + 0, + 1 + ], "spin": 90 }, { "id": 95, - "position": [186.04, -274.07, -27.3], - "normal": [0, 0, 1], + "position": [ + 186.04, + -274.07, + -27.3 + ], + "normal": [ + 0, + 0, + 1 + ], "spin": 90 }, { "id": 96, - "position": [369.77, -186.49, -27.3], - "normal": [0, 0, 1], + "position": [ + 369.77, + -186.49, + -27.3 + ], + "normal": [ + 0, + 0, + 1 + ], "spin": 90 }, { "id": 97, - "position": [304.35, -359.67, -27.3], - "normal": [0, 0, 1], + "position": [ + 304.35, + -359.67, + -27.3 + ], + "normal": [ + 0, + 0, + 1 + ], "spin": 90 }, { "id": 98, - "position": [575.27, 315.06, -27.3], - "normal": [0, 0, 1], + "position": [ + 575.27, + 315.06, + -27.3 + ], + "normal": [ + 0, + 0, + 1 + ], "spin": 90 }, { "id": 99, - "position": [959.16, -321.55, -27.3], - "normal": [0, 0, 1], + "position": [ + 959.16, + -321.55, + -27.3 + ], + "normal": [ + 0, + 0, + 1 + ], "spin": 90 }, { "id": 100, - "position": [803.25, 172.36, -27.3], - "normal": [0, 0, 1], + "position": [ + 803.25, + 172.36, + -27.3 + ], + "normal": [ + 0, + 0, + 1 + ], "spin": 90 }, { "id": 101, - "position": [117.7, 298.66, -27.3], - "normal": [0, 0, 1], + "position": [ + 117.7, + 298.66, + -27.3 + ], + "normal": [ + 0, + 0, + 1 + ], "spin": 90 }, { "id": 102, - "position": [649.69, -223.0, -27.3], - "normal": [0, 0, 1], + "position": [ + 649.69, + -223.0, + -27.3 + ], + "normal": [ + 0, + 0, + 1 + ], "spin": 90 }, { "id": 103, - "position": [105.71, -187.71, -27.3], - "normal": [0, 0, 1], + "position": [ + 105.71, + -187.71, + -27.3 + ], + "normal": [ + 0, + 0, + 1 + ], "spin": 90 }, { "id": 104, - "position": [826.71, 239.16, -27.3], - "normal": [0, 0, 1], + "position": [ + 826.71, + 239.16, + -27.3 + ], + "normal": [ + 0, + 0, + 1 + ], "spin": 90 }, { "id": 105, - "position": [524.84, -266.25, -27.3], - "normal": [0, 0, 1], + "position": [ + 524.84, + -266.25, + -27.3 + ], + "normal": [ + 0, + 0, + 1 + ], "spin": 90 } ], "model": [ { "stlFile": "surfaces/Board.stl", - "originOfModel": [0, 0, 0], - "rotationOfModelDegree": [0, 0, -90], + "originOfModel": [ + 0, + 0, + 0 + ], + "rotationOfModelDegree": [ + 0, + 0, + -90 + ], "material": "wood" }, { "stlFile": "surfaces/BoardRail.stl", - "originOfModel": [0, 0, 0], - "rotationOfModelDegree": [0, 0, -90], + "originOfModel": [ + 0, + 0, + 0 + ], + "rotationOfModelDegree": [ + 0, + 0, + -90 + ], "material": "steel" } ] }, "Base": { "parent": "Board", - "size": [150, 200, 150], - "mountPosition": [0, 0, 0], - "mountRotation": [0, 0, 0], + "size": [ + 150, + 200, + 150 + ], + "mountPosition": [ + 0, + 0, + 0 + ], + "mountRotation": [ + 0, + 0, + 0 + ], "jointToParent": { "name": "Slider", "type": "linear", - "axis": [1, 0, 0], - "origin": [0, 0, 16], - "rotation": [0, 0, 0], + "axis": [ + 1, + 0, + 0 + ], + "origin": [ + 0, + 0, + 16 + ], + "rotation": [ + 0, + 0, + 0 + ], "variable": "x" }, "skeleton": { - "from": [0, 108, 45], - "to": [110, 108, 45], + "from": [ + 0, + 108, + 45 + ], + "to": [ + 110, + 108, + 45 + ], "radius": 4, - "color": [0.2, 0.8, 0.2] + "color": [ + 0.2, + 0.8, + 0.2 + ] }, "markers": [], "model": [ { "stlFile": "surfaces/Base.stl", - "originOfModel": [-30, 0, -35], - "rotationOfModelDegree": [0, 0, 0], + "originOfModel": [ + -30, + 0, + -35 + ], + "rotationOfModelDegree": [ + 0, + 0, + 0 + ], "material": "plaWhite" } ] }, "Arm1": { "parent": "Base", - "size": [70, 250, 70], - "mountPosition": [0, 0, 0], - "mountRotation": [0, 0, 0], + "size": [ + 70, + 250, + 70 + ], + "mountPosition": [ + 0, + 0, + 0 + ], + "mountRotation": [ + 0, + 0, + 0 + ], "jointToParent": { "name": "Joint1", "type": "revolute", - "axis": [-1, 0, 0], - "origin": [110, 108, 45], - "rotation": [0, 0, 0], + "axis": [ + -1, + 0, + 0 + ], + "origin": [ + 110, + 108, + 45 + ], + "rotation": [ + 0, + 0, + 0 + ], "variable": "y" }, "skeleton": { - "from": [0, 0, 0], - "to": [0, -250, 0], + "from": [ + 0, + 0, + 0 + ], + "to": [ + 0, + -250, + 0 + ], "radius": 4, - "color": [0.2, 0.2, 0.9] + "color": [ + 0.2, + 0.2, + 0.9 + ] }, "markers": [ { "id": 198, "name": "aruco_198", - "position": [0, -160, 35], - "normal": [0, 0, 1], + "position": [ + 0, + -160, + 35 + ], + "normal": [ + 0, + 0, + 1 + ], "size": 25, "spin": 0 }, { "id": 229, "name": "aruco_229", - "position": [0, -250, 35], - "normal": [0, 0, 1], + "position": [ + 0, + -250, + 35 + ], + "normal": [ + 0, + 0, + 1 + ], "size": 25, "spin": 0 }, { "id": 242, "name": "aruco_242", - "position": [0, -250, -35], - "normal": [0, 0, -1], + "position": [ + 0, + -250, + -35 + ], + "normal": [ + 0, + 0, + -1 + ], "size": 25, "spin": 0 }, { "id": 243, "name": "aruco_243", - "position": [0, -285, 0], - "normal": [0, -1, 0], + "position": [ + 0, + -285, + 0 + ], + "normal": [ + 0, + -1, + 0 + ], "size": 25, "spin": 0 } @@ -594,245 +1693,717 @@ "model": [ { "stlFile": "surfaces/Holm.stl", - "originOfModel__": [-25, 29, -28.5], - "originOfModel": [-29, 25, 28.5], - "rotationOfModelDegree__": [0, 0, 0], - "rotationOfModelDegree": [180, 0, -90], + "originOfModel__": [ + -25, + 29, + -28.5 + ], + "originOfModel": [ + -29, + 25, + 28.5 + ], + "rotationOfModelDegree__": [ + 0, + 0, + 0 + ], + "rotationOfModelDegree": [ + 180, + 0, + -90 + ], "material": "powderCoatBlue" } ] }, "Ellbow": { "parent": "Arm1", - "mountPosition": [0, 0, 0], - "mountRotation": [0, 0, 0], + "mountPosition": [ + 0, + 0, + 0 + ], + "mountRotation": [ + 0, + 0, + 0 + ], "jointToParent": { "name": "Joint2", "type": "revolute", - "axis": [-1, 0, 0], - "origin": [0, -250, 0], - "rotation": [0, 0, 0], + "axis": [ + -1, + 0, + 0 + ], + "origin": [ + 0, + -250, + 0 + ], + "rotation": [ + 0, + 0, + 0 + ], "variable": "z" }, "skeleton": { - "from": [0, 0, 0], - "to": [90, 0, 0], + "from": [ + 0, + 0, + 0 + ], + "to": [ + 90, + 0, + 0 + ], "radius": 4, - "color": [0.9, 0.2, 0.2] + "color": [ + 0.9, + 0.2, + 0.2 + ] }, "model": [ { "stlFile": "surfaces/Ellebogen.stl", - "originOfModel": [90, 0, 0], - "rotationOfModelDegree": [0, -90, -90], + "originOfModel": [ + 90, + 0, + 0 + ], + "rotationOfModelDegree": [ + 0, + -90, + -90 + ], "material": "defaultPlastic" } ], "markers": [ - {"id": 244, "name": "aruco_244", "position": [125, 0, 0], "normal": [1, 0, 0], "size": 25, "spin": 0}, - {"id": 245, "name": "aruco_245", "position": [90, 0, -35], "normal": [0, 0, -1], "size": 25, "spin": 0}, - {"id": 246, "name": "aruco_246", "position": [90, 0, 35], "normal": [0, 0, 1], "size": 25}, - {"id": 247, "name": "aruco_247", "position": [52.5, 0, 35], "normal": [0, 0, 1], "size": 25}, - {"id": 248, "name": "aruco_248", "position": [52.5, 0, -35], "normal": [0, 0, -1], "size": 25}, - {"id": 232, "name": "aruco_232", "position": [90, 24.75, -24.75], "normal": [0, 1, -1], "size": 25}, - {"id": 231, "name": "aruco_231", "position": [90, 24.75, 24.75], "normal": [0, 1, 1], "size": 25} + { + "id": 244, + "name": "aruco_244", + "position": [ + 125, + 0, + 0 + ], + "normal": [ + 1, + 0, + 0 + ], + "size": 25, + "spin": 0 + }, + { + "id": 245, + "name": "aruco_245", + "position": [ + 90, + 0, + -35 + ], + "normal": [ + 0, + 0, + -1 + ], + "size": 25, + "spin": 0 + }, + { + "id": 246, + "name": "aruco_246", + "position": [ + 90, + 0, + 35 + ], + "normal": [ + 0, + 0, + 1 + ], + "size": 25 + }, + { + "id": 247, + "name": "aruco_247", + "position": [ + 52.5, + 0, + 35 + ], + "normal": [ + 0, + 0, + 1 + ], + "size": 25 + }, + { + "id": 248, + "name": "aruco_248", + "position": [ + 52.5, + 0, + -35 + ], + "normal": [ + 0, + 0, + -1 + ], + "size": 25 + }, + { + "id": 232, + "name": "aruco_232", + "position": [ + 90, + 24.75, + -24.75 + ], + "normal": [ + 0, + 1, + -1 + ], + "size": 25 + }, + { + "id": 231, + "name": "aruco_231", + "position": [ + 90, + 24.75, + 24.75 + ], + "normal": [ + 0, + 1, + 1 + ], + "size": 25 + } ] }, "Arm2": { "parent": "Ellbow", - "mountPosition": [0, 0, 0], - "mountRotation": [0, 0, 0], + "mountPosition": [ + 0, + 0, + 0 + ], + "mountRotation": [ + 0, + 0, + 0 + ], "jointToParent": { "name": "Joint3", "type": "revolute", - "axis": [0, -1, 0], - "origin": [90, 0, 0], - "rotation": [0, 0, 0], + "axis": [ + 0, + -1, + 0 + ], + "origin": [ + 90, + 0, + 0 + ], + "rotation": [ + 0, + 0, + 0 + ], "variable": "a" }, "skeleton": { - "from": [0, 0, 0], - "to": [0, -250, 0], + "from": [ + 0, + 0, + 0 + ], + "to": [ + 0, + -250, + 0 + ], "radius": 4, - "color": [0.95, 0.85, 0.2] + "color": [ + 0.95, + 0.85, + 0.2 + ] }, "model": [ { "stlFile": "surfaces/Unterarm.stl", - "originOfModel": [0, -250, 0], - "rotationOfModelDegree": [180, 0, -90], + "originOfModel": [ + 0, + -250, + 0 + ], + "rotationOfModelDegree": [ + 180, + 0, + -90 + ], "material": "defaultPlastic" } ], "markers": [ - {"id": 120, "position": [24.75, -112, -24.75], "normal": [1, 0, -1]}, + { + "id": 120, + "position": [ + 24.75, + -112, + -24.75 + ], + "normal": [ + 1, + 0, + -1 + ] + }, { "id": 122, "name": "aruco_122", - "position": [-35, -112, 0], - "normal": [-1, 0, 0] + "position": [ + -35, + -112, + 0 + ], + "normal": [ + -1, + 0, + 0 + ] }, { "id": 218, "name": "aruco_218", - "position": [35, -112, 0], - "normal": [1, 0, 0] + "position": [ + 35, + -112, + 0 + ], + "normal": [ + 1, + 0, + 0 + ] }, { "id": 113, "name": "aruco_113", - "position": [0, -182, 30], - "normal": [0, 0, 1] + "position": [ + 0, + -182, + 30 + ], + "normal": [ + 0, + 0, + 1 + ] }, { "id": 114, "name": "aruco_114", - "position": [24.75, -182, -24.75], - "normal": [1, 0, -1] + "position": [ + 24.75, + -182, + -24.75 + ], + "normal": [ + 1, + 0, + -1 + ] }, { "id": 115, "name": "aruco_115", - "position": [-24.75, -182, -24.75], - "normal": [-1, 0, -1] + "position": [ + -24.75, + -182, + -24.75 + ], + "normal": [ + -1, + 0, + -1 + ] }, { "id": 124, "name": "aruco_124", - "position": [-35, -219, 0], - "normal": [-1, 0, 0] + "position": [ + -35, + -219, + 0 + ], + "normal": [ + -1, + 0, + 0 + ] }, { "id": 219, "name": "aruco_219", - "position": [35, -219, 0], - "normal": [1, 0, 0] + "position": [ + 35, + -219, + 0 + ], + "normal": [ + 1, + 0, + 0 + ] } ] }, "Hand": { "parent": "Arm2", - "mountPosition": [0, 0, 0], - "mountRotation": [0, 0, 0], + "mountPosition": [ + 0, + 0, + 0 + ], + "mountRotation": [ + 0, + 0, + 0 + ], "jointToParent": { "name": "Joint4", "type": "revolute", - "axis": [1, 0, 0], - "origin": [0, -250, 0], - "rotation": [0, 0, 0], + "axis": [ + 1, + 0, + 0 + ], + "origin": [ + 0, + -250, + 0 + ], + "rotation": [ + 0, + 0, + 0 + ], "variable": "b" }, "skeleton": { - "from": [0, 0, 0], - "to": [0, -35, 0], + "from": [ + 0, + 0, + 0 + ], + "to": [ + 0, + -35, + 0 + ], "radius": 4, - "color": [0.95, 0.55, 0.15] + "color": [ + 0.95, + 0.55, + 0.15 + ] } }, "Palm": { "parent": "Hand", - "mountPosition": [0, 0, 0], - "mountRotation": [0, 0, 0], + "mountPosition": [ + 0, + 0, + 0 + ], + "mountRotation": [ + 0, + 0, + 0 + ], "jointToParent": { "name": "Joint3", "type": "revolute", - "axis": [0, -1, 0], - "origin": [0, 0, 0], - "rotation": [0, 0, 0], + "axis": [ + 0, + -1, + 0 + ], + "origin": [ + 0, + 0, + 0 + ], + "rotation": [ + 0, + 0, + 0 + ], "variable": "c" }, "skeleton": { - "from": [-50, -35, 0], - "to": [50, -35, 0], + "from": [ + -50, + -35, + 0 + ], + "to": [ + 50, + -35, + 0 + ], "radius": 7, - "color": [0.95, 0.2, 0.2] + "color": [ + 0.95, + 0.2, + 0.2 + ] } }, "FingerA": { "parent": "Palm", - "size": [80, 60, 20], - "mountPosition": [0, 0, 0], - "mountRotation": [0, 0, 0], + "size": [ + 80, + 60, + 20 + ], + "mountPosition": [ + 0, + 0, + 0 + ], + "mountRotation": [ + 0, + 0, + 0 + ], "jointToParent": { "name": "Slider", "type": "linear", - "axis": [1, 0, 0], - "origin": [4, -35, 0], - "rotation": [0, 0, 0], + "axis": [ + 1, + 0, + 0 + ], + "origin": [ + 4, + -35, + 0 + ], + "rotation": [ + 0, + 0, + 0 + ], "variable": "e" }, "skeleton": { - "from": [0, 0, 0], - "to": [0, -60, 0], + "from": [ + 0, + 0, + 0 + ], + "to": [ + 0, + -60, + 0 + ], "radius": 4, - "color": [0.2, 0.8, 0.2] + "color": [ + 0.2, + 0.8, + 0.2 + ] }, "markers": [ - {"id": 40, "position": [12, -24, -17.1], "normal": [-10.98, 0, -23.56]}, - {"id": 41, "position": [1.5, -2.2, 25.8], "normal": [0, -25.6, 9.5]}, + { + "id": 40, + "position": [ + 12, + -24, + -17.1 + ], + "normal": [ + -10.98, + 0, + -23.56 + ] + }, + { + "id": 41, + "position": [ + 1.5, + -2.2, + 25.8 + ], + "normal": [ + 0, + -25.6, + 9.5 + ] + }, { "id": 42, - "position": [13.9, -40, 0], - "normal": [1, -0.35, 0.4], + "position": [ + 13.9, + -40, + 0 + ], + "normal": [ + 1, + -0.35, + 0.4 + ], "spin": 27 } ], "model": [ { "stlFile": "surfaces/Finger.stl", - "originOfModel": [24, 0, -9.1], - "rotationOfModelDegree": [90, -90, 0], + "originOfModel": [ + 24, + 0, + -9.1 + ], + "rotationOfModelDegree": [ + 90, + -90, + 0 + ], "material": "defaultPlastic" } ] }, "FingerB": { "parent": "Palm", - "size": [80, 60, 20], - "mountPosition": [0, 0, 0], - "mountRotation": [0, 0, 0], + "size": [ + 80, + 60, + 20 + ], + "mountPosition": [ + 0, + 0, + 0 + ], + "mountRotation": [ + 0, + 0, + 0 + ], "jointToParent": { "name": "Slider", "type": "linear", - "axis": [-1, 0, 0], - "origin": [-4, -35, 0], - "rotation": [0, 0, 0], + "axis": [ + -1, + 0, + 0 + ], + "origin": [ + -4, + -35, + 0 + ], + "rotation": [ + 0, + 0, + 0 + ], "variable": "e" }, "skeleton": { - "from": [0, 0, 0], - "to": [0, -60, 0], + "from": [ + 0, + 0, + 0 + ], + "to": [ + 0, + -60, + 0 + ], "radius": 4, - "color": [0.2, 0.8, 0.2] + "color": [ + 0.2, + 0.8, + 0.2 + ] }, "markers": [ { "id": 43, - "position": [-12, -24, 17.1], - "normal": [10.98, 0, 23.56], + "position": [ + -12, + -24, + 17.1 + ], + "normal": [ + 10.98, + 0, + 23.56 + ], "spin": 90 }, { "id": 44, - "position": [-1.5, -2.2, -25.8], - "normal": [0, -25.6, -9.5], + "position": [ + -1.5, + -2.2, + -25.8 + ], + "normal": [ + 0, + -25.6, + -9.5 + ], "spin": 90 }, { "id": 45, - "position": [-13.9, -40, 0], - "normal": [-1, -0.35, -0.4], + "position": [ + -13.9, + -40, + 0 + ], + "normal": [ + -1, + -0.35, + -0.4 + ], "spin": -27 } ], "model": [ { "stlFile": "surfaces/Finger.stl", - "originOfModel": [-24, 0, 9.1], - "rotationOfModelDegree": [90, 90, 0], + "originOfModel": [ + -24, + 0, + 9.1 + ], + "rotationOfModelDegree": [ + 90, + 90, + 0 + ], "material": "defaultPlastic" } ] } } -} +} \ No newline at end of file diff --git a/data/robot/robot_commented.json b/data/robot/robot_commented.json deleted file mode 100644 index ffc0c76..0000000 --- a/data/robot/robot_commented.json +++ /dev/null @@ -1,334 +0,0 @@ -{ - "_comment": "Robot definition file for Blender/Robot/URDF-style kinematic rendering", - - "coordinateSystem": { - "_comment": "Global coordinate system definition", - - "system": "right-handed", - - "axes": { - "x": "right", - "y": "backward", - "z": "up" - }, - - "_important": [ - "This coordinate system is intentionally identical to Blender.", - "All positions are expressed in millimeters.", - "All rotations are expressed in degrees.", - "Positive rotations follow the right-hand rule." - ] - }, - - "units": { - "length": "mm", - "rotation": "degree" - }, - - "renderingInfo": { - "_comment": "Pure rendering settings. Does NOT affect robot kinematics.", - - "cameraPosition": [-400, -700, 300], - - "cameraTarget": [0, 0, 150], - - "_cameraTargetInfo": [ - "cameraTarget defines the world-space point the camera looks at.", - "Values may also reference state variables like 'x'." - ], - - "cameraUpVector": [0, 0, 1], - - "lightPosition": [-500, -500, 500], - - "lightTarget": [0, 0, 0], - - "lightUpVector": [0, 0, 1], - - "metric": "mm", - - "materials": { - "wood": { - "baseColor": [0.72, 0.52, 0.33], - "roughness": 0.85, - "metallic": 0.0 - }, - - "plaWhite": { - "baseColor": [0.95, 0.95, 0.95], - "roughness": 0.45, - "metallic": 0.0 - }, - - "steel": { - "baseColor": [0.72, 0.72, 0.75], - "roughness": 0.25, - "metallic": 1.0 - }, - - "powderCoatBlue": { - "baseColor": [0.15, 0.25, 0.70], - "roughness": 0.55, - "metallic": 0.0 - }, - - "defaultPlastic": { - "baseColor": [0.95, 0.95, 0.95], - "roughness": 0.40, - "metallic": 0.0 - } - } - }, - - "defaultPosition": { - "_comment": "Robot zero/home position", - - "_important": [ - "These values define the robot's neutral pose.", - "All joints are evaluated relative to this pose." - ], - - "x": 0, - "y": 0, - "z": 0, - - "a": 0, - "b": 0, - "c": 0, - - "e": 0 - }, - - "recognized": { - "_comment": "Pose reconstructed from machine vision / markers", - - "x": null, - "y": null, - "z": null, - - "a": null, - "b": null, - "c": null, - - "e": null - }, - - "movements": { - "_comment": "Current commanded movement state (e.g. from GCode)", - - "x": null, - "y": null, - "z": null, - - "a": null, - "b": null, - "c": null, - - "e": null - }, - - "_statePriority": [ - "movements overrides recognized", - "recognized overrides defaultPosition", - "defaultPosition overrides zero" - ], - - "links": { - "Board": { - "_comment": "Static world/base object", - - "parent": null, - - "_mountPositionMeaning": [ - "Position of THIS LINK coordinate system", - "relative to the PARENT LINK coordinate system" - ], - - "mountPosition": [0, 0, 0], - - "_mountRotationMeaning": [ - "Mechanical installation rotation", - "Defines how the LINK coordinate system", - "is rotated relative to its parent link", - "This is NOT the joint movement." - ], - - "mountRotation": [0, 0, 0], - - "_modelMeaning": [ - "One link may consist of multiple STL surfaces.", - "Each STL is positioned relative to the LINK coordinate system." - ], - - "model": [ - { - "_comment": "Visual geometry only", - - "stlFile": "surfaces/Board.stl", - - "_originOfModelMeaning": [ - "Position of STL inside the LINK coordinate system", - "Purely visual adjustment", - "Used to compensate CAD export offsets" - ], - - "originOfModel": [0, 0, 0], - - "_rotationOfModelMeaning": [ - "Rotation of STL inside LINK coordinate system", - "Purely visual adjustment", - "Used to compensate CAD export orientation" - ], - - "rotationOfModelDegree": [0, 0, 90], - - "material": "wood" - } - ] - }, - - "Base": { - "_comment": "Linear axis mounted on Board", - - "parent": "Board", - - "mountPosition": [0, 0, 25], - - "mountRotation": [0, 0, 0], - - "_jointToParentMeaning": [ - "Defines the kinematic transformation", - "between parent link and this link" - ], - - "jointToParent": { - "name": "Slider", - - "_jointTypeMeaning": [ - "fixed = no movement", - "linear = translational movement", - "revolute = rotational movement" - ], - - "type": "linear", - - "_axisMeaning": [ - "Joint movement axis in LOCAL joint coordinates", - "[1,0,0] = local X axis", - "[0,1,0] = local Y axis", - "[0,0,1] = local Z axis" - ], - - "axis": [1, 0, 0], - - "_originMeaning": [ - "Position of joint coordinate system", - "inside the parent link coordinate system" - ], - - "origin": [0, 0, 0], - - "_rotationMeaning": [ - "Orientation of joint coordinate system", - "inside the parent link coordinate system" - ], - - "rotation": [0, 0, 0], - - "_variableMeaning": [ - "Maps robot state variable", - "to this joint" - ], - - "variable": "x" - }, - - "model": [ - { - "stlFile": "surfaces/Base.stl", - - "originOfModel": [0, 0, 0], - - "rotationOfModelDegree": [0, 0, 0], - - "material": "plaWhite" - } - ] - }, - - "Arm1": { - "_comment": "Rotational arm", - - "parent": "Base", - - "mountPosition": [150, 0, 150], - - "mountRotation": [0, 0, 0], - - "jointToParent": { - "name": "Joint1", - - "type": "revolute", - - "_important": [ - "Positive rotation follows right-hand rule." - ], - - "axis": [1, 0, 0], - - "origin": [0, 0, 0], - - "rotation": [0, 0, 0], - - "variable": "a" - }, - - "model": [ - { - "stlFile": "surfaces/Holm.stl", - - "originOfModel": [0, 0, 0], - - "rotationOfModelDegree": [0, 0, 0], - - "material": "powderCoatBlue" - } - ] - } - }, - - "_kinematicStructure": { - "_comment": "Conceptual hierarchy", - - "hierarchy": [ - "ParentLink", - "-> JointOrigin", - "-> JointMotion", - "-> ChildLink", - "-> VisualMeshes" - ], - - "_important": [ - "All children automatically inherit parent movement.", - "This creates full forward kinematics automatically.", - "No manual propagation of child transformations is required." - ] - }, - - "_futureExtensions": { - "_comment": "Planned future capabilities", - - "possibleFeatures": [ - "marker definitions", - "inverse kinematics", - "collision geometry", - "joint limits", - "joint damping", - "mass/inertia", - "vision calibration", - "urdf export", - "gcode import", - "trajectory playback" - ] - } -} \ No newline at end of file diff --git a/data/robot/robot_r.json b/data/robot/robot_r.json deleted file mode 100644 index cdcd16d..0000000 Binary files a/data/robot/robot_r.json and /dev/null differ diff --git a/data/simulation/Scene7/pose.json b/data/simulation/Scene7/pose.json index 4c1b65e..d3abbfc 100644 --- a/data/simulation/Scene7/pose.json +++ b/data/simulation/Scene7/pose.json @@ -9,6 +9,11 @@ "c": 9, "e": 9 }, + "rendering": { + "width": 1280, + "height": 720, + "dofFStop": 11.0 + }, "camera_positions": { "a": [ -300, @@ -45,5 +50,42 @@ 200, 1400 ] + }, + "camera_targets": { + "a": [ + 210, + -100, + 180 + ], + "b": [ + 310, + -80, + 180 + ], + "c": [ + 210, + -100, + 150 + ], + "d": [ + 210, + -100, + 150 + ], + "e": [ + 210, + -100, + 50 + ], + "f": [ + 200, + -200, + 180 + ], + "g": [ + 200, + -200, + 180 + ] } } \ No newline at end of file diff --git a/data/simulation/Scene7/render_a.json b/data/simulation/Scene7/render_a.json index 81e77f6..a7fb394 100644 --- a/data/simulation/Scene7/render_a.json +++ b/data/simulation/Scene7/render_a.json @@ -2001,6 +2001,84 @@ -0.05233597010374069 ] }, + { + "name": "aruco_248", + "id": 248, + "link": "Ellbow", + "position_m": [ + 0.19249999523162842, + -0.17729905247688293, + 0.05413304641842842 + ], + "position_mm": [ + 192.49999523162842, + -177.29905247688293, + 54.13304641842842 + ], + "rotation_quaternion": [ + 0.5129170417785645, + 0.48674020171165466, + 0.4867401123046875, + -0.512917160987854 + ], + "normal": [ + -2.0861628513557662e-07, + -0.9986295700073242, + 0.05233597010374069 + ] + }, + { + "name": "aruco_232", + "id": 232, + "link": "Ellbow", + "position_m": [ + 0.23000000417232513, + -0.16823066771030426, + 0.02851978689432144 + ], + "position_mm": [ + 230.00000417232513, + -168.23066771030426, + 28.51978689432144 + ], + "rotation_quaternion": [ + 0.4067366421222687, + 0.9135454893112183, + 0.0, + 0.0 + ], + "normal": [ + 0.0, + -0.7431448698043823, + -0.6691306233406067 + ] + }, + { + "name": "aruco_231", + "id": 231, + "link": "Ellbow", + "position_m": [ + 0.23000000417232513, + -0.1180923730134964, + 0.02589215338230133 + ], + "position_mm": [ + 230.00000417232513, + -118.0923730134964, + 25.89215338230133 + ], + "rotation_quaternion": [ + 0.35836800932884216, + -0.9335803985595703, + -0.0, + -0.0 + ], + "normal": [ + 0.0, + 0.6691306829452515, + -0.7431447505950928 + ] + }, { "name": "Arm2_marker_120", "id": 120, diff --git a/data/simulation/Scene7/render_a.npz b/data/simulation/Scene7/render_a.npz index 6243600..b10ee26 100644 Binary files a/data/simulation/Scene7/render_a.npz and b/data/simulation/Scene7/render_a.npz differ diff --git a/data/simulation/Scene7/render_a.png b/data/simulation/Scene7/render_a.png index bf6aad6..35ccd75 100644 Binary files a/data/simulation/Scene7/render_a.png and b/data/simulation/Scene7/render_a.png differ diff --git a/data/simulation/Scene7/render_b.json b/data/simulation/Scene7/render_b.json index 81e77f6..a7fb394 100644 --- a/data/simulation/Scene7/render_b.json +++ b/data/simulation/Scene7/render_b.json @@ -2001,6 +2001,84 @@ -0.05233597010374069 ] }, + { + "name": "aruco_248", + "id": 248, + "link": "Ellbow", + "position_m": [ + 0.19249999523162842, + -0.17729905247688293, + 0.05413304641842842 + ], + "position_mm": [ + 192.49999523162842, + -177.29905247688293, + 54.13304641842842 + ], + "rotation_quaternion": [ + 0.5129170417785645, + 0.48674020171165466, + 0.4867401123046875, + -0.512917160987854 + ], + "normal": [ + -2.0861628513557662e-07, + -0.9986295700073242, + 0.05233597010374069 + ] + }, + { + "name": "aruco_232", + "id": 232, + "link": "Ellbow", + "position_m": [ + 0.23000000417232513, + -0.16823066771030426, + 0.02851978689432144 + ], + "position_mm": [ + 230.00000417232513, + -168.23066771030426, + 28.51978689432144 + ], + "rotation_quaternion": [ + 0.4067366421222687, + 0.9135454893112183, + 0.0, + 0.0 + ], + "normal": [ + 0.0, + -0.7431448698043823, + -0.6691306233406067 + ] + }, + { + "name": "aruco_231", + "id": 231, + "link": "Ellbow", + "position_m": [ + 0.23000000417232513, + -0.1180923730134964, + 0.02589215338230133 + ], + "position_mm": [ + 230.00000417232513, + -118.0923730134964, + 25.89215338230133 + ], + "rotation_quaternion": [ + 0.35836800932884216, + -0.9335803985595703, + -0.0, + -0.0 + ], + "normal": [ + 0.0, + 0.6691306829452515, + -0.7431447505950928 + ] + }, { "name": "Arm2_marker_120", "id": 120, diff --git a/data/simulation/Scene7/render_b.npz b/data/simulation/Scene7/render_b.npz index 6243600..b10ee26 100644 Binary files a/data/simulation/Scene7/render_b.npz and b/data/simulation/Scene7/render_b.npz differ diff --git a/data/simulation/Scene7/render_b.png b/data/simulation/Scene7/render_b.png index 245d2eb..b210edd 100644 Binary files a/data/simulation/Scene7/render_b.png and b/data/simulation/Scene7/render_b.png differ diff --git a/data/simulation/Scene7/render_c.json b/data/simulation/Scene7/render_c.json index 81e77f6..a7fb394 100644 --- a/data/simulation/Scene7/render_c.json +++ b/data/simulation/Scene7/render_c.json @@ -2001,6 +2001,84 @@ -0.05233597010374069 ] }, + { + "name": "aruco_248", + "id": 248, + "link": "Ellbow", + "position_m": [ + 0.19249999523162842, + -0.17729905247688293, + 0.05413304641842842 + ], + "position_mm": [ + 192.49999523162842, + -177.29905247688293, + 54.13304641842842 + ], + "rotation_quaternion": [ + 0.5129170417785645, + 0.48674020171165466, + 0.4867401123046875, + -0.512917160987854 + ], + "normal": [ + -2.0861628513557662e-07, + -0.9986295700073242, + 0.05233597010374069 + ] + }, + { + "name": "aruco_232", + "id": 232, + "link": "Ellbow", + "position_m": [ + 0.23000000417232513, + -0.16823066771030426, + 0.02851978689432144 + ], + "position_mm": [ + 230.00000417232513, + -168.23066771030426, + 28.51978689432144 + ], + "rotation_quaternion": [ + 0.4067366421222687, + 0.9135454893112183, + 0.0, + 0.0 + ], + "normal": [ + 0.0, + -0.7431448698043823, + -0.6691306233406067 + ] + }, + { + "name": "aruco_231", + "id": 231, + "link": "Ellbow", + "position_m": [ + 0.23000000417232513, + -0.1180923730134964, + 0.02589215338230133 + ], + "position_mm": [ + 230.00000417232513, + -118.0923730134964, + 25.89215338230133 + ], + "rotation_quaternion": [ + 0.35836800932884216, + -0.9335803985595703, + -0.0, + -0.0 + ], + "normal": [ + 0.0, + 0.6691306829452515, + -0.7431447505950928 + ] + }, { "name": "Arm2_marker_120", "id": 120, diff --git a/data/simulation/Scene7/render_c.npz b/data/simulation/Scene7/render_c.npz index 6243600..b10ee26 100644 Binary files a/data/simulation/Scene7/render_c.npz and b/data/simulation/Scene7/render_c.npz differ diff --git a/data/simulation/Scene7/render_c.png b/data/simulation/Scene7/render_c.png index 5d28671..5cab1a9 100644 Binary files a/data/simulation/Scene7/render_c.png and b/data/simulation/Scene7/render_c.png differ diff --git a/data/simulation/Scene7/render_d.json b/data/simulation/Scene7/render_d.json index 81e77f6..a7fb394 100644 --- a/data/simulation/Scene7/render_d.json +++ b/data/simulation/Scene7/render_d.json @@ -2001,6 +2001,84 @@ -0.05233597010374069 ] }, + { + "name": "aruco_248", + "id": 248, + "link": "Ellbow", + "position_m": [ + 0.19249999523162842, + -0.17729905247688293, + 0.05413304641842842 + ], + "position_mm": [ + 192.49999523162842, + -177.29905247688293, + 54.13304641842842 + ], + "rotation_quaternion": [ + 0.5129170417785645, + 0.48674020171165466, + 0.4867401123046875, + -0.512917160987854 + ], + "normal": [ + -2.0861628513557662e-07, + -0.9986295700073242, + 0.05233597010374069 + ] + }, + { + "name": "aruco_232", + "id": 232, + "link": "Ellbow", + "position_m": [ + 0.23000000417232513, + -0.16823066771030426, + 0.02851978689432144 + ], + "position_mm": [ + 230.00000417232513, + -168.23066771030426, + 28.51978689432144 + ], + "rotation_quaternion": [ + 0.4067366421222687, + 0.9135454893112183, + 0.0, + 0.0 + ], + "normal": [ + 0.0, + -0.7431448698043823, + -0.6691306233406067 + ] + }, + { + "name": "aruco_231", + "id": 231, + "link": "Ellbow", + "position_m": [ + 0.23000000417232513, + -0.1180923730134964, + 0.02589215338230133 + ], + "position_mm": [ + 230.00000417232513, + -118.0923730134964, + 25.89215338230133 + ], + "rotation_quaternion": [ + 0.35836800932884216, + -0.9335803985595703, + -0.0, + -0.0 + ], + "normal": [ + 0.0, + 0.6691306829452515, + -0.7431447505950928 + ] + }, { "name": "Arm2_marker_120", "id": 120, diff --git a/data/simulation/Scene7/render_d.npz b/data/simulation/Scene7/render_d.npz index 6243600..b10ee26 100644 Binary files a/data/simulation/Scene7/render_d.npz and b/data/simulation/Scene7/render_d.npz differ diff --git a/data/simulation/Scene7/render_d.png b/data/simulation/Scene7/render_d.png index 73f5110..60c949a 100644 Binary files a/data/simulation/Scene7/render_d.png and b/data/simulation/Scene7/render_d.png differ diff --git a/data/simulation/Scene7/render_e.json b/data/simulation/Scene7/render_e.json index 81e77f6..a7fb394 100644 --- a/data/simulation/Scene7/render_e.json +++ b/data/simulation/Scene7/render_e.json @@ -2001,6 +2001,84 @@ -0.05233597010374069 ] }, + { + "name": "aruco_248", + "id": 248, + "link": "Ellbow", + "position_m": [ + 0.19249999523162842, + -0.17729905247688293, + 0.05413304641842842 + ], + "position_mm": [ + 192.49999523162842, + -177.29905247688293, + 54.13304641842842 + ], + "rotation_quaternion": [ + 0.5129170417785645, + 0.48674020171165466, + 0.4867401123046875, + -0.512917160987854 + ], + "normal": [ + -2.0861628513557662e-07, + -0.9986295700073242, + 0.05233597010374069 + ] + }, + { + "name": "aruco_232", + "id": 232, + "link": "Ellbow", + "position_m": [ + 0.23000000417232513, + -0.16823066771030426, + 0.02851978689432144 + ], + "position_mm": [ + 230.00000417232513, + -168.23066771030426, + 28.51978689432144 + ], + "rotation_quaternion": [ + 0.4067366421222687, + 0.9135454893112183, + 0.0, + 0.0 + ], + "normal": [ + 0.0, + -0.7431448698043823, + -0.6691306233406067 + ] + }, + { + "name": "aruco_231", + "id": 231, + "link": "Ellbow", + "position_m": [ + 0.23000000417232513, + -0.1180923730134964, + 0.02589215338230133 + ], + "position_mm": [ + 230.00000417232513, + -118.0923730134964, + 25.89215338230133 + ], + "rotation_quaternion": [ + 0.35836800932884216, + -0.9335803985595703, + -0.0, + -0.0 + ], + "normal": [ + 0.0, + 0.6691306829452515, + -0.7431447505950928 + ] + }, { "name": "Arm2_marker_120", "id": 120, diff --git a/data/simulation/Scene7/render_e.npz b/data/simulation/Scene7/render_e.npz index 6243600..b10ee26 100644 Binary files a/data/simulation/Scene7/render_e.npz and b/data/simulation/Scene7/render_e.npz differ diff --git a/data/simulation/Scene7/render_e.png b/data/simulation/Scene7/render_e.png index 95088bb..235204b 100644 Binary files a/data/simulation/Scene7/render_e.png and b/data/simulation/Scene7/render_e.png differ diff --git a/data/simulation/Scene8/pose.json b/data/simulation/Scene8/pose.json index a7ee6a8..0025639 100644 --- a/data/simulation/Scene8/pose.json +++ b/data/simulation/Scene8/pose.json @@ -9,6 +9,11 @@ "c": 9, "e": 3 }, + "rendering": { + "width": 1280, + "height": 720, + "dofFStop": 11.0 + }, "camera_positions": { "a": [ -300, @@ -45,5 +50,42 @@ 200, 1400 ] + }, + "camera_targets": { + "a": [ + 210, + -100, + 180 + ], + "b": [ + 310, + -80, + 180 + ], + "c": [ + 210, + -100, + 150 + ], + "d": [ + 210, + -100, + 150 + ], + "e": [ + 210, + -100, + 50 + ], + "f": [ + 200, + -200, + 180 + ], + "g": [ + 200, + -200, + 180 + ] } } \ No newline at end of file diff --git a/data/simulation/Scene8/render_a.json b/data/simulation/Scene8/render_a.json index 5d3d420..81b2b95 100644 --- a/data/simulation/Scene8/render_a.json +++ b/data/simulation/Scene8/render_a.json @@ -2001,6 +2001,84 @@ -0.05233597010374069 ] }, + { + "name": "aruco_248", + "id": 248, + "link": "Ellbow", + "position_m": [ + 0.21249999105930328, + -0.17729905247688293, + 0.05413304641842842 + ], + "position_mm": [ + 212.49999105930328, + -177.29905247688293, + 54.13304641842842 + ], + "rotation_quaternion": [ + 0.5129170417785645, + 0.48674020171165466, + 0.4867401123046875, + -0.512917160987854 + ], + "normal": [ + -2.0861628513557662e-07, + -0.9986295700073242, + 0.05233597010374069 + ] + }, + { + "name": "aruco_232", + "id": 232, + "link": "Ellbow", + "position_m": [ + 0.25, + -0.16823066771030426, + 0.02851978689432144 + ], + "position_mm": [ + 250.0, + -168.23066771030426, + 28.51978689432144 + ], + "rotation_quaternion": [ + 0.4067366421222687, + 0.9135454893112183, + 0.0, + 0.0 + ], + "normal": [ + 0.0, + -0.7431448698043823, + -0.6691306233406067 + ] + }, + { + "name": "aruco_231", + "id": 231, + "link": "Ellbow", + "position_m": [ + 0.25, + -0.1180923730134964, + 0.02589215338230133 + ], + "position_mm": [ + 250.0, + -118.0923730134964, + 25.89215338230133 + ], + "rotation_quaternion": [ + 0.35836800932884216, + -0.9335803985595703, + -0.0, + -0.0 + ], + "normal": [ + 0.0, + 0.6691306829452515, + -0.7431447505950928 + ] + }, { "name": "Arm2_marker_120", "id": 120, diff --git a/data/simulation/Scene8/render_a.npz b/data/simulation/Scene8/render_a.npz index 6243600..b10ee26 100644 Binary files a/data/simulation/Scene8/render_a.npz and b/data/simulation/Scene8/render_a.npz differ diff --git a/data/simulation/Scene8/render_a.png b/data/simulation/Scene8/render_a.png index e799049..bf19949 100644 Binary files a/data/simulation/Scene8/render_a.png and b/data/simulation/Scene8/render_a.png differ diff --git a/data/simulation/Scene8/render_b.json b/data/simulation/Scene8/render_b.json index 5d3d420..81b2b95 100644 --- a/data/simulation/Scene8/render_b.json +++ b/data/simulation/Scene8/render_b.json @@ -2001,6 +2001,84 @@ -0.05233597010374069 ] }, + { + "name": "aruco_248", + "id": 248, + "link": "Ellbow", + "position_m": [ + 0.21249999105930328, + -0.17729905247688293, + 0.05413304641842842 + ], + "position_mm": [ + 212.49999105930328, + -177.29905247688293, + 54.13304641842842 + ], + "rotation_quaternion": [ + 0.5129170417785645, + 0.48674020171165466, + 0.4867401123046875, + -0.512917160987854 + ], + "normal": [ + -2.0861628513557662e-07, + -0.9986295700073242, + 0.05233597010374069 + ] + }, + { + "name": "aruco_232", + "id": 232, + "link": "Ellbow", + "position_m": [ + 0.25, + -0.16823066771030426, + 0.02851978689432144 + ], + "position_mm": [ + 250.0, + -168.23066771030426, + 28.51978689432144 + ], + "rotation_quaternion": [ + 0.4067366421222687, + 0.9135454893112183, + 0.0, + 0.0 + ], + "normal": [ + 0.0, + -0.7431448698043823, + -0.6691306233406067 + ] + }, + { + "name": "aruco_231", + "id": 231, + "link": "Ellbow", + "position_m": [ + 0.25, + -0.1180923730134964, + 0.02589215338230133 + ], + "position_mm": [ + 250.0, + -118.0923730134964, + 25.89215338230133 + ], + "rotation_quaternion": [ + 0.35836800932884216, + -0.9335803985595703, + -0.0, + -0.0 + ], + "normal": [ + 0.0, + 0.6691306829452515, + -0.7431447505950928 + ] + }, { "name": "Arm2_marker_120", "id": 120, diff --git a/data/simulation/Scene8/render_b.npz b/data/simulation/Scene8/render_b.npz index 6243600..b10ee26 100644 Binary files a/data/simulation/Scene8/render_b.npz and b/data/simulation/Scene8/render_b.npz differ diff --git a/data/simulation/Scene8/render_b.png b/data/simulation/Scene8/render_b.png index 21be21d..f103d96 100644 Binary files a/data/simulation/Scene8/render_b.png and b/data/simulation/Scene8/render_b.png differ diff --git a/data/simulation/Scene8/render_c.json b/data/simulation/Scene8/render_c.json index 5d3d420..81b2b95 100644 --- a/data/simulation/Scene8/render_c.json +++ b/data/simulation/Scene8/render_c.json @@ -2001,6 +2001,84 @@ -0.05233597010374069 ] }, + { + "name": "aruco_248", + "id": 248, + "link": "Ellbow", + "position_m": [ + 0.21249999105930328, + -0.17729905247688293, + 0.05413304641842842 + ], + "position_mm": [ + 212.49999105930328, + -177.29905247688293, + 54.13304641842842 + ], + "rotation_quaternion": [ + 0.5129170417785645, + 0.48674020171165466, + 0.4867401123046875, + -0.512917160987854 + ], + "normal": [ + -2.0861628513557662e-07, + -0.9986295700073242, + 0.05233597010374069 + ] + }, + { + "name": "aruco_232", + "id": 232, + "link": "Ellbow", + "position_m": [ + 0.25, + -0.16823066771030426, + 0.02851978689432144 + ], + "position_mm": [ + 250.0, + -168.23066771030426, + 28.51978689432144 + ], + "rotation_quaternion": [ + 0.4067366421222687, + 0.9135454893112183, + 0.0, + 0.0 + ], + "normal": [ + 0.0, + -0.7431448698043823, + -0.6691306233406067 + ] + }, + { + "name": "aruco_231", + "id": 231, + "link": "Ellbow", + "position_m": [ + 0.25, + -0.1180923730134964, + 0.02589215338230133 + ], + "position_mm": [ + 250.0, + -118.0923730134964, + 25.89215338230133 + ], + "rotation_quaternion": [ + 0.35836800932884216, + -0.9335803985595703, + -0.0, + -0.0 + ], + "normal": [ + 0.0, + 0.6691306829452515, + -0.7431447505950928 + ] + }, { "name": "Arm2_marker_120", "id": 120, diff --git a/data/simulation/Scene8/render_c.npz b/data/simulation/Scene8/render_c.npz index 6243600..b10ee26 100644 Binary files a/data/simulation/Scene8/render_c.npz and b/data/simulation/Scene8/render_c.npz differ diff --git a/data/simulation/Scene8/render_c.png b/data/simulation/Scene8/render_c.png index 56c0074..ed21d82 100644 Binary files a/data/simulation/Scene8/render_c.png and b/data/simulation/Scene8/render_c.png differ diff --git a/data/simulation/Scene8/render_d.json b/data/simulation/Scene8/render_d.json index 5d3d420..81b2b95 100644 --- a/data/simulation/Scene8/render_d.json +++ b/data/simulation/Scene8/render_d.json @@ -2001,6 +2001,84 @@ -0.05233597010374069 ] }, + { + "name": "aruco_248", + "id": 248, + "link": "Ellbow", + "position_m": [ + 0.21249999105930328, + -0.17729905247688293, + 0.05413304641842842 + ], + "position_mm": [ + 212.49999105930328, + -177.29905247688293, + 54.13304641842842 + ], + "rotation_quaternion": [ + 0.5129170417785645, + 0.48674020171165466, + 0.4867401123046875, + -0.512917160987854 + ], + "normal": [ + -2.0861628513557662e-07, + -0.9986295700073242, + 0.05233597010374069 + ] + }, + { + "name": "aruco_232", + "id": 232, + "link": "Ellbow", + "position_m": [ + 0.25, + -0.16823066771030426, + 0.02851978689432144 + ], + "position_mm": [ + 250.0, + -168.23066771030426, + 28.51978689432144 + ], + "rotation_quaternion": [ + 0.4067366421222687, + 0.9135454893112183, + 0.0, + 0.0 + ], + "normal": [ + 0.0, + -0.7431448698043823, + -0.6691306233406067 + ] + }, + { + "name": "aruco_231", + "id": 231, + "link": "Ellbow", + "position_m": [ + 0.25, + -0.1180923730134964, + 0.02589215338230133 + ], + "position_mm": [ + 250.0, + -118.0923730134964, + 25.89215338230133 + ], + "rotation_quaternion": [ + 0.35836800932884216, + -0.9335803985595703, + -0.0, + -0.0 + ], + "normal": [ + 0.0, + 0.6691306829452515, + -0.7431447505950928 + ] + }, { "name": "Arm2_marker_120", "id": 120, diff --git a/data/simulation/Scene8/render_d.npz b/data/simulation/Scene8/render_d.npz index 6243600..b10ee26 100644 Binary files a/data/simulation/Scene8/render_d.npz and b/data/simulation/Scene8/render_d.npz differ diff --git a/data/simulation/Scene8/render_d.png b/data/simulation/Scene8/render_d.png index 95a1047..fec8349 100644 Binary files a/data/simulation/Scene8/render_d.png and b/data/simulation/Scene8/render_d.png differ diff --git a/data/simulation/Scene8/render_e.json b/data/simulation/Scene8/render_e.json index 5d3d420..81b2b95 100644 --- a/data/simulation/Scene8/render_e.json +++ b/data/simulation/Scene8/render_e.json @@ -2001,6 +2001,84 @@ -0.05233597010374069 ] }, + { + "name": "aruco_248", + "id": 248, + "link": "Ellbow", + "position_m": [ + 0.21249999105930328, + -0.17729905247688293, + 0.05413304641842842 + ], + "position_mm": [ + 212.49999105930328, + -177.29905247688293, + 54.13304641842842 + ], + "rotation_quaternion": [ + 0.5129170417785645, + 0.48674020171165466, + 0.4867401123046875, + -0.512917160987854 + ], + "normal": [ + -2.0861628513557662e-07, + -0.9986295700073242, + 0.05233597010374069 + ] + }, + { + "name": "aruco_232", + "id": 232, + "link": "Ellbow", + "position_m": [ + 0.25, + -0.16823066771030426, + 0.02851978689432144 + ], + "position_mm": [ + 250.0, + -168.23066771030426, + 28.51978689432144 + ], + "rotation_quaternion": [ + 0.4067366421222687, + 0.9135454893112183, + 0.0, + 0.0 + ], + "normal": [ + 0.0, + -0.7431448698043823, + -0.6691306233406067 + ] + }, + { + "name": "aruco_231", + "id": 231, + "link": "Ellbow", + "position_m": [ + 0.25, + -0.1180923730134964, + 0.02589215338230133 + ], + "position_mm": [ + 250.0, + -118.0923730134964, + 25.89215338230133 + ], + "rotation_quaternion": [ + 0.35836800932884216, + -0.9335803985595703, + -0.0, + -0.0 + ], + "normal": [ + 0.0, + 0.6691306829452515, + -0.7431447505950928 + ] + }, { "name": "Arm2_marker_120", "id": 120, diff --git a/data/simulation/Scene8/render_e.npz b/data/simulation/Scene8/render_e.npz index 6243600..b10ee26 100644 Binary files a/data/simulation/Scene8/render_e.npz and b/data/simulation/Scene8/render_e.npz differ diff --git a/data/simulation/Scene8/render_e.png b/data/simulation/Scene8/render_e.png index deff2b0..6ecb544 100644 Binary files a/data/simulation/Scene8/render_e.png and b/data/simulation/Scene8/render_e.png differ diff --git a/data/simulation/Scene8/render_f.json b/data/simulation/Scene8/render_f.json index 5d3d420..81b2b95 100644 --- a/data/simulation/Scene8/render_f.json +++ b/data/simulation/Scene8/render_f.json @@ -2001,6 +2001,84 @@ -0.05233597010374069 ] }, + { + "name": "aruco_248", + "id": 248, + "link": "Ellbow", + "position_m": [ + 0.21249999105930328, + -0.17729905247688293, + 0.05413304641842842 + ], + "position_mm": [ + 212.49999105930328, + -177.29905247688293, + 54.13304641842842 + ], + "rotation_quaternion": [ + 0.5129170417785645, + 0.48674020171165466, + 0.4867401123046875, + -0.512917160987854 + ], + "normal": [ + -2.0861628513557662e-07, + -0.9986295700073242, + 0.05233597010374069 + ] + }, + { + "name": "aruco_232", + "id": 232, + "link": "Ellbow", + "position_m": [ + 0.25, + -0.16823066771030426, + 0.02851978689432144 + ], + "position_mm": [ + 250.0, + -168.23066771030426, + 28.51978689432144 + ], + "rotation_quaternion": [ + 0.4067366421222687, + 0.9135454893112183, + 0.0, + 0.0 + ], + "normal": [ + 0.0, + -0.7431448698043823, + -0.6691306233406067 + ] + }, + { + "name": "aruco_231", + "id": 231, + "link": "Ellbow", + "position_m": [ + 0.25, + -0.1180923730134964, + 0.02589215338230133 + ], + "position_mm": [ + 250.0, + -118.0923730134964, + 25.89215338230133 + ], + "rotation_quaternion": [ + 0.35836800932884216, + -0.9335803985595703, + -0.0, + -0.0 + ], + "normal": [ + 0.0, + 0.6691306829452515, + -0.7431447505950928 + ] + }, { "name": "Arm2_marker_120", "id": 120, diff --git a/data/simulation/Scene8/render_f.npz b/data/simulation/Scene8/render_f.npz index 6243600..b10ee26 100644 Binary files a/data/simulation/Scene8/render_f.npz and b/data/simulation/Scene8/render_f.npz differ diff --git a/data/simulation/Scene8/render_f.png b/data/simulation/Scene8/render_f.png index 9f63344..33fb907 100644 Binary files a/data/simulation/Scene8/render_f.png and b/data/simulation/Scene8/render_f.png differ diff --git a/data/simulation/Scene8/render_g.json b/data/simulation/Scene8/render_g.json index 5d3d420..81b2b95 100644 --- a/data/simulation/Scene8/render_g.json +++ b/data/simulation/Scene8/render_g.json @@ -2001,6 +2001,84 @@ -0.05233597010374069 ] }, + { + "name": "aruco_248", + "id": 248, + "link": "Ellbow", + "position_m": [ + 0.21249999105930328, + -0.17729905247688293, + 0.05413304641842842 + ], + "position_mm": [ + 212.49999105930328, + -177.29905247688293, + 54.13304641842842 + ], + "rotation_quaternion": [ + 0.5129170417785645, + 0.48674020171165466, + 0.4867401123046875, + -0.512917160987854 + ], + "normal": [ + -2.0861628513557662e-07, + -0.9986295700073242, + 0.05233597010374069 + ] + }, + { + "name": "aruco_232", + "id": 232, + "link": "Ellbow", + "position_m": [ + 0.25, + -0.16823066771030426, + 0.02851978689432144 + ], + "position_mm": [ + 250.0, + -168.23066771030426, + 28.51978689432144 + ], + "rotation_quaternion": [ + 0.4067366421222687, + 0.9135454893112183, + 0.0, + 0.0 + ], + "normal": [ + 0.0, + -0.7431448698043823, + -0.6691306233406067 + ] + }, + { + "name": "aruco_231", + "id": 231, + "link": "Ellbow", + "position_m": [ + 0.25, + -0.1180923730134964, + 0.02589215338230133 + ], + "position_mm": [ + 250.0, + -118.0923730134964, + 25.89215338230133 + ], + "rotation_quaternion": [ + 0.35836800932884216, + -0.9335803985595703, + -0.0, + -0.0 + ], + "normal": [ + 0.0, + 0.6691306829452515, + -0.7431447505950928 + ] + }, { "name": "Arm2_marker_120", "id": 120, diff --git a/data/simulation/Scene8/render_g.npz b/data/simulation/Scene8/render_g.npz index 6243600..b10ee26 100644 Binary files a/data/simulation/Scene8/render_g.npz and b/data/simulation/Scene8/render_g.npz differ diff --git a/data/simulation/Scene8/render_g.png b/data/simulation/Scene8/render_g.png index 3f4e337..5a450d9 100644 Binary files a/data/simulation/Scene8/render_g.png and b/data/simulation/Scene8/render_g.png differ diff --git a/data/simulation/debug/markers.json b/data/simulation/debug/markers.json index 6870bb5..a7fb394 100644 --- a/data/simulation/debug/markers.json +++ b/data/simulation/debug/markers.json @@ -1798,12 +1798,12 @@ "id": 198, "link": "Arm1", "position_m": [ - 0.17000000178813934, + 0.14000000059604645, -0.053141459822654724, 0.09089445322751999 ], "position_mm": [ - 170.00000178813934, + 140.00000059604645, -53.141459822654724, 90.89445322751999 ], @@ -1824,12 +1824,12 @@ "id": 229, "link": "Arm1", "position_m": [ - 0.17000000178813934, + 0.14000000059604645, -0.14308664202690125, 0.08775349706411362 ], "position_mm": [ - 170.00000178813934, + 140.00000059604645, -143.08664202690125, 87.75349706411362 ], @@ -1850,12 +1850,12 @@ "id": 242, "link": "Arm1", "position_m": [ - 0.17000000178813934, + 0.14000000059604645, -0.1406087726354599, 0.016796745359897614 ], "position_mm": [ - 170.00000178813934, + 140.00000059604645, -140.6087726354599, 16.796745359897614 ], @@ -1876,12 +1876,12 @@ "id": 243, "link": "Arm1", "position_m": [ - 0.17000000178813934, + 0.14000000059604645, -0.1773260533809662, 0.05103618651628494 ], "position_mm": [ - 170.00000178813934, + 140.00000059604645, -177.3260533809662, 51.03618651628494 ], @@ -1902,12 +1902,12 @@ "id": 244, "link": "Ellbow", "position_m": [ - 0.2954999804496765, + 0.265500009059906, -0.14184769988059998, 0.052275121212005615 ], "position_mm": [ - 295.4999804496765, + 265.500009059906, -141.84769988059998, 52.275121212005615 ], @@ -1928,12 +1928,12 @@ "id": 245, "link": "Ellbow", "position_m": [ - 0.25999999046325684, + 0.23000000417232513, -0.17729905247688293, 0.05413304641842842 ], "position_mm": [ - 259.99999046325684, + 230.00000417232513, -177.29905247688293, 54.13304641842842 ], @@ -1954,12 +1954,12 @@ "id": 246, "link": "Ellbow", "position_m": [ - 0.25999999046325684, + 0.23000000417232513, -0.10639634728431702, 0.05041719600558281 ], "position_mm": [ - 259.99999046325684, + 230.00000417232513, -106.39634728431702, 50.41719600558281 ], @@ -1980,12 +1980,12 @@ "id": 247, "link": "Ellbow", "position_m": [ - 0.2224999964237213, + 0.19249999523162842, -0.10639634728431702, 0.05041719600558281 ], "position_mm": [ - 222.4999964237213, + 192.49999523162842, -106.39634728431702, 50.41719600558281 ], @@ -2001,30 +2001,108 @@ -0.05233597010374069 ] }, + { + "name": "aruco_248", + "id": 248, + "link": "Ellbow", + "position_m": [ + 0.19249999523162842, + -0.17729905247688293, + 0.05413304641842842 + ], + "position_mm": [ + 192.49999523162842, + -177.29905247688293, + 54.13304641842842 + ], + "rotation_quaternion": [ + 0.5129170417785645, + 0.48674020171165466, + 0.4867401123046875, + -0.512917160987854 + ], + "normal": [ + -2.0861628513557662e-07, + -0.9986295700073242, + 0.05233597010374069 + ] + }, + { + "name": "aruco_232", + "id": 232, + "link": "Ellbow", + "position_m": [ + 0.23000000417232513, + -0.16823066771030426, + 0.02851978689432144 + ], + "position_mm": [ + 230.00000417232513, + -168.23066771030426, + 28.51978689432144 + ], + "rotation_quaternion": [ + 0.4067366421222687, + 0.9135454893112183, + 0.0, + 0.0 + ], + "normal": [ + 0.0, + -0.7431448698043823, + -0.6691306233406067 + ] + }, + { + "name": "aruco_231", + "id": 231, + "link": "Ellbow", + "position_m": [ + 0.23000000417232513, + -0.1180923730134964, + 0.02589215338230133 + ], + "position_mm": [ + 230.00000417232513, + -118.0923730134964, + 25.89215338230133 + ], + "rotation_quaternion": [ + 0.35836800932884216, + -0.9335803985595703, + -0.0, + -0.0 + ], + "normal": [ + 0.0, + 0.6691306829452515, + -0.7431447505950928 + ] + }, { "name": "Arm2_marker_120", "id": 120, "link": "Arm2", "position_m": [ - 0.22782443463802338, - -0.1210029348731041, - 0.1633363962173462 + 0.2621755301952362, + -0.1509692370891571, + 0.16490685939788818 ], "position_mm": [ - 227.82443463802338, - -121.0029348731041, - 163.3363962173462 + 262.1755301952362, + -150.9692370891571, + 164.90685939788818 ], "rotation_quaternion": [ - 0.5805524587631226, - -0.6117745637893677, - -0.36985260248184204, - 0.38974329829216003 + 0.3698526918888092, + -0.3897433578968048, + 0.5805523991584778, + -0.6117745041847229 ], "normal": [ - -0.9063076972961426, - 0.42203933000564575, - -0.022118031978607178 + 0.9063078165054321, + -0.4220390319824219, + 0.02211807668209076 ] }, { @@ -2032,25 +2110,25 @@ "id": 122, "link": "Arm2", "position_m": [ - 0.29335907101631165, - -0.12386100739240646, - 0.16348618268966675 + 0.19664090871810913, + -0.14811114966869354, + 0.16475707292556763 ], "position_mm": [ - 293.35907101631165, - -123.86100739240646, - 163.48618268966675 + 196.64090871810913, + -148.11114966869354, + 164.75707292556763 ], "rotation_quaternion": [ - 0.5638670921325684, - -0.5941917896270752, - 0.3948240578174591, - -0.4160577356815338 + 0.3948240280151367, + -0.41605767607688904, + -0.5638671517372131, + 0.59419184923172 ], "normal": [ - 0.9396927356719971, - 0.34155115485191345, - -0.017899811267852783 + -0.9396926164627075, + -0.34155139327049255, + 0.017899779602885246 ] }, { @@ -2058,25 +2136,25 @@ "id": 218, "link": "Arm2", "position_m": [ - 0.22664089500904083, - -0.14811114966869354, - 0.16475707292556763 + 0.26335909962654114, + -0.12386099994182587, + 0.16348618268966675 ], "position_mm": [ - 226.64089500904083, - -148.11114966869354, - 164.75707292556763 + 263.35909962654114, + -123.86099994182587, + 163.48618268966675 ], "rotation_quaternion": [ - 0.3948240280151367, - -0.4160577058792114, - -0.5638670921325684, - 0.59419184923172 + 0.5638671517372131, + -0.5941919088363647, + 0.39482399821281433, + -0.41605764627456665 ], "normal": [ - -0.9396926760673523, - -0.3415512442588806, - 0.017899809405207634 + 0.9396926164627075, + 0.3415515422821045, + -0.017899898812174797 ] }, { @@ -2084,25 +2162,25 @@ "id": 113, "link": "Arm2", "position_m": [ - 0.27043160796165466, - -0.1609439104795456, - 0.2355256825685501 + 0.2195683866739273, + -0.10370121896266937, + 0.23252572119235992 ], "position_mm": [ - 270.43160796165466, - -160.9439104795456, - 235.5256825685501 + 219.5683866739273, + -103.70121896266937, + 232.52572119235992 ], "rotation_quaternion": [ - 0.11953148245811462, - -0.1259598731994629, 0.6778969764709473, - -0.7143542766571045 + -0.7143542766571045, + -0.1195315346121788, + 0.12595993280410767 ], "normal": [ - 0.34202003479003906, - -0.9384048581123352, - 0.04917958378791809 + -0.3420201539993286, + 0.9384047985076904, + -0.04917961359024048 ] }, { @@ -2110,25 +2188,25 @@ "id": 114, "link": "Arm2", "position_m": [ - 0.22782443463802338, - -0.11733941733837128, - 0.23324045538902283 + 0.2621755301952362, + -0.1473057121038437, + 0.2348109483718872 ], "position_mm": [ - 227.82443463802338, - -117.33941733837128, - 233.24045538902283 + 262.1755301952362, + -147.3057121038437, + 234.8109483718872 ], "rotation_quaternion": [ - 0.5805524587631226, - -0.6117745637893677, - -0.36985260248184204, - 0.38974329829216003 + 0.3698526918888092, + -0.3897433578968048, + 0.5805523991584778, + -0.6117745041847229 ], "normal": [ - -0.9063076972961426, - 0.42203933000564575, - -0.022118031978607178 + 0.9063078165054321, + -0.4220390319824219, + 0.02211807668209076 ] }, { @@ -2136,25 +2214,25 @@ "id": 115, "link": "Arm2", "position_m": [ - 0.27500370144844055, - -0.10019111633300781, - 0.23234176635742188 + 0.21499629318714142, + -0.16445402801036835, + 0.23570963740348816 ], "position_mm": [ - 275.00370144844055, - -100.19111633300781, - 232.34176635742188 + 214.99629318714142, + -164.45402801036835, + 235.70963740348816 ], "rotation_quaternion": [ - 0.6720378398895264, - -0.7081800699234009, - 0.148987278342247, - -0.15699981153011322 + 0.14898721873760223, + -0.15699973702430725, + -0.6720378994941711, + 0.7081800699234009 ], "normal": [ - 0.42261838912963867, - 0.9050655961036682, - -0.047432444989681244 + -0.4226182699203491, + -0.9050657749176025, + 0.047432348132133484 ] }, { @@ -2162,25 +2240,25 @@ "id": 124, "link": "Arm2", "position_m": [ - 0.29335907101631165, - -0.11826106905937195, - 0.2703395485877991 + 0.19664090871810913, + -0.14251121878623962, + 0.27161043882369995 ], "position_mm": [ - 293.35907101631165, - -118.26106905937195, - 270.3395485877991 + 196.64090871810913, + -142.51121878623962, + 271.61043882369995 ], "rotation_quaternion": [ - 0.5638670921325684, - -0.5941917896270752, - 0.3948240578174591, - -0.4160577356815338 + 0.3948240280151367, + -0.41605767607688904, + -0.5638671517372131, + 0.59419184923172 ], "normal": [ - 0.9396927356719971, - 0.34155115485191345, - -0.017899811267852783 + -0.9396926164627075, + -0.34155139327049255, + 0.017899779602885246 ] }, { @@ -2188,25 +2266,25 @@ "id": 219, "link": "Arm2", "position_m": [ - 0.22664089500904083, - -0.14251121878623962, - 0.27161043882369995 + 0.26335909962654114, + -0.11826106160879135, + 0.2703395485877991 ], "position_mm": [ - 226.64089500904083, - -142.51121878623962, - 271.61043882369995 + 263.35909962654114, + -118.26106160879135, + 270.3395485877991 ], "rotation_quaternion": [ - 0.3948240280151367, - -0.4160577058792114, - -0.5638670921325684, - 0.59419184923172 + 0.5638671517372131, + -0.5941919088363647, + 0.39482399821281433, + -0.41605764627456665 ], "normal": [ - -0.9396926760673523, - -0.3415512442588806, - 0.017899809405207634 + 0.9396926164627075, + 0.3415515422821045, + -0.017899898812174797 ] }, { @@ -2214,25 +2292,25 @@ "id": 40, "link": "FingerA", "position_m": [ - 0.21553662419319153, - -0.08246307820081711, - 0.31723877787590027 + 0.2677094340324402, + -0.1501556783914566, + 0.35217177867889404 ], "position_mm": [ - 215.53662419319153, - -82.46307820081711, - 317.23877787590027 + 267.7094340324402, + -150.1556783914566, + 352.17177867889404 ], "rotation_quaternion": [ - 0.25081899762153625, - -0.9551512002944946, - -0.13290834426879883, - -0.08432948589324951 + 0.021059956401586533, + 0.06727804243564606, + -0.8116653561592102, + 0.5798529982566833 ], "normal": [ - 0.09442292153835297, - 0.5015562772750854, - -0.859956681728363 + 0.04383547604084015, + -0.9441269040107727, + -0.32665398716926575 ] }, { @@ -2240,25 +2318,25 @@ "id": 41, "link": "FingerA", "position_m": [ - 0.24487937986850739, - -0.11210105568170547, - 0.34399858117103577 + 0.2358827143907547, + -0.11256645619869232, + 0.34673067927360535 ], "position_mm": [ - 244.87937986850739, - -112.10105568170547, - 343.99858117103577 + 235.8827143907547, + -112.56645619869232, + 346.73067927360535 ], "rotation_quaternion": [ - 0.22204725444316864, - 0.003033978631719947, - -0.3654671907424927, - -0.9039466977119446 + 0.9692426919937134, + 0.002282005036249757, + -0.018137134611606598, + 0.24542734026908875 ], "normal": [ - -0.16778706014156342, - 0.6593782901763916, - 0.73284912109375 + -0.03403843566775322, + -0.013326330110430717, + 0.9993317127227783 ] }, { @@ -2266,25 +2344,25 @@ "id": 42, "link": "FingerA", "position_m": [ - 0.21405166387557983, - -0.0764177069067955, - 0.34054282307624817 + 0.2639923095703125, + -0.13954909145832062, + 0.3735145628452301 ], "position_mm": [ - 214.05166387557983, - -76.4177069067955, - 340.54282307624817 + 263.9923095703125, + -139.54909145832062, + 373.5145628452301 ], "rotation_quaternion": [ - 0.2647150754928589, - 0.453290730714798, - -0.008107217960059643, - -0.8511097431182861 + 0.8447493314743042, + -0.3168453276157379, + 0.42179709672927856, + 0.0899711325764656 ], "normal": [ - -0.7758923768997192, - -0.22618548572063446, - 0.5889236330986023 + 0.6556118130683899, + 0.6112089157104492, + 0.4433925151824951 ] }, { @@ -2292,25 +2370,25 @@ "id": 43, "link": "FingerB", "position_m": [ - 0.26951199769973755, - -0.07608000934123993, - 0.34051966667175293 + 0.2080598622560501, + -0.1449533998966217, + 0.36243146657943726 ], "position_mm": [ - 269.51199769973755, - -76.08000934123993, - 340.51966667175293 + 208.0598622560501, + -144.9533998966217, + 362.43146657943726 ], "rotation_quaternion": [ - 0.7693742513656616, - 0.23698587715625763, - 0.11772578954696655, - -0.5814135074615479 + 0.526361346244812, + -0.39512625336647034, + 0.42490965127944946, + 0.6215068101882935 ], "normal": [ - -0.09442318975925446, - -0.5015563368797302, - 0.859956681728363 + -0.043835271149873734, + 0.9441269636154175, + 0.3266540467739105 ] }, { @@ -2318,25 +2396,25 @@ "id": 44, "link": "FingerB", "position_m": [ - 0.25280579924583435, - -0.08222946524620056, - 0.2942748963832855 + 0.23418523371219635, + -0.16895513236522675, + 0.3278355598449707 ], "position_mm": [ - 252.80579924583435, - -82.22946524620056, - 294.2748963832855 + 234.18523371219635, + -168.95513236522675, + 327.8355598449707 ], "rotation_quaternion": [ - 0.6558026671409607, - -0.4080226421356201, - -0.521297037601471, - -0.3628908097743988 + 0.47481709718704224, + 0.28831005096435547, + -0.19160225987434387, + 0.8091443777084351 ], "normal": [ - -0.38760069012641907, - 0.9135125875473022, - 0.12353380024433136 + 0.2846168577671051, + -0.5838568210601807, + 0.7603318095207214 ] }, { @@ -2344,25 +2422,25 @@ "id": 45, "link": "FingerB", "position_m": [ - 0.2614270746707916, - -0.055022913962602615, - 0.3319719433784485 + 0.21609467267990112, + -0.16585004329681396, + 0.37140941619873047 ], "position_mm": [ - 261.4270746707916, - -55.022913962602615, - 331.9719433784485 + 216.09467267990112, + -165.85004329681396, + 371.40941619873047 ], "rotation_quaternion": [ - 0.18035854399204254, - -0.6729050278663635, - -0.44777974486351013, - -0.5605023503303528 + 0.6045908331871033, + 0.20278345048427582, + -0.6249297261238098, + 0.45034608244895935 ], "normal": [ - 0.592807948589325, - 0.7446916103363037, - -0.30661579966545105 + -0.573008120059967, + -0.808071494102478, + 0.136683389544487 ] } ] \ No newline at end of file diff --git a/data/simulation/debug/render.npz b/data/simulation/debug/render.npz index c76f892..b10ee26 100644 Binary files a/data/simulation/debug/render.npz and b/data/simulation/debug/render.npz differ diff --git a/data/simulation/debug/render.png b/data/simulation/debug/render.png index e5e5987..235204b 100644 Binary files a/data/simulation/debug/render.png and b/data/simulation/debug/render.png differ diff --git a/pipeline/3_multiview_bundle_adjustment_v4.py b/pipeline/3_multiview_bundle_adjustment_v4.py index d373a70..e9a4bbb 100644 --- a/pipeline/3_multiview_bundle_adjustment_v4.py +++ b/pipeline/3_multiview_bundle_adjustment_v4.py @@ -1091,9 +1091,11 @@ def optimize_with_constraints( # =================================================================== def print_constraint_summary(constraints: List[Constraint]) -> None: - num_dist = sum(isinstance(c, MarkerDistanceConstraint) for c in constraints) + num_dist = sum(isinstance(c, MarkerDistanceConstraint) for c in constraints) num_joint = sum(isinstance(c, JointAxisConstraint) for c in constraints) - print(f"[INFO] Constraint summary: total={len(constraints)} distance={num_dist} joint/chain={num_joint}") + num_other = len(constraints) - num_dist - num_joint + extra = f" other={num_other}" if num_other else "" + print(f"[INFO] Constraint summary: total={len(constraints)} distance={num_dist} joint/chain={num_joint}{extra}") def print_constraint_list(constraints: List[Constraint]) -> None: @@ -1108,7 +1110,7 @@ def print_constraint_list(constraints: List[Constraint]) -> None: f"Weight={constraint.weight} | " f"Source={constraint.source}" ) - else: + elif isinstance(constraint, JointAxisConstraint): axis_str = np.array2string(constraint.joint_axis, precision=3, suppress_small=True) print( f" [{idx:03d}] JOINT_AXIS | " @@ -1119,6 +1121,12 @@ def print_constraint_list(constraints: List[Constraint]) -> None: f"Weight={constraint.weight} | " f"Source={constraint.source}" ) + else: + print( + f" [{idx:03d}] {type(constraint).__name__} | " + f"weight={getattr(constraint, 'weight', '?')} | " + f"source={getattr(constraint, 'source', '?')}" + ) def print_constraints_with_errors( diff --git a/pipeline/3_multiview_bundle_adjustment_v5_board_anchor_patch.py b/pipeline/3_multiview_bundle_adjustment_v5_board_anchor_patch.py index 1cba4c6..68f8fdd 100644 --- a/pipeline/3_multiview_bundle_adjustment_v5_board_anchor_patch.py +++ b/pipeline/3_multiview_bundle_adjustment_v5_board_anchor_patch.py @@ -165,6 +165,7 @@ def _monkey_patch_v4(): spec = importlib.util.spec_from_file_location("ba_v4", v4_path) mod = importlib.util.module_from_spec(spec) + sys.modules["ba_v4"] = mod # must be registered before exec_module for @dataclass spec.loader.exec_module(mod) # Inject PositionAnchorConstraint into the module namespace @@ -198,9 +199,19 @@ def _monkey_patch_v4(): def _patched_main(): import sys as _sys # We hijack the module-level function calls by patching compile_constraints - _orig_compile = mod.compile_constraints + _orig_compile = mod.compile_constraints + _orig_initial = mod.initial_triangulation + + # robot_data / length_scale are captured here so the initial-triangulation + # wrapper below can pin Board markers to their true world positions. + # In v4.main(), compile_constraints() runs BEFORE initial_triangulation(), + # so this dict is populated by the time the triangulation wrapper fires. + captured: Dict[str, Any] = {} def _compile_with_anchors(robot_data, length_scale, cfg): + captured["robot_data"] = robot_data + captured["length_scale"] = length_scale + marker_to_link, link_markers, constraints, issues, marker_meta = \ _orig_compile(robot_data, length_scale, cfg) @@ -209,9 +220,40 @@ def _monkey_patch_v4(): constraints = constraints + anchors return marker_to_link, link_markers, constraints, issues, marker_meta - mod.compile_constraints = _compile_with_anchors + def _initial_with_board(marker_observations, cameras): + """ + Run the normal multi-view triangulation, then overwrite every + OBSERVED Board marker with its exact robot.json world position. + Board markers define the world frame, so they must not be left at + their (z-noisy) triangulated values — not even in the initial JSON. + """ + tri = _orig_initial(marker_observations, cameras) + + robot_data = captured.get("robot_data") + length_scale = captured.get("length_scale", 1.0) + if robot_data is None: + return tri + + board = (robot_data.get("links", {}) or {}).get("Board", {}) or {} + pinned = 0 + for m in board.get("markers", []): + mid = int(m.get("id", -1)) + pos = m.get("position", None) + if mid < 0 or pos is None or len(pos) != 3: + continue + # Only pin markers that were actually observed/triangulated, + # so we don't introduce markers that no camera ever saw. + if mid in tri: + tri[mid] = np.array(pos, dtype=np.float64) * float(length_scale) + pinned += 1 + print(f"[PATCH] Board markers pinned to robot.json in initial triangulation: {pinned}") + return tri + + mod.compile_constraints = _compile_with_anchors + mod.initial_triangulation = _initial_with_board _orig_main() - mod.compile_constraints = _orig_compile # restore + mod.compile_constraints = _orig_compile # restore + mod.initial_triangulation = _orig_initial # restore mod.main = _patched_main return mod diff --git a/pipeline/5_v8_camera_z_refine.py b/pipeline/5_v8_camera_z_refine.py new file mode 100644 index 0000000..17bab20 --- /dev/null +++ b/pipeline/5_v8_camera_z_refine.py @@ -0,0 +1,218 @@ +#!/usr/bin/env python3 +""" +5_v8_camera_z_refine.py +----------------------- +Refines camera z-positions using the FK-predicted z of the Ellbow link. + +Background +---------- +Camera poses from step 2 are estimated from board markers alone. Board +markers are roughly coplanar (z ≈ 0), so the camera's z-height above the +board is poorly constrained and can be 20–40 % off. + +Once we have the elbow angle (step 3b, from 4_v8_4b_revolute_angle.py), +FK predicts where the Ellbow markers *should* be in world space. The +difference between FK-predicted z and triangulated z gives a global +z-offset for the cameras. + +Algorithm +--------- +1. Load elbow-angle result (v8_ellbow_angle.json) → joint state dict +2. Run FK with that state → predicted world positions for Ellbow markers (mm) +3. Load triangulated Ellbow marker positions from aruco_positions_optimized.json +4. delta_z_mm = median(fk_z - triangulated_z) over matched markers +5. For each camera pose file: + a. camera center world C = -R_wc.T @ t_wc + b. C_new = C + [0, 0, delta_z_mm / 1000] + c. t_wc_new = -R_wc @ C_new + d. Save as *_camera_pose_v8.json +6. Save v8_z_correction.json summary + +Usage +----- +python 5_v8_camera_z_refine.py \\ + --angle path/to/v8_ellbow_angle.json \\ + --robot path/to/robot.json \\ + --aruco path/to/aruco_positions_optimized.json \\ + -pose path/to/render_a_camera_pose.json \\ + -pose path/to/render_b_camera_pose.json \\ + --outDir path/to/output_dir \\ + [--elbowLink Ellbow] +""" + +from __future__ import annotations + +import argparse +import copy +import json +import os +import sys +import time +from pathlib import Path +from typing import Dict, List, Optional + +import numpy as np + +# robot_fk lives in the same directory as this script +sys.path.insert(0, str(Path(__file__).parent)) +from robot_fk import RobotFK + + +# ────────────────────────────────────────────────────────────── +# I/O helpers +# ────────────────────────────────────────────────────────────── + +def load_json(path: str) -> dict: + with open(path, "r", encoding="utf-8") as f: + return json.load(f) + + +def save_json(path: str, data: dict) -> None: + os.makedirs(os.path.dirname(path) or ".", exist_ok=True) + with open(path, "w", encoding="utf-8") as f: + json.dump(data, f, indent=2) + + +def load_triangulated_mm(aruco_json: dict) -> Dict[int, np.ndarray]: + """Read marker world positions (mm) from aruco_positions_*.json.""" + result: Dict[int, np.ndarray] = {} + for m in aruco_json.get("markers", []): + mid = int(m.get("marker_id", m.get("id", -1))) + if mid < 0: + continue + if "position_mm" in m: + result[mid] = np.array(m["position_mm"], dtype=float) + elif "position_m" in m: + result[mid] = np.array(m["position_m"], dtype=float) * 1000.0 + return result + + +# ────────────────────────────────────────────────────────────── +# Main +# ────────────────────────────────────────────────────────────── + +def main() -> None: + parser = argparse.ArgumentParser( + description="5v8: refine camera z-positions using FK-predicted Ellbow marker z" + ) + parser.add_argument("--angle", required=True, + help="v8_ellbow_angle.json from 4_v8_4b_revolute_angle.py") + parser.add_argument("--robot", required=True, help="robot.json") + parser.add_argument("--aruco", required=True, + help="aruco_positions_optimized.json (first-pass triangulation)") + parser.add_argument("-pose", "--poses", action="append", required=True, + help="*_camera_pose.json files (repeat for each camera)") + parser.add_argument("--outDir", required=True, help="Output directory") + parser.add_argument("--elbowLink", default="Ellbow", + help="Link name used for z estimation (default: Ellbow)") + args = parser.parse_args() + + os.makedirs(args.outDir, exist_ok=True) + + # ── 1. Load angle / state ──────────────────────────────── + angle_data = load_json(args.angle) + if angle_data.get("status") != "ok": + print(f"[ERROR] Angle estimation was not ok: {angle_data.get('reason', '?')}") + sys.exit(1) + + accumulated_state = angle_data.get("accumulated_state", {}) + elbow_link = angle_data.get("link", args.elbowLink) + + print(f"[INFO] Joint state from 4b: {accumulated_state}") + print(f"[INFO] Link used for z-ref: {elbow_link}") + + # ── 2. FK prediction ───────────────────────────────────── + fk = RobotFK.from_file(args.robot) + T = fk.compute(accumulated_state) + all_fk = fk.all_markers_world(T) # marker_id -> {world_mm, link, …} + + elbow_fk = {mid: v for mid, v in all_fk.items() if v["link"] == elbow_link} + + if not elbow_fk: + print(f"[ERROR] No FK markers found for link '{elbow_link}'") + sys.exit(1) + + print(f"[INFO] FK markers for '{elbow_link}': {sorted(elbow_fk.keys())}") + + # ── 3. Load triangulated positions ─────────────────────── + aruco_data = load_json(args.aruco) + triangulated = load_triangulated_mm(aruco_data) + + # ── 4. Compute z-deltas ────────────────────────────────── + z_deltas: List[float] = [] + print("\n[INFO] Per-marker z comparison (FK vs triangulated):") + for mid in sorted(elbow_fk.keys()): + fk_z = float(elbow_fk[mid]["world_mm"][2]) + if mid not in triangulated: + print(f" Marker {mid:4d}: FK z={fk_z:8.1f} mm [NOT triangulated – skip]") + continue + obs_z = float(triangulated[mid][2]) + delta = fk_z - obs_z + z_deltas.append(delta) + print(f" Marker {mid:4d}: FK z={fk_z:8.1f} mm obs z={obs_z:8.1f} mm Δz={delta:+7.1f} mm") + + if not z_deltas: + print(f"\n[ERROR] No matched markers for '{elbow_link}' — cannot compute z correction.") + sys.exit(1) + + delta_z_mm = float(np.median(z_deltas)) + print(f"\n[INFO] z-correction (median): {delta_z_mm:+.1f} mm " + f"(from {len(z_deltas)} markers)") + if abs(delta_z_mm) < 1.0: + print("[INFO] Correction < 1 mm — cameras already well-calibrated in z.") + + # ── 5. Apply correction to each camera pose ────────────── + corrected_files: List[str] = [] + + for pose_file in args.poses: + pose_data = load_json(pose_file) + + pose_section = pose_data.get("camera_pose", {}) or {} + w2c = pose_section.get("world_to_camera", {}) or {} + + R_wc = np.array(w2c.get("rotation_matrix", []), dtype=float).reshape(3, 3) + t_wc = np.array(w2c.get("translation_m", []), dtype=float).reshape(3) + + # Camera centre in world (metres) + C_world = -R_wc.T @ t_wc + C_world_new = C_world + np.array([0.0, 0.0, delta_z_mm / 1000.0]) + + t_wc_new = -R_wc @ C_world_new + + pose_new = copy.deepcopy(pose_data) + pose_new["camera_pose"]["world_to_camera"]["translation_m"] = \ + [float(v) for v in t_wc_new.tolist()] + pose_new["camera_pose"]["camera_in_world"]["position_m"] = \ + [float(v) for v in C_world_new.tolist()] + pose_new["camera_pose"]["camera_in_world"]["position_mm"] = \ + [float(v * 1000.0) for v in C_world_new.tolist()] + pose_new["v8_z_correction_mm"] = delta_z_mm + pose_new["created_utc"] = time.strftime("%Y-%m-%dT%H:%M:%SZ", time.gmtime()) + + basename = os.path.basename(pose_file) + out_name = basename.replace("_camera_pose.json", "_camera_pose_v8.json") + if out_name == basename: + out_name = os.path.splitext(basename)[0] + "_v8.json" + + out_path = os.path.join(args.outDir, out_name) + save_json(out_path, pose_new) + print(f"[INFO] Saved: {out_path}") + corrected_files.append(out_path) + + # ── 6. Save correction summary ─────────────────────────── + summary = { + "schema_version": "1.0", + "created_utc": time.strftime("%Y-%m-%dT%H:%M:%SZ", time.gmtime()), + "elbow_link": elbow_link, + "z_correction_mm": delta_z_mm, + "n_markers_used": len(z_deltas), + "z_deltas_mm": z_deltas, + "corrected_pose_files": corrected_files, + } + summary_path = os.path.join(args.outDir, "v8_z_correction.json") + save_json(summary_path, summary) + print(f"\n[INFO] Correction summary → {summary_path}") + + +if __name__ == "__main__": + main() diff --git a/pipeline/__pycache__/3_multiview_bundle_adjustment_v4.cpython-311.pyc b/pipeline/__pycache__/3_multiview_bundle_adjustment_v4.cpython-311.pyc index 7d7478a..6f1b376 100644 Binary files a/pipeline/__pycache__/3_multiview_bundle_adjustment_v4.cpython-311.pyc and b/pipeline/__pycache__/3_multiview_bundle_adjustment_v4.cpython-311.pyc differ diff --git a/pipeline/__pycache__/3_multiview_bundle_adjustment_v5_board_anchor_patch.cpython-311.pyc b/pipeline/__pycache__/3_multiview_bundle_adjustment_v5_board_anchor_patch.cpython-311.pyc new file mode 100644 index 0000000..0f41ab8 Binary files /dev/null and b/pipeline/__pycache__/3_multiview_bundle_adjustment_v5_board_anchor_patch.cpython-311.pyc differ diff --git a/robot_viewer.html b/robot_viewer.html deleted file mode 100644 index 6837d94..0000000 --- a/robot_viewer.html +++ /dev/null @@ -1,751 +0,0 @@ - - -
- -