5426 lines
141 KiB
JSON
5426 lines
141 KiB
JSON
{
|
|
"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
|
|
}
|
|
]
|
|
} |