799 lines
18 KiB
JSON
799 lines
18 KiB
JSON
{
|
|
"schema_version": "2.0",
|
|
"created_utc": "2026-05-29T18:13:32Z",
|
|
"source": {
|
|
"marker_positions_file": "aruco_positions_optimized_Set3_v4.json",
|
|
"robot_file": "..\\robot.json"
|
|
},
|
|
"summary": {
|
|
"num_links": 9,
|
|
"num_observed_markers": 8,
|
|
"num_link_markers": 25,
|
|
"root_link": "Board",
|
|
"optimizer": {
|
|
"cost": 0.001596169080421209,
|
|
"success": true,
|
|
"status": 2,
|
|
"message": "`ftol` termination condition is satisfied.",
|
|
"nfev": 4,
|
|
"njev": 4
|
|
},
|
|
"fit_stats": {
|
|
"num_markers_used": 8,
|
|
"mean_error_m": 0.010174015156011006,
|
|
"median_error_m": 0.0081510187450574,
|
|
"rms_error_m": 0.01234803815522387,
|
|
"worst_error_m": 0.027803375607782888,
|
|
"p80_error_m": 0.01066478101691201,
|
|
"p90_error_m": 0.016414008933028513
|
|
},
|
|
"stages": [
|
|
{
|
|
"depth": 0,
|
|
"active_links": [
|
|
"Board"
|
|
],
|
|
"active_joint_vars": [],
|
|
"mean_error_m": 4.1869206709871756e-05,
|
|
"rms_error_m": 4.423857209220498e-05,
|
|
"worst_error_m": 6.087233578986151e-05,
|
|
"num_markers_used": 4,
|
|
"optimizer_info": {
|
|
"cost": 7.828205043028872e-09,
|
|
"success": true,
|
|
"status": 1,
|
|
"message": "`gtol` termination condition is satisfied.",
|
|
"nfev": 1,
|
|
"njev": 1
|
|
}
|
|
},
|
|
{
|
|
"depth": 1,
|
|
"active_links": [
|
|
"Board",
|
|
"Base"
|
|
],
|
|
"active_joint_vars": [
|
|
"x"
|
|
],
|
|
"mean_error_m": 4.1869206709871756e-05,
|
|
"rms_error_m": 4.423857209220498e-05,
|
|
"worst_error_m": 6.087233578986151e-05,
|
|
"num_markers_used": 4,
|
|
"optimizer_info": {
|
|
"cost": 7.828205043028872e-09,
|
|
"success": true,
|
|
"status": 1,
|
|
"message": "`gtol` termination condition is satisfied.",
|
|
"nfev": 1,
|
|
"njev": 1
|
|
}
|
|
},
|
|
{
|
|
"depth": 2,
|
|
"active_links": [
|
|
"Board",
|
|
"Base",
|
|
"Arm1"
|
|
],
|
|
"active_joint_vars": [
|
|
"x",
|
|
"y"
|
|
],
|
|
"mean_error_m": 0.006745485580070273,
|
|
"rms_error_m": 0.007483965411863164,
|
|
"worst_error_m": 0.013168099127981843,
|
|
"num_markers_used": 7,
|
|
"optimizer_info": {
|
|
"cost": 0.0006290927673917855,
|
|
"success": true,
|
|
"status": 2,
|
|
"message": "`ftol` termination condition is satisfied.",
|
|
"nfev": 5,
|
|
"njev": 5
|
|
}
|
|
},
|
|
{
|
|
"depth": 3,
|
|
"active_links": [
|
|
"Board",
|
|
"Base",
|
|
"Arm1",
|
|
"Ellbow"
|
|
],
|
|
"active_joint_vars": [
|
|
"x",
|
|
"y",
|
|
"z"
|
|
],
|
|
"mean_error_m": 0.0066626047418244985,
|
|
"rms_error_m": 0.007500866443446507,
|
|
"worst_error_m": 0.012885780730839473,
|
|
"num_markers_used": 7,
|
|
"optimizer_info": {
|
|
"cost": 0.0005983942414244817,
|
|
"success": true,
|
|
"status": 1,
|
|
"message": "`gtol` termination condition is satisfied.",
|
|
"nfev": 5,
|
|
"njev": 5
|
|
}
|
|
},
|
|
{
|
|
"depth": 4,
|
|
"active_links": [
|
|
"Board",
|
|
"Base",
|
|
"Arm1",
|
|
"Ellbow",
|
|
"Arm2"
|
|
],
|
|
"active_joint_vars": [
|
|
"x",
|
|
"y",
|
|
"z",
|
|
"a"
|
|
],
|
|
"mean_error_m": 0.01000608974879495,
|
|
"rms_error_m": 0.012284520280612297,
|
|
"worst_error_m": 0.0278453161070784,
|
|
"num_markers_used": 8,
|
|
"optimizer_info": {
|
|
"cost": 0.001600681668676478,
|
|
"success": true,
|
|
"status": 2,
|
|
"message": "`ftol` termination condition is satisfied.",
|
|
"nfev": 5,
|
|
"njev": 5
|
|
}
|
|
},
|
|
{
|
|
"depth": 5,
|
|
"active_links": [
|
|
"Board",
|
|
"Base",
|
|
"Arm1",
|
|
"Ellbow",
|
|
"Arm2",
|
|
"Hand"
|
|
],
|
|
"active_joint_vars": [
|
|
"x",
|
|
"y",
|
|
"z",
|
|
"a",
|
|
"b"
|
|
],
|
|
"mean_error_m": 0.010093215903747043,
|
|
"rms_error_m": 0.01231106970746885,
|
|
"worst_error_m": 0.027801581705374914,
|
|
"num_markers_used": 8,
|
|
"optimizer_info": {
|
|
"cost": 0.0015973675989890592,
|
|
"success": true,
|
|
"status": 2,
|
|
"message": "`ftol` termination condition is satisfied.",
|
|
"nfev": 4,
|
|
"njev": 4
|
|
}
|
|
},
|
|
{
|
|
"depth": 6,
|
|
"active_links": [
|
|
"Board",
|
|
"Base",
|
|
"Arm1",
|
|
"Ellbow",
|
|
"Arm2",
|
|
"Hand",
|
|
"Palm"
|
|
],
|
|
"active_joint_vars": [
|
|
"x",
|
|
"y",
|
|
"z",
|
|
"a",
|
|
"b",
|
|
"c"
|
|
],
|
|
"mean_error_m": 0.01014248256819925,
|
|
"rms_error_m": 0.012332226944012195,
|
|
"worst_error_m": 0.027800128557559874,
|
|
"num_markers_used": 8,
|
|
"optimizer_info": {
|
|
"cost": 0.0015965216948719777,
|
|
"success": true,
|
|
"status": 2,
|
|
"message": "`ftol` termination condition is satisfied.",
|
|
"nfev": 4,
|
|
"njev": 4
|
|
}
|
|
},
|
|
{
|
|
"depth": 7,
|
|
"active_links": [
|
|
"Board",
|
|
"Base",
|
|
"Arm1",
|
|
"Ellbow",
|
|
"Arm2",
|
|
"Hand",
|
|
"Palm",
|
|
"FingerA",
|
|
"FingerB"
|
|
],
|
|
"active_joint_vars": [
|
|
"x",
|
|
"y",
|
|
"z",
|
|
"a",
|
|
"b",
|
|
"c",
|
|
"e"
|
|
],
|
|
"mean_error_m": 0.010174015156011006,
|
|
"rms_error_m": 0.01234803815522387,
|
|
"worst_error_m": 0.027803375607782888,
|
|
"num_markers_used": 8,
|
|
"optimizer_info": {
|
|
"cost": 0.001596169080421209,
|
|
"success": true,
|
|
"status": 2,
|
|
"message": "`ftol` termination condition is satisfied.",
|
|
"nfev": 4,
|
|
"njev": 4
|
|
}
|
|
}
|
|
]
|
|
},
|
|
"world_pose": {
|
|
"root_translation_m": [
|
|
-0.00010499551928665273,
|
|
-0.004122751371632455,
|
|
0.007868336770484426
|
|
],
|
|
"root_rotation_matrix": [
|
|
[
|
|
0.9998881512412199,
|
|
0.00015742221075852172,
|
|
0.01495527417545956
|
|
],
|
|
[
|
|
-0.00034452146365532657,
|
|
0.9999217021212259,
|
|
0.012508834156371969
|
|
],
|
|
[
|
|
-0.014952134040888227,
|
|
-0.012512587471746087,
|
|
0.9998099163552967
|
|
]
|
|
],
|
|
"root_euler_xyz_deg": [
|
|
-0.7170173207318126,
|
|
0.8567260997949179,
|
|
-0.019741833137479233
|
|
]
|
|
},
|
|
"movements": {
|
|
"x": {
|
|
"value_m": 0.0036718418153270935,
|
|
"value_mm": 3.6718418153270935,
|
|
"joint_type": "linear",
|
|
"link": "Base"
|
|
},
|
|
"y": {
|
|
"value_rad": 0.153997576654123,
|
|
"value_deg": 8.823411197523626,
|
|
"joint_type": "revolute",
|
|
"link": "Arm1"
|
|
},
|
|
"z": {
|
|
"value_rad": 0.3681612038699359,
|
|
"value_deg": 21.094083162202796,
|
|
"joint_type": "revolute",
|
|
"link": "Ellbow"
|
|
},
|
|
"a": {
|
|
"value_rad": 0.16870892545216015,
|
|
"value_deg": 9.666309394596011,
|
|
"joint_type": "revolute",
|
|
"link": "Arm2"
|
|
},
|
|
"b": {
|
|
"value_rad": 0.03490658503988659,
|
|
"value_deg": 2.0,
|
|
"joint_type": "revolute",
|
|
"link": "Hand"
|
|
},
|
|
"c": {
|
|
"value_rad": 0.15707963267948966,
|
|
"value_deg": 9.0,
|
|
"joint_type": "revolute",
|
|
"link": "Palm"
|
|
},
|
|
"e": {
|
|
"value_m": 0.001,
|
|
"value_mm": 1.0,
|
|
"joint_type": "linear",
|
|
"link": "FingerB"
|
|
}
|
|
},
|
|
"links": [
|
|
{
|
|
"link": "Board",
|
|
"parent": null,
|
|
"position_m": [
|
|
-0.00010499551928665273,
|
|
-0.004122751371632455,
|
|
0.007868336770484426
|
|
],
|
|
"rotation_matrix": [
|
|
[
|
|
0.9998881512412199,
|
|
0.00015742221075852172,
|
|
0.01495527417545956
|
|
],
|
|
[
|
|
-0.00034452146365532657,
|
|
0.9999217021212259,
|
|
0.012508834156371969
|
|
],
|
|
[
|
|
-0.014952134040888227,
|
|
-0.012512587471746087,
|
|
0.9998099163552967
|
|
]
|
|
],
|
|
"euler_xyz_deg": [
|
|
-0.7170173207318126,
|
|
0.8567260997949179,
|
|
-0.019741833137479233
|
|
],
|
|
"num_observed_markers": 4,
|
|
"num_markers_total": 9
|
|
},
|
|
{
|
|
"link": "Base",
|
|
"parent": "Board",
|
|
"position_m": [
|
|
0.003805719991894641,
|
|
-0.003923875053447029,
|
|
0.02381039356116952
|
|
],
|
|
"rotation_matrix": [
|
|
[
|
|
0.9998881512412199,
|
|
0.00015742221075852172,
|
|
0.01495527417545956
|
|
],
|
|
[
|
|
-0.00034452146365532657,
|
|
0.9999217021212259,
|
|
0.012508834156371969
|
|
],
|
|
[
|
|
-0.014952134040888227,
|
|
-0.012512587471746087,
|
|
0.9998099163552967
|
|
]
|
|
],
|
|
"euler_xyz_deg": [
|
|
-0.7170173207318126,
|
|
0.8567260997949179,
|
|
-0.019741833137479233
|
|
],
|
|
"num_observed_markers": 0,
|
|
"num_markers_total": 0
|
|
},
|
|
{
|
|
"link": "Arm1",
|
|
"parent": "Base",
|
|
"position_m": [
|
|
0.11448340556508642,
|
|
0.10459266895168001,
|
|
0.06580574560571159
|
|
],
|
|
"rotation_matrix": [
|
|
[
|
|
0.9998881512411962,
|
|
-0.002138424520931235,
|
|
0.014802437231208825
|
|
],
|
|
[
|
|
-0.00034452146365531843,
|
|
0.9861696920072487,
|
|
0.16573840795434897
|
|
],
|
|
[
|
|
-0.014952134040887874,
|
|
-0.16572497007647763,
|
|
0.9860586534181053
|
|
]
|
|
],
|
|
"euler_xyz_deg": [
|
|
-9.540428518246754,
|
|
0.8567260997949179,
|
|
-0.019741833137479233
|
|
],
|
|
"num_observed_markers": 3,
|
|
"num_markers_total": 4
|
|
},
|
|
{
|
|
"link": "Ellbow",
|
|
"parent": "Arm1",
|
|
"position_m": [
|
|
0.11501801169531922,
|
|
-0.14194975405013216,
|
|
0.107236988124831
|
|
],
|
|
"rotation_matrix": [
|
|
[
|
|
0.9998881512410622,
|
|
-0.007322534197157381,
|
|
0.013040916392148211
|
|
],
|
|
[
|
|
-0.00034452146365527225,
|
|
0.8604378277497007,
|
|
0.5095553217090676
|
|
],
|
|
[
|
|
-0.01495213404088587,
|
|
-0.5095028214544074,
|
|
0.8603390660764603
|
|
]
|
|
],
|
|
"euler_xyz_deg": [
|
|
-30.634511680430315,
|
|
0.8567260997949179,
|
|
-0.019741833137479233
|
|
],
|
|
"num_observed_markers": 0,
|
|
"num_markers_total": 4
|
|
},
|
|
{
|
|
"link": "Arm2",
|
|
"parent": "Ellbow",
|
|
"position_m": [
|
|
0.20500794530701483,
|
|
-0.14198076098186113,
|
|
0.10589129606115127
|
|
],
|
|
"rotation_matrix": [
|
|
[
|
|
0.9878818086254475,
|
|
-0.007322534197157173,
|
|
-0.15503519819536069
|
|
],
|
|
[
|
|
0.08521967406056483,
|
|
0.8604378277496763,
|
|
0.5023786935470759
|
|
],
|
|
[
|
|
0.12971946399655934,
|
|
-0.509502821454393,
|
|
0.8506349014648388
|
|
]
|
|
],
|
|
"euler_xyz_deg": [
|
|
-30.920246253571754,
|
|
-7.453381520416379,
|
|
4.930417324847138
|
|
],
|
|
"num_observed_markers": 1,
|
|
"num_markers_total": 8
|
|
},
|
|
{
|
|
"link": "Hand",
|
|
"parent": "Arm2",
|
|
"position_m": [
|
|
0.20683857885630413,
|
|
-0.3570902179192802,
|
|
0.23326700142474951
|
|
],
|
|
"rotation_matrix": [
|
|
[
|
|
0.9878818086254463,
|
|
-0.012728723895357681,
|
|
-0.15468520218346354
|
|
],
|
|
[
|
|
0.08521967406056473,
|
|
0.8774464358320986,
|
|
0.4720438108885581
|
|
],
|
|
[
|
|
0.12971946399655918,
|
|
-0.4795057161631937,
|
|
0.867898109703497
|
|
]
|
|
],
|
|
"euler_xyz_deg": [
|
|
-28.92024625357375,
|
|
-7.453381520416377,
|
|
4.930417324847139
|
|
],
|
|
"num_observed_markers": 0,
|
|
"num_markers_total": 0
|
|
},
|
|
{
|
|
"link": "Palm",
|
|
"parent": "Hand",
|
|
"position_m": [
|
|
0.20683857885630413,
|
|
-0.3570902179192802,
|
|
0.23326700142474951
|
|
],
|
|
"rotation_matrix": [
|
|
[
|
|
0.9515212474122047,
|
|
-0.012728723895357367,
|
|
-0.3073195329143514
|
|
],
|
|
[
|
|
0.15801439949076734,
|
|
0.8774464358320769,
|
|
0.45290087414217106
|
|
],
|
|
[
|
|
0.2638915786384106,
|
|
-0.4795057161631819,
|
|
0.8369202488231169
|
|
]
|
|
],
|
|
"euler_xyz_deg": [
|
|
-29.810153131835676,
|
|
-15.301100626605999,
|
|
9.428779059340897
|
|
],
|
|
"num_observed_markers": 0,
|
|
"num_markers_total": 0
|
|
},
|
|
{
|
|
"link": "FingerA",
|
|
"parent": "Palm",
|
|
"position_m": [
|
|
0.2120416904297017,
|
|
-0.38701077117594923,
|
|
0.2513691593836527
|
|
],
|
|
"rotation_matrix": [
|
|
[
|
|
0.9515212474122047,
|
|
-0.012728723895357367,
|
|
-0.3073195329143514
|
|
],
|
|
[
|
|
0.15801439949076734,
|
|
0.8774464358320769,
|
|
0.45290087414217106
|
|
],
|
|
[
|
|
0.2638915786384106,
|
|
-0.4795057161631819,
|
|
0.8369202488231169
|
|
]
|
|
],
|
|
"euler_xyz_deg": [
|
|
-29.810153131835676,
|
|
-15.301100626605999,
|
|
9.428779059340897
|
|
],
|
|
"num_observed_markers": 0,
|
|
"num_markers_total": 0
|
|
},
|
|
{
|
|
"link": "FingerB",
|
|
"parent": "Palm",
|
|
"position_m": [
|
|
0.20252647795558157,
|
|
-0.38859091517085653,
|
|
0.24873024359726909
|
|
],
|
|
"rotation_matrix": [
|
|
[
|
|
0.9515212474122047,
|
|
-0.012728723895357367,
|
|
-0.3073195329143514
|
|
],
|
|
[
|
|
0.15801439949076734,
|
|
0.8774464358320769,
|
|
0.45290087414217106
|
|
],
|
|
[
|
|
0.2638915786384106,
|
|
-0.4795057161631819,
|
|
0.8369202488231169
|
|
]
|
|
],
|
|
"euler_xyz_deg": [
|
|
-29.810153131835676,
|
|
-15.301100626605999,
|
|
9.428779059340897
|
|
],
|
|
"num_observed_markers": 0,
|
|
"num_markers_total": 0
|
|
}
|
|
],
|
|
"markers": [
|
|
{
|
|
"marker_id": 122,
|
|
"link": "Arm2",
|
|
"observed_position_m": [
|
|
0.16408414603046484,
|
|
-0.2598816877789887,
|
|
0.17784668754227578
|
|
],
|
|
"predicted_position_m": [
|
|
0.17125220583520576,
|
|
-0.24133248628194467,
|
|
0.15841543082416373
|
|
],
|
|
"error_m": [
|
|
0.007168059804740917,
|
|
0.018549201497044004,
|
|
-0.01943125671811205
|
|
],
|
|
"error_norm_m": 0.027803375607782888,
|
|
"error_norm_mm": 27.80337560778289,
|
|
"marker_size": null
|
|
},
|
|
{
|
|
"marker_id": 198,
|
|
"link": "Arm1",
|
|
"observed_position_m": [
|
|
0.11704671868929717,
|
|
-0.05006352997427808,
|
|
0.13545744846179997
|
|
],
|
|
"predicted_position_m": [
|
|
0.11534363879152772,
|
|
-0.047393637491077556,
|
|
0.1268337936875817
|
|
],
|
|
"error_m": [
|
|
-0.0017030798977694522,
|
|
0.0026698924832005214,
|
|
-0.008623654774218281
|
|
],
|
|
"error_norm_m": 0.009186742005462807,
|
|
"error_norm_mm": 9.186742005462806,
|
|
"marker_size": 25
|
|
},
|
|
{
|
|
"marker_id": 210,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.019883267288547467,
|
|
-0.019568887683375974,
|
|
-6.02159742251129e-05
|
|
],
|
|
"predicted_position_m": [
|
|
0.019894105643575213,
|
|
-0.024124323193083167,
|
|
0.008119488814008173
|
|
],
|
|
"error_m": [
|
|
1.083835502774591e-05,
|
|
-0.004555435509707193,
|
|
0.008179704788233285
|
|
],
|
|
"error_norm_m": 0.0093626748622222,
|
|
"error_norm_mm": 9.3626748622222,
|
|
"marker_size": null
|
|
},
|
|
{
|
|
"marker_id": 211,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.24989200282636703,
|
|
-0.009772675866705374,
|
|
1.0334501290569615e-05
|
|
],
|
|
"predicted_position_m": [
|
|
0.24986995465116338,
|
|
-0.014204346108511633,
|
|
0.004555372109886419
|
|
],
|
|
"error_m": [
|
|
-2.2048175203653875e-05,
|
|
-0.0044316702418062594,
|
|
0.004545037608595849
|
|
],
|
|
"error_norm_m": 0.006348035453405379,
|
|
"error_norm_mm": 6.348035453405379,
|
|
"marker_size": null
|
|
},
|
|
{
|
|
"marker_id": 214,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.34989199483349664,
|
|
-0.009735514620349328,
|
|
1.4271508683918328e-05
|
|
],
|
|
"predicted_position_m": [
|
|
0.3498587697752854,
|
|
-0.014238798254877167,
|
|
0.003060158705797595
|
|
],
|
|
"error_m": [
|
|
-3.322505821123922e-05,
|
|
-0.0045032836345278385,
|
|
0.0030458871971136767
|
|
],
|
|
"error_norm_m": 0.005436735805153714,
|
|
"error_norm_mm": 5.436735805153714,
|
|
"marker_size": null
|
|
},
|
|
{
|
|
"marker_id": 215,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.24981646807454147,
|
|
-0.08977263518943693,
|
|
-1.508171313798581e-05
|
|
],
|
|
"predicted_position_m": [
|
|
0.2498573608743027,
|
|
-0.09419808227820971,
|
|
0.005556379107626107
|
|
],
|
|
"error_m": [
|
|
4.089279976121629e-05,
|
|
-0.00442544708877278,
|
|
0.005571460820764092
|
|
],
|
|
"error_norm_m": 0.007115295484651995,
|
|
"error_norm_mm": 7.115295484651996,
|
|
"marker_size": null
|
|
},
|
|
{
|
|
"marker_id": 229,
|
|
"link": "Arm1",
|
|
"observed_position_m": [
|
|
0.11773154751353263,
|
|
-0.13967941405892637,
|
|
0.1437326114716167
|
|
],
|
|
"predicted_position_m": [
|
|
0.11553609699841152,
|
|
-0.13614890977172994,
|
|
0.14174904099446467
|
|
],
|
|
"error_m": [
|
|
-0.0021954505151211,
|
|
0.003530504287196423,
|
|
-0.00198357047715203
|
|
],
|
|
"error_norm_m": 0.004606410242703852,
|
|
"error_norm_mm": 4.606410242703852,
|
|
"marker_size": 25
|
|
},
|
|
{
|
|
"marker_id": 243,
|
|
"link": "Arm1",
|
|
"observed_position_m": [
|
|
0.11835862963107012,
|
|
-0.16963843269272738,
|
|
0.10433506872776273
|
|
],
|
|
"predicted_position_m": [
|
|
0.11509285655355182,
|
|
-0.17646569327038591,
|
|
0.11303736207750772
|
|
],
|
|
"error_m": [
|
|
-0.003265773077518297,
|
|
-0.006827260577658534,
|
|
0.008702293349744997
|
|
],
|
|
"error_norm_m": 0.011532851786705215,
|
|
"error_norm_mm": 11.532851786705216,
|
|
"marker_size": 25
|
|
}
|
|
]
|
|
} |