5025 lines
129 KiB
JSON
5025 lines
129 KiB
JSON
{
|
|
"schema_version": "1.0",
|
|
"method": "deterministic_geometric_sequential_prefix",
|
|
"created_utc": "2026-05-31T14:42:22Z",
|
|
"root_pose": {
|
|
"translation_m": [
|
|
-0.0032757286413787057,
|
|
0.0012217999942842755,
|
|
-0.006254103931395576
|
|
],
|
|
"rotation_matrix": [
|
|
[
|
|
0.9994298994856179,
|
|
-0.015941269979709575,
|
|
-0.029761584729322686
|
|
],
|
|
[
|
|
0.016194128848459305,
|
|
0.999834627579146,
|
|
0.00827452019812642
|
|
],
|
|
[
|
|
0.029624756623576654,
|
|
-0.008751765827746193,
|
|
0.9995227763237263
|
|
]
|
|
],
|
|
"euler_xyz_deg": [
|
|
-0.5016658380806522,
|
|
-1.6976218983174125,
|
|
0.928303272356586
|
|
]
|
|
},
|
|
"movements": {
|
|
"x": {
|
|
"value_m": 0.049601955968715646,
|
|
"value_mm": 49.60195596871564,
|
|
"joint_type": "linear",
|
|
"link": "Base"
|
|
},
|
|
"y": {
|
|
"value_rad": 0.1983555527659142,
|
|
"value_deg": 11.364936016471388,
|
|
"joint_type": "revolute",
|
|
"link": "Arm1"
|
|
},
|
|
"z": {
|
|
"value_rad": -1.383202430654766,
|
|
"value_deg": -79.251661488755,
|
|
"joint_type": "revolute",
|
|
"link": "Ellbow"
|
|
},
|
|
"a": {
|
|
"value_rad": -1.370706275771358,
|
|
"value_deg": -78.53568455379394,
|
|
"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": [
|
|
-0.0032757286413787057,
|
|
0.0012217999942842755,
|
|
-0.006254103931395576
|
|
],
|
|
"rotation_matrix": [
|
|
[
|
|
0.9994298994856179,
|
|
-0.015941269979709575,
|
|
-0.029761584729322686
|
|
],
|
|
[
|
|
0.016194128848459305,
|
|
0.999834627579146,
|
|
0.00827452019812642
|
|
],
|
|
[
|
|
0.029624756623576654,
|
|
-0.008751765827746193,
|
|
0.9995227763237263
|
|
]
|
|
]
|
|
},
|
|
"Base": {
|
|
"translation_m": [
|
|
0.04582176387100608,
|
|
0.0021574527835464814,
|
|
0.011207706363409143
|
|
],
|
|
"rotation_matrix": [
|
|
[
|
|
0.9994298994856179,
|
|
-0.015941269979709575,
|
|
-0.029761584729322686
|
|
],
|
|
[
|
|
0.016194128848459305,
|
|
0.999834627579146,
|
|
0.00827452019812642
|
|
],
|
|
[
|
|
0.029624756623576654,
|
|
-0.008751765827746193,
|
|
0.9995227763237263
|
|
]
|
|
]
|
|
},
|
|
"Arm1": {
|
|
"translation_m": [
|
|
0.1526981243437959,
|
|
0.11229330014434045,
|
|
0.058499763817173665
|
|
],
|
|
"rotation_matrix": [
|
|
[
|
|
0.9994298994855787,
|
|
-0.009763952459451988,
|
|
-0.032319363337419194
|
|
],
|
|
[
|
|
0.01619412884845867,
|
|
0.978599268587566,
|
|
0.20513708029179437
|
|
],
|
|
[
|
|
0.029624756623575492,
|
|
-0.20554351547098768,
|
|
0.9781994873453695
|
|
]
|
|
]
|
|
},
|
|
"Ellbow": {
|
|
"translation_m": [
|
|
0.15513911245865888,
|
|
-0.13235651700255102,
|
|
0.10988564268492058
|
|
],
|
|
"rotation_matrix": [
|
|
[
|
|
0.9994298994839527,
|
|
-0.03357327981303085,
|
|
0.0035652344607738514
|
|
],
|
|
[
|
|
0.016194128848432323,
|
|
0.3840425208978849,
|
|
-0.9231733815114195
|
|
],
|
|
[
|
|
0.029624756623527294,
|
|
0.9227048157579893,
|
|
0.38436726807833427
|
|
]
|
|
]
|
|
},
|
|
"Arm2": {
|
|
"translation_m": [
|
|
0.24508780341221462,
|
|
-0.1308990454061921,
|
|
0.11255187078103804
|
|
],
|
|
"rotation_matrix": [
|
|
[
|
|
0.1951501708459349,
|
|
-0.033573279812977044,
|
|
0.9801985746246256
|
|
],
|
|
[
|
|
0.9079735631403052,
|
|
0.3840425208972694,
|
|
-0.16761667809931402
|
|
],
|
|
[
|
|
-0.37081048994482163,
|
|
0.9227048157565108,
|
|
0.10542961406360711
|
|
]
|
|
]
|
|
},
|
|
"Hand": {
|
|
"translation_m": [
|
|
0.25348112336545886,
|
|
-0.22690967563050946,
|
|
-0.11812433315808965
|
|
],
|
|
"rotation_matrix": [
|
|
[
|
|
0.1951501708459349,
|
|
-0.033573279812977044,
|
|
0.9801985746246256
|
|
],
|
|
[
|
|
0.9079735631403052,
|
|
0.3840425208972694,
|
|
-0.16761667809931402
|
|
],
|
|
[
|
|
-0.37081048994482163,
|
|
0.9227048157565108,
|
|
0.10542961406360711
|
|
]
|
|
]
|
|
},
|
|
"Palm": {
|
|
"translation_m": [
|
|
0.25348112336545886,
|
|
-0.22690967563050946,
|
|
-0.11812433315808965
|
|
],
|
|
"rotation_matrix": [
|
|
[
|
|
0.1951501708459349,
|
|
-0.033573279812977044,
|
|
0.9801985746246256
|
|
],
|
|
[
|
|
0.9079735631403052,
|
|
0.3840425208972694,
|
|
-0.16761667809931402
|
|
],
|
|
[
|
|
-0.37081048994482163,
|
|
0.9227048157565108,
|
|
0.10542961406360711
|
|
]
|
|
]
|
|
},
|
|
"FingerA": {
|
|
"translation_m": [
|
|
0.2554367888422968,
|
|
-0.23671926960935266,
|
|
-0.15190224366934682
|
|
],
|
|
"rotation_matrix": [
|
|
[
|
|
0.1951501708459349,
|
|
-0.033573279812977044,
|
|
0.9801985746246256
|
|
],
|
|
[
|
|
0.9079735631403052,
|
|
0.3840425208972694,
|
|
-0.16761667809931402
|
|
],
|
|
[
|
|
-0.37081048994482163,
|
|
0.9227048157565108,
|
|
0.10542961406360711
|
|
]
|
|
]
|
|
},
|
|
"FingerB": {
|
|
"translation_m": [
|
|
0.2538755874755293,
|
|
-0.2439830581144751,
|
|
-0.14893575974978823
|
|
],
|
|
"rotation_matrix": [
|
|
[
|
|
0.1951501708459349,
|
|
-0.033573279812977044,
|
|
0.9801985746246256
|
|
],
|
|
[
|
|
0.9079735631403052,
|
|
0.3840425208972694,
|
|
-0.16761667809931402
|
|
],
|
|
[
|
|
-0.37081048994482163,
|
|
0.9227048157565108,
|
|
0.10542961406360711
|
|
]
|
|
]
|
|
}
|
|
},
|
|
"stage_reports": [
|
|
{
|
|
"method": "deterministic_geometric_prefix",
|
|
"active_links": [
|
|
"Board",
|
|
"Base",
|
|
"Arm1"
|
|
],
|
|
"active_observations": 43,
|
|
"joint_updates": [
|
|
{
|
|
"pass": 0,
|
|
"updates": [
|
|
{
|
|
"link": "Base",
|
|
"joint_variable": "x",
|
|
"joint_type": "linear",
|
|
"old": 0.0,
|
|
"new": 0.03551003717236282,
|
|
"info": {
|
|
"reason": "weighted_projection",
|
|
"used_markers": 3,
|
|
"axis_world": [
|
|
0.999429899484619,
|
|
0.01619412884844312,
|
|
0.029624756623547046
|
|
],
|
|
"per_marker": [
|
|
{
|
|
"marker_id": 198,
|
|
"q_i": 0.016119811341528775,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 229,
|
|
"q_i": 0.05888877390306697,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 243,
|
|
"q_i": 0.0315215262724927,
|
|
"weight": 1.0
|
|
}
|
|
]
|
|
}
|
|
},
|
|
{
|
|
"link": "Arm1",
|
|
"joint_variable": "y",
|
|
"joint_type": "revolute",
|
|
"old": 0.0,
|
|
"new": 0.6043859396479823,
|
|
"info": {
|
|
"reason": "2d_alignment+normal_tiebreak",
|
|
"used_markers": 3,
|
|
"axis_world": [
|
|
-0.999429899484619,
|
|
-0.01619412884844312,
|
|
-0.029624756623547046
|
|
],
|
|
"axis_id": 0,
|
|
"theta_rad": 0.604385939647982,
|
|
"theta_alt_rad": -2.537206713941811,
|
|
"score_theta": 0.22073724094261074,
|
|
"score_theta_alt": 0.575346031336051,
|
|
"best_score": 0.22073724094261074,
|
|
"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.03551003717236282,
|
|
"new": 0.03551003717236279,
|
|
"info": {
|
|
"reason": "weighted_projection",
|
|
"used_markers": 3,
|
|
"axis_world": [
|
|
0.999429899484619,
|
|
0.01619412884844312,
|
|
0.029624756623547046
|
|
],
|
|
"per_marker": [
|
|
{
|
|
"marker_id": 198,
|
|
"q_i": 0.016119811341528748,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 229,
|
|
"q_i": 0.05888877390306695,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 243,
|
|
"q_i": 0.03152152627249269,
|
|
"weight": 1.0
|
|
}
|
|
]
|
|
}
|
|
},
|
|
{
|
|
"link": "Arm1",
|
|
"joint_variable": "y",
|
|
"joint_type": "revolute",
|
|
"old": 0.6043859396479823,
|
|
"new": 0.6043859396479823,
|
|
"info": {
|
|
"reason": "2d_alignment+normal_tiebreak",
|
|
"used_markers": 3,
|
|
"axis_world": [
|
|
-0.999429899484619,
|
|
-0.01619412884844312,
|
|
-0.029624756623547046
|
|
],
|
|
"axis_id": 0,
|
|
"theta_rad": 0.604385939647982,
|
|
"theta_alt_rad": -2.537206713941811,
|
|
"score_theta": 0.22073724094261074,
|
|
"score_theta_alt": 0.575346031336051,
|
|
"best_score": 0.22073724094261074,
|
|
"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,
|
|
217,
|
|
46,
|
|
47,
|
|
51,
|
|
53,
|
|
54,
|
|
55,
|
|
56,
|
|
58,
|
|
59,
|
|
60,
|
|
61,
|
|
62,
|
|
63,
|
|
64,
|
|
66,
|
|
68,
|
|
69,
|
|
71,
|
|
72,
|
|
75,
|
|
79,
|
|
83,
|
|
84,
|
|
85,
|
|
86,
|
|
92,
|
|
95,
|
|
96,
|
|
97,
|
|
102,
|
|
103,
|
|
105
|
|
]
|
|
},
|
|
"marker_stats": {
|
|
"num_markers_used": 43,
|
|
"mean_error_m": 0.04483866901767141,
|
|
"rms_error_m": 0.07587627462983015,
|
|
"median_error_m": 0.027744520670368065,
|
|
"worst_error_m": 0.2853814905194462
|
|
},
|
|
"marker_reports": [
|
|
{
|
|
"marker_id": 46,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.02977436173539516,
|
|
-0.020163450777703845,
|
|
0.025920185947828564
|
|
],
|
|
"error_norm_m": 0.044327569339915975,
|
|
"predicted_m": [
|
|
0.5309846348696204,
|
|
0.19509678982540885,
|
|
-0.019264100052690733
|
|
],
|
|
"observed_m": [
|
|
0.5607589966050156,
|
|
0.2152602406031127,
|
|
-0.0451842860005193
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 47,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.0073628555498681525,
|
|
0.013876041434123187,
|
|
0.00755179109565474
|
|
],
|
|
"error_norm_m": 0.017429449689595422,
|
|
"predicted_m": [
|
|
0.34613832842165204,
|
|
-0.2799222036201479,
|
|
-0.02083561477221712
|
|
],
|
|
"observed_m": [
|
|
0.3535011839715202,
|
|
-0.2937982450542711,
|
|
-0.02838740586787186
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 51,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.010179977403965035,
|
|
0.011477065013790283,
|
|
0.003743682480280102
|
|
],
|
|
"error_norm_m": 0.015791457177511004,
|
|
"predicted_m": [
|
|
0.1679842734935269,
|
|
-0.16833826230017254,
|
|
-0.027064037699958576
|
|
],
|
|
"observed_m": [
|
|
0.15780429608956187,
|
|
-0.17981532731396282,
|
|
-0.03080772018023868
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 53,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.016244608790811632,
|
|
0.0037909543104679977,
|
|
0.007199594102783712
|
|
],
|
|
"error_norm_m": 0.018168456307441433,
|
|
"predicted_m": [
|
|
0.4801261761061199,
|
|
0.2210752021028367,
|
|
-0.02099351259610001
|
|
],
|
|
"observed_m": [
|
|
0.49637078489693154,
|
|
0.2172842477923687,
|
|
-0.02819310669888372
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 54,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.005601583835458779,
|
|
0.011561463851464115,
|
|
0.007033803115922211
|
|
],
|
|
"error_norm_m": 0.014646486750341926,
|
|
"predicted_m": [
|
|
0.34488165876126636,
|
|
-0.32399665945755224,
|
|
-0.02050816401048711
|
|
],
|
|
"observed_m": [
|
|
0.3392800749258076,
|
|
-0.33555812330901635,
|
|
-0.02754196712640932
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 55,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.006056503298817462,
|
|
0.01870992578690267,
|
|
0.012050310969998125
|
|
],
|
|
"error_norm_m": 0.02306409654926135,
|
|
"predicted_m": [
|
|
0.28528087237506344,
|
|
-0.2569460726799718,
|
|
-0.022837901104742542
|
|
],
|
|
"observed_m": [
|
|
0.2913373756738809,
|
|
-0.2756559984668745,
|
|
-0.03488821207474067
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 56,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.03602729562188883,
|
|
-0.010860700071165463,
|
|
0.020033714398758302
|
|
],
|
|
"error_norm_m": 0.0426294563473873,
|
|
"predicted_m": [
|
|
0.49324365088974215,
|
|
0.17771370040079967,
|
|
-0.020243962434154047
|
|
],
|
|
"observed_m": [
|
|
0.529270946511631,
|
|
0.18857440047196514,
|
|
-0.04027767683291235
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 58,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.013819968450056397,
|
|
0.0033860150421816393,
|
|
-0.0013047456083081603
|
|
],
|
|
"error_norm_m": 0.014288421428864492,
|
|
"predicted_m": [
|
|
0.051075156682240865,
|
|
-0.21626686111439278,
|
|
-0.030148324021068627
|
|
],
|
|
"observed_m": [
|
|
0.03725518823218447,
|
|
-0.21965287615657442,
|
|
-0.028843578412760466
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 59,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.0046474248509768,
|
|
-0.02007838972427911,
|
|
-0.022453303766810324
|
|
],
|
|
"error_norm_m": 0.030477715493622094,
|
|
"predicted_m": [
|
|
0.6278333889854647,
|
|
-0.2675670714186178,
|
|
-0.012550202155299117
|
|
],
|
|
"observed_m": [
|
|
0.6231859641344879,
|
|
-0.24748868169433869,
|
|
0.009903101611511207
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 60,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.020840498292304166,
|
|
0.05467635371103319,
|
|
-0.004062124678497342
|
|
],
|
|
"error_norm_m": 0.05865433386467877,
|
|
"predicted_m": [
|
|
0.4271248419293634,
|
|
0.2917930530527297,
|
|
-0.023157105097589194
|
|
],
|
|
"observed_m": [
|
|
0.44796534022166756,
|
|
0.2371166993416965,
|
|
-0.019094980419091852
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 61,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.016715411671068464,
|
|
0.03419778990423655,
|
|
-0.02822582122801697
|
|
],
|
|
"error_norm_m": 0.04738766512145928,
|
|
"predicted_m": [
|
|
-0.030224012422021617,
|
|
0.33640729620399756,
|
|
-0.0371443682864659
|
|
],
|
|
"observed_m": [
|
|
-0.013508600750953155,
|
|
0.302209506299761,
|
|
-0.008918547058448923
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 62,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.003008904985095595,
|
|
-0.0013059949002687254,
|
|
-0.003520345318250663
|
|
],
|
|
"error_norm_m": 0.004811648682997378,
|
|
"predicted_m": [
|
|
0.4047973593170085,
|
|
-0.16752137375126158,
|
|
-0.020019502523033472
|
|
],
|
|
"observed_m": [
|
|
0.4017884543319129,
|
|
-0.16621537885099286,
|
|
-0.01649915720478281
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 63,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.04095440242177373,
|
|
-0.03467808983161946,
|
|
-0.02694626301594327
|
|
],
|
|
"error_norm_m": 0.06004943032718001,
|
|
"predicted_m": [
|
|
0.7782580973875596,
|
|
-0.22252572594314765,
|
|
-0.008444060425642552
|
|
],
|
|
"observed_m": [
|
|
0.7373036949657858,
|
|
-0.1878476361115282,
|
|
0.018502202590300717
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 64,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.01303797844057802,
|
|
0.0013062603141276996,
|
|
-0.0036475044849425577
|
|
],
|
|
"error_norm_m": 0.01360145164285483,
|
|
"predicted_m": [
|
|
-0.020720486092046558,
|
|
-0.18754741547695392,
|
|
-0.03252384941666012
|
|
],
|
|
"observed_m": [
|
|
-0.03375846453262458,
|
|
-0.18885367579108162,
|
|
-0.02887634493171756
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 66,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.0063447633974443585,
|
|
0.009736616801269415,
|
|
0.005253599481634341
|
|
],
|
|
"error_norm_m": 0.012753745991579891,
|
|
"predicted_m": [
|
|
0.21295753153357003,
|
|
-0.3587773076567335,
|
|
-0.02414837912162585
|
|
],
|
|
"observed_m": [
|
|
0.20661276813612567,
|
|
-0.3685139244580029,
|
|
-0.02940197860326019
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 68,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.020994195458070353,
|
|
-0.008215071481563724,
|
|
0.017325649618756017
|
|
],
|
|
"error_norm_m": 0.0284327588723072,
|
|
"predicted_m": [
|
|
0.5682194605442779,
|
|
0.18089874398720743,
|
|
-0.01803786542823528
|
|
],
|
|
"observed_m": [
|
|
0.5892136560023482,
|
|
0.18911381546877115,
|
|
-0.0353635150469913
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 69,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.01686947656630972,
|
|
0.001361555528239744,
|
|
-0.0016296205514579852
|
|
],
|
|
"error_norm_m": 0.017002609688500387,
|
|
"predicted_m": [
|
|
0.009625268687811486,
|
|
-0.2800443527081194,
|
|
-0.030854547258707378
|
|
],
|
|
"observed_m": [
|
|
-0.007244207878498232,
|
|
-0.28140590823635914,
|
|
-0.029224926707249393
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 71,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.04534155679981389,
|
|
-0.03798045328533087,
|
|
-0.03464448159198996
|
|
],
|
|
"error_norm_m": 0.06854642010760066,
|
|
"predicted_m": [
|
|
0.7513868098480112,
|
|
-0.2708255788817454,
|
|
-0.00884432543376851
|
|
],
|
|
"observed_m": [
|
|
0.7060452530481973,
|
|
-0.23284512559641454,
|
|
0.025800156158221454
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 72,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.017621858058974815,
|
|
0.005352047115575104,
|
|
-0.0019367446397366012
|
|
],
|
|
"error_norm_m": 0.018518241535781414,
|
|
"predicted_m": [
|
|
0.43517764641343726,
|
|
0.20242521930493712,
|
|
-0.022177497437249876
|
|
],
|
|
"observed_m": [
|
|
0.4527995044724121,
|
|
0.19707317218936202,
|
|
-0.020240752797513275
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 75,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.023906225247401484,
|
|
-0.007770682755671776,
|
|
-0.027792825309228542
|
|
],
|
|
"error_norm_m": 0.0374744213396029,
|
|
"predicted_m": [
|
|
-0.031250438107700465,
|
|
0.19512753831582025,
|
|
-0.036005350565022076
|
|
],
|
|
"observed_m": [
|
|
-0.05515666335510195,
|
|
0.20289822107149202,
|
|
-0.008212525255793534
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 79,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.019741398794198728,
|
|
-0.0011177056092179505,
|
|
0.0012677730605323637
|
|
],
|
|
"error_norm_m": 0.01981361503394774,
|
|
"predicted_m": [
|
|
0.3121951356975619,
|
|
-0.15303035556186867,
|
|
-0.022896770770637617
|
|
],
|
|
"observed_m": [
|
|
0.33193653449176064,
|
|
-0.15191264995265072,
|
|
-0.02416454383116998
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 83,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.01687722352482758,
|
|
0.039320246776119006,
|
|
-0.0276298736317439
|
|
],
|
|
"error_norm_m": 0.05093458940001409,
|
|
"predicted_m": [
|
|
0.036263989380499614,
|
|
0.3408749406902213,
|
|
-0.03520162047662422
|
|
],
|
|
"observed_m": [
|
|
0.053141212905327195,
|
|
0.3015546939141023,
|
|
-0.0075717468448803235
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 84,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.026911733970135576,
|
|
0.002932553919758163,
|
|
0.012083195811184826
|
|
],
|
|
"error_norm_m": 0.02964531866556797,
|
|
"predicted_m": [
|
|
0.40067490937496975,
|
|
0.26597211561633705,
|
|
-0.023730914973698225
|
|
],
|
|
"observed_m": [
|
|
0.4275866433451053,
|
|
0.2630395616965789,
|
|
-0.03581411078488305
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 85,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.0025391176517612912,
|
|
-0.0027037961933991106,
|
|
0.0018538776460073694
|
|
],
|
|
"error_norm_m": 0.004146624486409533,
|
|
"predicted_m": [
|
|
0.5068147334903392,
|
|
-0.3035311406481469,
|
|
-0.015855901265281372
|
|
],
|
|
"observed_m": [
|
|
0.5042756158385779,
|
|
-0.3008273444547478,
|
|
-0.01770977891128874
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 86,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.02596059090385272,
|
|
0.04311787354616786,
|
|
-0.020219255040303467
|
|
],
|
|
"error_norm_m": 0.05423948353003889,
|
|
"predicted_m": [
|
|
0.35556486859929265,
|
|
0.2988343026100792,
|
|
-0.02534615093326374
|
|
],
|
|
"observed_m": [
|
|
0.38152545950314537,
|
|
0.25571642906391134,
|
|
-0.005126895892960272
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 92,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.02969931702418649,
|
|
-0.023918618882797116,
|
|
-0.023441802911906187
|
|
],
|
|
"error_norm_m": 0.0447623489634345,
|
|
"predicted_m": [
|
|
0.6452055808239586,
|
|
-0.17336685639000132,
|
|
-0.012812765079129634
|
|
],
|
|
"observed_m": [
|
|
0.6155062637997721,
|
|
-0.1494482375072042,
|
|
0.010629037832776555
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 95,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.013702574585451543,
|
|
0.012142477556413345,
|
|
0.00566938744275803
|
|
],
|
|
"error_norm_m": 0.019166175034522847,
|
|
"predicted_m": [
|
|
0.18783972498537516,
|
|
-0.2700160150567737,
|
|
-0.025631089542372705
|
|
],
|
|
"observed_m": [
|
|
0.1741371503999236,
|
|
-0.28215849261318704,
|
|
-0.031300476985130735
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 96,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.009663996874285041,
|
|
0.014444741665975702,
|
|
0.005375074043238701
|
|
],
|
|
"error_norm_m": 0.018191613956800644,
|
|
"predicted_m": [
|
|
0.37006884399304474,
|
|
-0.17947515108006473,
|
|
-0.020954612659116977
|
|
],
|
|
"observed_m": [
|
|
0.3797328408673298,
|
|
-0.19391989274604043,
|
|
-0.02632968670235568
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 97,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.006285106572075261,
|
|
0.010720622571001592,
|
|
0.005088768789963002
|
|
],
|
|
"error_norm_m": 0.013428696166415932,
|
|
"predicted_m": [
|
|
0.3074468491037817,
|
|
-0.35368593179348745,
|
|
-0.021377033431382277
|
|
],
|
|
"observed_m": [
|
|
0.30116174253170647,
|
|
-0.36440655436448904,
|
|
-0.02646580222134528
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 102,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.028741460534945418,
|
|
-0.024315124538578953,
|
|
-0.018563396358892592
|
|
],
|
|
"error_norm_m": 0.041974951094501306,
|
|
"predicted_m": [
|
|
0.6504112772240183,
|
|
-0.2114460527857186,
|
|
-0.012342523814674385
|
|
],
|
|
"observed_m": [
|
|
0.6216698166890728,
|
|
-0.18713092824713964,
|
|
0.006220872544218209
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 103,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.01081495654735981,
|
|
0.009167931106118604,
|
|
0.000583746578498745
|
|
],
|
|
"error_norm_m": 0.014189961450114193,
|
|
"predicted_m": [
|
|
0.10617883308424775,
|
|
-0.18497117098943547,
|
|
-0.028766648738828778
|
|
],
|
|
"observed_m": [
|
|
0.09536387653688794,
|
|
-0.19413910209555407,
|
|
-0.029350395317327523
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 105,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.002169453738404714,
|
|
-0.0024040942166324575,
|
|
-0.0015873780630882503
|
|
],
|
|
"error_norm_m": 0.0036063787433792396,
|
|
"predicted_m": [
|
|
0.5263219141998613,
|
|
-0.2567107374152468,
|
|
-0.015662660807077906
|
|
],
|
|
"observed_m": [
|
|
0.5241524604614566,
|
|
-0.25430664319861435,
|
|
-0.014075282743989656
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 198,
|
|
"link": "Arm1",
|
|
"error_m": [
|
|
0.010385919396798005,
|
|
0.039768486654657056,
|
|
0.2824060822266092
|
|
],
|
|
"error_norm_m": 0.2853814905194462,
|
|
"predicted_m": [
|
|
0.1368328668639706,
|
|
0.0013070101080144801,
|
|
0.17872421725496906
|
|
],
|
|
"observed_m": [
|
|
0.12644694746717258,
|
|
-0.03846147654664257,
|
|
-0.1036818649716401
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 205,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.006692388656711068,
|
|
-0.015336273349981625,
|
|
0.033582364675758314
|
|
],
|
|
"error_norm_m": 0.037520188744374024,
|
|
"predicted_m": [
|
|
0.7477224817955899,
|
|
-0.07661523749543495,
|
|
0.017051979293681192
|
|
],
|
|
"observed_m": [
|
|
0.7544148704523009,
|
|
-0.06127896414545332,
|
|
-0.01653038538207712
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 206,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.042495346284374236,
|
|
-0.010745826187502815,
|
|
-0.01824910683832149
|
|
],
|
|
"error_norm_m": 0.04748007094221082,
|
|
"predicted_m": [
|
|
0.6465041902486512,
|
|
0.0017521198260508023,
|
|
0.013389362365103831
|
|
],
|
|
"observed_m": [
|
|
0.604008843964277,
|
|
0.012497946013553618,
|
|
0.03163846920342532
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 208,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.007987851932816703,
|
|
-0.012480629087450679,
|
|
0.012472121561776833
|
|
],
|
|
"error_norm_m": 0.01936816194611306,
|
|
"predicted_m": [
|
|
0.3479505220013427,
|
|
-0.08309288903481866,
|
|
0.00520207664425053
|
|
],
|
|
"observed_m": [
|
|
0.339962670068526,
|
|
-0.07061225994736799,
|
|
-0.007270044917526303
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 210,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.0074463115848725815,
|
|
0.0021649915371987245,
|
|
-0.0006177274601281944
|
|
],
|
|
"error_norm_m": 0.007779224369443663,
|
|
"predicted_m": [
|
|
0.017022766272509048,
|
|
-0.01844852762427002,
|
|
-0.0051867166494720006
|
|
],
|
|
"observed_m": [
|
|
0.009576454687636467,
|
|
-0.020613519161468745,
|
|
-0.004568989189343806
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 211,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.02511171094906539,
|
|
-0.015707281435153327,
|
|
0.025551753476736872
|
|
],
|
|
"error_norm_m": 0.03911788366730053,
|
|
"predicted_m": [
|
|
0.24673223045440407,
|
|
-0.004725531713332921,
|
|
0.0015394597156731674
|
|
],
|
|
"observed_m": [
|
|
0.27184394140346946,
|
|
0.010981749721820406,
|
|
-0.024012293761063706
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 214,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.0040600458965698305,
|
|
-0.011765868314021733,
|
|
0.011116536860858665
|
|
],
|
|
"error_norm_m": 0.016688230033289436,
|
|
"predicted_m": [
|
|
0.3466752204029659,
|
|
-0.0031061188284869905,
|
|
0.0045019353780308335
|
|
],
|
|
"observed_m": [
|
|
0.3507352662995357,
|
|
0.008659749485534742,
|
|
-0.006614601482827832
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 215,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.037228036202207826,
|
|
-0.01737982614105754,
|
|
0.035715321528362806
|
|
],
|
|
"error_norm_m": 0.05443867401067572,
|
|
"predicted_m": [
|
|
0.2480075320527808,
|
|
-0.0847123019196646,
|
|
0.0022396009818928635
|
|
],
|
|
"observed_m": [
|
|
0.28523556825498864,
|
|
-0.06733247577860706,
|
|
-0.033475720546469946
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 217,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.008290955393926769,
|
|
-0.024515650708768183,
|
|
0.010000067810273669
|
|
],
|
|
"error_norm_m": 0.027744520670368065,
|
|
"predicted_m": [
|
|
0.647779491847028,
|
|
-0.07823465038028088,
|
|
0.014089503631323526
|
|
],
|
|
"observed_m": [
|
|
0.6394885364531012,
|
|
-0.053718999671512696,
|
|
0.004089435821049857
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 229,
|
|
"link": "Arm1",
|
|
"error_m": [
|
|
-0.031251365169835094,
|
|
0.0032640320695995068,
|
|
0.26335925600713095
|
|
],
|
|
"error_norm_m": 0.2652270714971594,
|
|
"predicted_m": [
|
|
0.13649132290391167,
|
|
-0.07231416589171147,
|
|
0.23049105791707136
|
|
],
|
|
"observed_m": [
|
|
0.16774268807374676,
|
|
-0.07557819796131098,
|
|
-0.032868198090059565
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 243,
|
|
"link": "Arm1",
|
|
"error_m": [
|
|
-0.0014806254050987733,
|
|
-0.05955163114784371,
|
|
0.21713862730677966
|
|
],
|
|
"error_norm_m": 0.2251616585758588,
|
|
"predicted_m": [
|
|
0.13753268348409162,
|
|
-0.12106863020350166,
|
|
0.22201062291579685
|
|
],
|
|
"observed_m": [
|
|
0.1390133088891904,
|
|
-0.061516999055657946,
|
|
0.00487199560901719
|
|
]
|
|
}
|
|
],
|
|
"stage_idx": 0,
|
|
"num_active_links": 3
|
|
},
|
|
{
|
|
"method": "deterministic_geometric_prefix",
|
|
"active_links": [
|
|
"Board",
|
|
"Base",
|
|
"Arm1",
|
|
"Ellbow"
|
|
],
|
|
"active_observations": 45,
|
|
"joint_updates": [
|
|
{
|
|
"pass": 0,
|
|
"updates": [
|
|
{
|
|
"link": "Base",
|
|
"joint_variable": "x",
|
|
"joint_type": "linear",
|
|
"old": 0.03551003717236279,
|
|
"new": 0.034212428943290026,
|
|
"info": {
|
|
"reason": "weighted_projection",
|
|
"used_markers": 5,
|
|
"axis_world": [
|
|
0.999429899484619,
|
|
0.01619412884844312,
|
|
0.029624756623547046
|
|
],
|
|
"per_marker": [
|
|
{
|
|
"marker_id": 198,
|
|
"q_i": 0.016119811341528748,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 229,
|
|
"q_i": 0.05888877390306695,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 243,
|
|
"q_i": 0.03152152627249269,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 244,
|
|
"q_i": 0.020872012899750374,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 245,
|
|
"q_i": 0.04366002029961136,
|
|
"weight": 1.0
|
|
}
|
|
]
|
|
}
|
|
},
|
|
{
|
|
"link": "Arm1",
|
|
"joint_variable": "y",
|
|
"joint_type": "revolute",
|
|
"old": 0.6043859396479823,
|
|
"new": 0.5919255723164945,
|
|
"info": {
|
|
"reason": "2d_alignment+normal_tiebreak",
|
|
"used_markers": 5,
|
|
"axis_world": [
|
|
-0.999429899484619,
|
|
-0.01619412884844312,
|
|
-0.029624756623547046
|
|
],
|
|
"axis_id": 0,
|
|
"theta_rad": 0.5919255723164943,
|
|
"theta_alt_rad": -2.5496670812732987,
|
|
"score_theta": 0.3248724239891294,
|
|
"score_theta_alt": 0.7480383022399995,
|
|
"best_score": 0.3248724239891294,
|
|
"per_marker": [
|
|
{
|
|
"marker_id": 198,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 229,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 243,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 244,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 245,
|
|
"weight": 1.0
|
|
}
|
|
]
|
|
}
|
|
},
|
|
{
|
|
"link": "Ellbow",
|
|
"joint_variable": "z",
|
|
"joint_type": "revolute",
|
|
"old": 0.0,
|
|
"new": -1.9450513780191887,
|
|
"info": {
|
|
"reason": "2d_alignment+normal_tiebreak",
|
|
"used_markers": 1,
|
|
"axis_world": [
|
|
-0.999429899484619,
|
|
-0.01619412884844312,
|
|
-0.029624756623547042
|
|
],
|
|
"axis_id": 0,
|
|
"theta_rad": 1.1965412755706044,
|
|
"theta_alt_rad": -1.9450513780191887,
|
|
"score_theta": 0.186031429302903,
|
|
"score_theta_alt": 0.1411380162535759,
|
|
"best_score": 0.1411380162535759,
|
|
"per_marker": [
|
|
{
|
|
"marker_id": 245,
|
|
"weight": 1.0
|
|
}
|
|
]
|
|
}
|
|
}
|
|
]
|
|
},
|
|
{
|
|
"pass": 1,
|
|
"updates": [
|
|
{
|
|
"link": "Base",
|
|
"joint_variable": "x",
|
|
"joint_type": "linear",
|
|
"old": 0.034212428943290026,
|
|
"new": 0.034212428943406856,
|
|
"info": {
|
|
"reason": "weighted_projection",
|
|
"used_markers": 5,
|
|
"axis_world": [
|
|
0.999429899484619,
|
|
0.01619412884844312,
|
|
0.029624756623547046
|
|
],
|
|
"per_marker": [
|
|
{
|
|
"marker_id": 198,
|
|
"q_i": 0.016119811341528748,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 229,
|
|
"q_i": 0.05888877390306695,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 243,
|
|
"q_i": 0.03152152627249269,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 244,
|
|
"q_i": 0.02087201290009002,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 245,
|
|
"q_i": 0.04366002029985589,
|
|
"weight": 1.0
|
|
}
|
|
]
|
|
}
|
|
},
|
|
{
|
|
"link": "Arm1",
|
|
"joint_variable": "y",
|
|
"joint_type": "revolute",
|
|
"old": 0.5919255723164945,
|
|
"new": 0.6202931984210398,
|
|
"info": {
|
|
"reason": "2d_alignment+normal_tiebreak",
|
|
"used_markers": 5,
|
|
"axis_world": [
|
|
-0.999429899484619,
|
|
-0.01619412884844312,
|
|
-0.029624756623547046
|
|
],
|
|
"axis_id": 0,
|
|
"theta_rad": 0.62029319842104,
|
|
"theta_alt_rad": -2.5212994551687533,
|
|
"score_theta": 0.3299023092881357,
|
|
"score_theta_alt": 0.7104311093121503,
|
|
"best_score": 0.3299023092881357,
|
|
"per_marker": [
|
|
{
|
|
"marker_id": 198,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 229,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 243,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 244,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 245,
|
|
"weight": 1.0
|
|
}
|
|
]
|
|
}
|
|
},
|
|
{
|
|
"link": "Ellbow",
|
|
"joint_variable": "z",
|
|
"joint_type": "revolute",
|
|
"old": -1.9450513780191887,
|
|
"new": -1.9466162215247689,
|
|
"info": {
|
|
"reason": "2d_alignment+normal_tiebreak",
|
|
"used_markers": 1,
|
|
"axis_world": [
|
|
-0.999429899484619,
|
|
-0.01619412884844312,
|
|
-0.029624756623547046
|
|
],
|
|
"axis_id": 0,
|
|
"theta_rad": 1.1949764320650247,
|
|
"theta_alt_rad": -1.9466162215247689,
|
|
"score_theta": 0.18939954480015228,
|
|
"score_theta_alt": 0.14170388364102868,
|
|
"best_score": 0.14170388364102868,
|
|
"per_marker": [
|
|
{
|
|
"marker_id": 245,
|
|
"weight": 1.0
|
|
}
|
|
]
|
|
}
|
|
}
|
|
]
|
|
}
|
|
],
|
|
"root_link": "Board",
|
|
"root_pose": {
|
|
"reason": "kabsch",
|
|
"used_markers": [
|
|
210,
|
|
211,
|
|
215,
|
|
214,
|
|
208,
|
|
206,
|
|
205,
|
|
217,
|
|
46,
|
|
47,
|
|
51,
|
|
53,
|
|
54,
|
|
55,
|
|
56,
|
|
58,
|
|
59,
|
|
60,
|
|
61,
|
|
62,
|
|
63,
|
|
64,
|
|
66,
|
|
68,
|
|
69,
|
|
71,
|
|
72,
|
|
75,
|
|
79,
|
|
83,
|
|
84,
|
|
85,
|
|
86,
|
|
92,
|
|
95,
|
|
96,
|
|
97,
|
|
102,
|
|
103,
|
|
105
|
|
]
|
|
},
|
|
"marker_stats": {
|
|
"num_markers_used": 45,
|
|
"mean_error_m": 0.05308505266692316,
|
|
"rms_error_m": 0.08892148241740519,
|
|
"median_error_m": 0.0284327588723072,
|
|
"worst_error_m": 0.2872949265718958
|
|
},
|
|
"marker_reports": [
|
|
{
|
|
"marker_id": 46,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.02977436173539516,
|
|
-0.020163450777703845,
|
|
0.025920185947828564
|
|
],
|
|
"error_norm_m": 0.044327569339915975,
|
|
"predicted_m": [
|
|
0.5309846348696204,
|
|
0.19509678982540885,
|
|
-0.019264100052690733
|
|
],
|
|
"observed_m": [
|
|
0.5607589966050156,
|
|
0.2152602406031127,
|
|
-0.0451842860005193
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 47,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.0073628555498681525,
|
|
0.013876041434123187,
|
|
0.00755179109565474
|
|
],
|
|
"error_norm_m": 0.017429449689595422,
|
|
"predicted_m": [
|
|
0.34613832842165204,
|
|
-0.2799222036201479,
|
|
-0.02083561477221712
|
|
],
|
|
"observed_m": [
|
|
0.3535011839715202,
|
|
-0.2937982450542711,
|
|
-0.02838740586787186
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 51,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.010179977403965035,
|
|
0.011477065013790283,
|
|
0.003743682480280102
|
|
],
|
|
"error_norm_m": 0.015791457177511004,
|
|
"predicted_m": [
|
|
0.1679842734935269,
|
|
-0.16833826230017254,
|
|
-0.027064037699958576
|
|
],
|
|
"observed_m": [
|
|
0.15780429608956187,
|
|
-0.17981532731396282,
|
|
-0.03080772018023868
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 53,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.016244608790811632,
|
|
0.0037909543104679977,
|
|
0.007199594102783712
|
|
],
|
|
"error_norm_m": 0.018168456307441433,
|
|
"predicted_m": [
|
|
0.4801261761061199,
|
|
0.2210752021028367,
|
|
-0.02099351259610001
|
|
],
|
|
"observed_m": [
|
|
0.49637078489693154,
|
|
0.2172842477923687,
|
|
-0.02819310669888372
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 54,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.005601583835458779,
|
|
0.011561463851464115,
|
|
0.007033803115922211
|
|
],
|
|
"error_norm_m": 0.014646486750341926,
|
|
"predicted_m": [
|
|
0.34488165876126636,
|
|
-0.32399665945755224,
|
|
-0.02050816401048711
|
|
],
|
|
"observed_m": [
|
|
0.3392800749258076,
|
|
-0.33555812330901635,
|
|
-0.02754196712640932
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 55,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.006056503298817462,
|
|
0.01870992578690267,
|
|
0.012050310969998125
|
|
],
|
|
"error_norm_m": 0.02306409654926135,
|
|
"predicted_m": [
|
|
0.28528087237506344,
|
|
-0.2569460726799718,
|
|
-0.022837901104742542
|
|
],
|
|
"observed_m": [
|
|
0.2913373756738809,
|
|
-0.2756559984668745,
|
|
-0.03488821207474067
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 56,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.03602729562188883,
|
|
-0.010860700071165463,
|
|
0.020033714398758302
|
|
],
|
|
"error_norm_m": 0.0426294563473873,
|
|
"predicted_m": [
|
|
0.49324365088974215,
|
|
0.17771370040079967,
|
|
-0.020243962434154047
|
|
],
|
|
"observed_m": [
|
|
0.529270946511631,
|
|
0.18857440047196514,
|
|
-0.04027767683291235
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 58,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.013819968450056397,
|
|
0.0033860150421816393,
|
|
-0.0013047456083081603
|
|
],
|
|
"error_norm_m": 0.014288421428864492,
|
|
"predicted_m": [
|
|
0.051075156682240865,
|
|
-0.21626686111439278,
|
|
-0.030148324021068627
|
|
],
|
|
"observed_m": [
|
|
0.03725518823218447,
|
|
-0.21965287615657442,
|
|
-0.028843578412760466
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 59,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.0046474248509768,
|
|
-0.02007838972427911,
|
|
-0.022453303766810324
|
|
],
|
|
"error_norm_m": 0.030477715493622094,
|
|
"predicted_m": [
|
|
0.6278333889854647,
|
|
-0.2675670714186178,
|
|
-0.012550202155299117
|
|
],
|
|
"observed_m": [
|
|
0.6231859641344879,
|
|
-0.24748868169433869,
|
|
0.009903101611511207
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 60,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.020840498292304166,
|
|
0.05467635371103319,
|
|
-0.004062124678497342
|
|
],
|
|
"error_norm_m": 0.05865433386467877,
|
|
"predicted_m": [
|
|
0.4271248419293634,
|
|
0.2917930530527297,
|
|
-0.023157105097589194
|
|
],
|
|
"observed_m": [
|
|
0.44796534022166756,
|
|
0.2371166993416965,
|
|
-0.019094980419091852
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 61,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.016715411671068464,
|
|
0.03419778990423655,
|
|
-0.02822582122801697
|
|
],
|
|
"error_norm_m": 0.04738766512145928,
|
|
"predicted_m": [
|
|
-0.030224012422021617,
|
|
0.33640729620399756,
|
|
-0.0371443682864659
|
|
],
|
|
"observed_m": [
|
|
-0.013508600750953155,
|
|
0.302209506299761,
|
|
-0.008918547058448923
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 62,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.003008904985095595,
|
|
-0.0013059949002687254,
|
|
-0.003520345318250663
|
|
],
|
|
"error_norm_m": 0.004811648682997378,
|
|
"predicted_m": [
|
|
0.4047973593170085,
|
|
-0.16752137375126158,
|
|
-0.020019502523033472
|
|
],
|
|
"observed_m": [
|
|
0.4017884543319129,
|
|
-0.16621537885099286,
|
|
-0.01649915720478281
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 63,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.04095440242177373,
|
|
-0.03467808983161946,
|
|
-0.02694626301594327
|
|
],
|
|
"error_norm_m": 0.06004943032718001,
|
|
"predicted_m": [
|
|
0.7782580973875596,
|
|
-0.22252572594314765,
|
|
-0.008444060425642552
|
|
],
|
|
"observed_m": [
|
|
0.7373036949657858,
|
|
-0.1878476361115282,
|
|
0.018502202590300717
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 64,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.01303797844057802,
|
|
0.0013062603141276996,
|
|
-0.0036475044849425577
|
|
],
|
|
"error_norm_m": 0.01360145164285483,
|
|
"predicted_m": [
|
|
-0.020720486092046558,
|
|
-0.18754741547695392,
|
|
-0.03252384941666012
|
|
],
|
|
"observed_m": [
|
|
-0.03375846453262458,
|
|
-0.18885367579108162,
|
|
-0.02887634493171756
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 66,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.0063447633974443585,
|
|
0.009736616801269415,
|
|
0.005253599481634341
|
|
],
|
|
"error_norm_m": 0.012753745991579891,
|
|
"predicted_m": [
|
|
0.21295753153357003,
|
|
-0.3587773076567335,
|
|
-0.02414837912162585
|
|
],
|
|
"observed_m": [
|
|
0.20661276813612567,
|
|
-0.3685139244580029,
|
|
-0.02940197860326019
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 68,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.020994195458070353,
|
|
-0.008215071481563724,
|
|
0.017325649618756017
|
|
],
|
|
"error_norm_m": 0.0284327588723072,
|
|
"predicted_m": [
|
|
0.5682194605442779,
|
|
0.18089874398720743,
|
|
-0.01803786542823528
|
|
],
|
|
"observed_m": [
|
|
0.5892136560023482,
|
|
0.18911381546877115,
|
|
-0.0353635150469913
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 69,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.01686947656630972,
|
|
0.001361555528239744,
|
|
-0.0016296205514579852
|
|
],
|
|
"error_norm_m": 0.017002609688500387,
|
|
"predicted_m": [
|
|
0.009625268687811486,
|
|
-0.2800443527081194,
|
|
-0.030854547258707378
|
|
],
|
|
"observed_m": [
|
|
-0.007244207878498232,
|
|
-0.28140590823635914,
|
|
-0.029224926707249393
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 71,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.04534155679981389,
|
|
-0.03798045328533087,
|
|
-0.03464448159198996
|
|
],
|
|
"error_norm_m": 0.06854642010760066,
|
|
"predicted_m": [
|
|
0.7513868098480112,
|
|
-0.2708255788817454,
|
|
-0.00884432543376851
|
|
],
|
|
"observed_m": [
|
|
0.7060452530481973,
|
|
-0.23284512559641454,
|
|
0.025800156158221454
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 72,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.017621858058974815,
|
|
0.005352047115575104,
|
|
-0.0019367446397366012
|
|
],
|
|
"error_norm_m": 0.018518241535781414,
|
|
"predicted_m": [
|
|
0.43517764641343726,
|
|
0.20242521930493712,
|
|
-0.022177497437249876
|
|
],
|
|
"observed_m": [
|
|
0.4527995044724121,
|
|
0.19707317218936202,
|
|
-0.020240752797513275
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 75,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.023906225247401484,
|
|
-0.007770682755671776,
|
|
-0.027792825309228542
|
|
],
|
|
"error_norm_m": 0.0374744213396029,
|
|
"predicted_m": [
|
|
-0.031250438107700465,
|
|
0.19512753831582025,
|
|
-0.036005350565022076
|
|
],
|
|
"observed_m": [
|
|
-0.05515666335510195,
|
|
0.20289822107149202,
|
|
-0.008212525255793534
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 79,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.019741398794198728,
|
|
-0.0011177056092179505,
|
|
0.0012677730605323637
|
|
],
|
|
"error_norm_m": 0.01981361503394774,
|
|
"predicted_m": [
|
|
0.3121951356975619,
|
|
-0.15303035556186867,
|
|
-0.022896770770637617
|
|
],
|
|
"observed_m": [
|
|
0.33193653449176064,
|
|
-0.15191264995265072,
|
|
-0.02416454383116998
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 83,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.01687722352482758,
|
|
0.039320246776119006,
|
|
-0.0276298736317439
|
|
],
|
|
"error_norm_m": 0.05093458940001409,
|
|
"predicted_m": [
|
|
0.036263989380499614,
|
|
0.3408749406902213,
|
|
-0.03520162047662422
|
|
],
|
|
"observed_m": [
|
|
0.053141212905327195,
|
|
0.3015546939141023,
|
|
-0.0075717468448803235
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 84,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.026911733970135576,
|
|
0.002932553919758163,
|
|
0.012083195811184826
|
|
],
|
|
"error_norm_m": 0.02964531866556797,
|
|
"predicted_m": [
|
|
0.40067490937496975,
|
|
0.26597211561633705,
|
|
-0.023730914973698225
|
|
],
|
|
"observed_m": [
|
|
0.4275866433451053,
|
|
0.2630395616965789,
|
|
-0.03581411078488305
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 85,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.0025391176517612912,
|
|
-0.0027037961933991106,
|
|
0.0018538776460073694
|
|
],
|
|
"error_norm_m": 0.004146624486409533,
|
|
"predicted_m": [
|
|
0.5068147334903392,
|
|
-0.3035311406481469,
|
|
-0.015855901265281372
|
|
],
|
|
"observed_m": [
|
|
0.5042756158385779,
|
|
-0.3008273444547478,
|
|
-0.01770977891128874
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 86,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.02596059090385272,
|
|
0.04311787354616786,
|
|
-0.020219255040303467
|
|
],
|
|
"error_norm_m": 0.05423948353003889,
|
|
"predicted_m": [
|
|
0.35556486859929265,
|
|
0.2988343026100792,
|
|
-0.02534615093326374
|
|
],
|
|
"observed_m": [
|
|
0.38152545950314537,
|
|
0.25571642906391134,
|
|
-0.005126895892960272
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 92,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.02969931702418649,
|
|
-0.023918618882797116,
|
|
-0.023441802911906187
|
|
],
|
|
"error_norm_m": 0.0447623489634345,
|
|
"predicted_m": [
|
|
0.6452055808239586,
|
|
-0.17336685639000132,
|
|
-0.012812765079129634
|
|
],
|
|
"observed_m": [
|
|
0.6155062637997721,
|
|
-0.1494482375072042,
|
|
0.010629037832776555
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 95,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.013702574585451543,
|
|
0.012142477556413345,
|
|
0.00566938744275803
|
|
],
|
|
"error_norm_m": 0.019166175034522847,
|
|
"predicted_m": [
|
|
0.18783972498537516,
|
|
-0.2700160150567737,
|
|
-0.025631089542372705
|
|
],
|
|
"observed_m": [
|
|
0.1741371503999236,
|
|
-0.28215849261318704,
|
|
-0.031300476985130735
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 96,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.009663996874285041,
|
|
0.014444741665975702,
|
|
0.005375074043238701
|
|
],
|
|
"error_norm_m": 0.018191613956800644,
|
|
"predicted_m": [
|
|
0.37006884399304474,
|
|
-0.17947515108006473,
|
|
-0.020954612659116977
|
|
],
|
|
"observed_m": [
|
|
0.3797328408673298,
|
|
-0.19391989274604043,
|
|
-0.02632968670235568
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 97,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.006285106572075261,
|
|
0.010720622571001592,
|
|
0.005088768789963002
|
|
],
|
|
"error_norm_m": 0.013428696166415932,
|
|
"predicted_m": [
|
|
0.3074468491037817,
|
|
-0.35368593179348745,
|
|
-0.021377033431382277
|
|
],
|
|
"observed_m": [
|
|
0.30116174253170647,
|
|
-0.36440655436448904,
|
|
-0.02646580222134528
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 102,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.028741460534945418,
|
|
-0.024315124538578953,
|
|
-0.018563396358892592
|
|
],
|
|
"error_norm_m": 0.041974951094501306,
|
|
"predicted_m": [
|
|
0.6504112772240183,
|
|
-0.2114460527857186,
|
|
-0.012342523814674385
|
|
],
|
|
"observed_m": [
|
|
0.6216698166890728,
|
|
-0.18713092824713964,
|
|
0.006220872544218209
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 103,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.01081495654735981,
|
|
0.009167931106118604,
|
|
0.000583746578498745
|
|
],
|
|
"error_norm_m": 0.014189961450114193,
|
|
"predicted_m": [
|
|
0.10617883308424775,
|
|
-0.18497117098943547,
|
|
-0.028766648738828778
|
|
],
|
|
"observed_m": [
|
|
0.09536387653688794,
|
|
-0.19413910209555407,
|
|
-0.029350395317327523
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 105,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.002169453738404714,
|
|
-0.0024040942166324575,
|
|
-0.0015873780630882503
|
|
],
|
|
"error_norm_m": 0.0036063787433792396,
|
|
"predicted_m": [
|
|
0.5263219141998613,
|
|
-0.2567107374152468,
|
|
-0.015662660807077906
|
|
],
|
|
"observed_m": [
|
|
0.5241524604614566,
|
|
-0.25430664319861435,
|
|
-0.014075282743989656
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 198,
|
|
"link": "Arm1",
|
|
"error_m": [
|
|
0.009006007356622131,
|
|
0.04168023265255866,
|
|
0.28411269748371343
|
|
],
|
|
"error_norm_m": 0.2872949265718958,
|
|
"predicted_m": [
|
|
0.1354529548237947,
|
|
0.0032187561059160846,
|
|
0.18043083251207334
|
|
],
|
|
"observed_m": [
|
|
0.12644694746717258,
|
|
-0.03846147654664257,
|
|
-0.1036818649716401
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 205,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.006692388656711068,
|
|
-0.015336273349981625,
|
|
0.033582364675758314
|
|
],
|
|
"error_norm_m": 0.037520188744374024,
|
|
"predicted_m": [
|
|
0.7477224817955899,
|
|
-0.07661523749543495,
|
|
0.017051979293681192
|
|
],
|
|
"observed_m": [
|
|
0.7544148704523009,
|
|
-0.06127896414545332,
|
|
-0.01653038538207712
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 206,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.042495346284374236,
|
|
-0.010745826187502815,
|
|
-0.01824910683832149
|
|
],
|
|
"error_norm_m": 0.04748007094221082,
|
|
"predicted_m": [
|
|
0.6465041902486512,
|
|
0.0017521198260508023,
|
|
0.013389362365103831
|
|
],
|
|
"observed_m": [
|
|
0.604008843964277,
|
|
0.012497946013553618,
|
|
0.03163846920342532
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 208,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.007987851932816703,
|
|
-0.012480629087450679,
|
|
0.012472121561776833
|
|
],
|
|
"error_norm_m": 0.01936816194611306,
|
|
"predicted_m": [
|
|
0.3479505220013427,
|
|
-0.08309288903481866,
|
|
0.00520207664425053
|
|
],
|
|
"observed_m": [
|
|
0.339962670068526,
|
|
-0.07061225994736799,
|
|
-0.007270044917526303
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 210,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.0074463115848725815,
|
|
0.0021649915371987245,
|
|
-0.0006177274601281944
|
|
],
|
|
"error_norm_m": 0.007779224369443663,
|
|
"predicted_m": [
|
|
0.017022766272509048,
|
|
-0.01844852762427002,
|
|
-0.0051867166494720006
|
|
],
|
|
"observed_m": [
|
|
0.009576454687636467,
|
|
-0.020613519161468745,
|
|
-0.004568989189343806
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 211,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.02511171094906539,
|
|
-0.015707281435153327,
|
|
0.025551753476736872
|
|
],
|
|
"error_norm_m": 0.03911788366730053,
|
|
"predicted_m": [
|
|
0.24673223045440407,
|
|
-0.004725531713332921,
|
|
0.0015394597156731674
|
|
],
|
|
"observed_m": [
|
|
0.27184394140346946,
|
|
0.010981749721820406,
|
|
-0.024012293761063706
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 214,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.0040600458965698305,
|
|
-0.011765868314021733,
|
|
0.011116536860858665
|
|
],
|
|
"error_norm_m": 0.016688230033289436,
|
|
"predicted_m": [
|
|
0.3466752204029659,
|
|
-0.0031061188284869905,
|
|
0.0045019353780308335
|
|
],
|
|
"observed_m": [
|
|
0.3507352662995357,
|
|
0.008659749485534742,
|
|
-0.006614601482827832
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 215,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.037228036202207826,
|
|
-0.01737982614105754,
|
|
0.035715321528362806
|
|
],
|
|
"error_norm_m": 0.05443867401067572,
|
|
"predicted_m": [
|
|
0.2480075320527808,
|
|
-0.0847123019196646,
|
|
0.0022396009818928635
|
|
],
|
|
"observed_m": [
|
|
0.28523556825498864,
|
|
-0.06733247577860706,
|
|
-0.033475720546469946
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 217,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.008290955393926769,
|
|
-0.024515650708768183,
|
|
0.010000067810273669
|
|
],
|
|
"error_norm_m": 0.027744520670368065,
|
|
"predicted_m": [
|
|
0.647779491847028,
|
|
-0.07823465038028088,
|
|
0.014089503631323526
|
|
],
|
|
"observed_m": [
|
|
0.6394885364531012,
|
|
-0.053718999671512696,
|
|
0.004089435821049857
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 229,
|
|
"link": "Arm1",
|
|
"error_m": [
|
|
-0.032679261209828864,
|
|
0.006008217762227819,
|
|
0.2662296279451091
|
|
],
|
|
"error_norm_m": 0.2682950755971675,
|
|
"predicted_m": [
|
|
0.1350634268639179,
|
|
-0.06956998019908316,
|
|
0.23336142985504954
|
|
],
|
|
"observed_m": [
|
|
0.16774268807374676,
|
|
-0.07557819796131098,
|
|
-0.032868198090059565
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 243,
|
|
"link": "Arm1",
|
|
"error_m": [
|
|
-0.002929443199691295,
|
|
-0.05693658574939701,
|
|
0.22078541546823824
|
|
],
|
|
"error_norm_m": 0.22802753368341558,
|
|
"predicted_m": [
|
|
0.1360838656894991,
|
|
-0.11845358480505495,
|
|
0.22565741107725543
|
|
],
|
|
"observed_m": [
|
|
0.1390133088891904,
|
|
-0.061516999055657946,
|
|
0.00487199560901719
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 244,
|
|
"link": "Ellbow",
|
|
"error_m": [
|
|
0.010317640451486143,
|
|
-0.1664604789365223,
|
|
0.19322825840258281
|
|
],
|
|
"error_norm_m": 0.2552502783496187,
|
|
"predicted_m": [
|
|
0.2611640862203209,
|
|
-0.08812258791372632,
|
|
0.2087763844662558
|
|
],
|
|
"observed_m": [
|
|
0.25084644576883475,
|
|
0.07833789102279598,
|
|
0.015548126063672972
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 245,
|
|
"link": "Ellbow",
|
|
"error_m": [
|
|
-0.0133482292607294,
|
|
-0.08508023075772075,
|
|
0.17791971620736072
|
|
],
|
|
"error_norm_m": 0.19766700864203865,
|
|
"predicted_m": [
|
|
0.2258948136326747,
|
|
-0.05480582362537515,
|
|
0.19897477090102095
|
|
],
|
|
"observed_m": [
|
|
0.2392430428934041,
|
|
0.030274407132345596,
|
|
0.021055054693660227
|
|
]
|
|
}
|
|
],
|
|
"stage_idx": 1,
|
|
"num_active_links": 4
|
|
},
|
|
{
|
|
"method": "deterministic_geometric_prefix",
|
|
"active_links": [
|
|
"Board",
|
|
"Base",
|
|
"Arm1",
|
|
"Ellbow",
|
|
"Arm2"
|
|
],
|
|
"active_observations": 48,
|
|
"joint_updates": [
|
|
{
|
|
"pass": 0,
|
|
"updates": [
|
|
{
|
|
"link": "Base",
|
|
"joint_variable": "x",
|
|
"joint_type": "linear",
|
|
"old": 0.034212428943406856,
|
|
"new": 0.053287321626320716,
|
|
"info": {
|
|
"reason": "weighted_projection",
|
|
"used_markers": 8,
|
|
"axis_world": [
|
|
0.999429899484619,
|
|
0.01619412884844312,
|
|
0.029624756623547046
|
|
],
|
|
"per_marker": [
|
|
{
|
|
"marker_id": 198,
|
|
"q_i": 0.016119811341528748,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 229,
|
|
"q_i": 0.05888877390306695,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 243,
|
|
"q_i": 0.031521526272492696,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 244,
|
|
"q_i": 0.020872012900094432,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 245,
|
|
"q_i": 0.043660020299859034,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 218,
|
|
"q_i": 0.08753830962563552,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 113,
|
|
"q_i": 0.06773829406506039,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 124,
|
|
"q_i": 0.099959824602828,
|
|
"weight": 1.0
|
|
}
|
|
]
|
|
}
|
|
},
|
|
{
|
|
"link": "Arm1",
|
|
"joint_variable": "y",
|
|
"joint_type": "revolute",
|
|
"old": 0.6202931984210398,
|
|
"new": 0.17201947162039577,
|
|
"info": {
|
|
"reason": "2d_alignment+normal_tiebreak",
|
|
"used_markers": 8,
|
|
"axis_world": [
|
|
-0.999429899484619,
|
|
-0.01619412884844312,
|
|
-0.029624756623547046
|
|
],
|
|
"axis_id": 0,
|
|
"theta_rad": 0.17201947162039585,
|
|
"theta_alt_rad": -2.9695731819693973,
|
|
"score_theta": 0.22668889253907415,
|
|
"score_theta_alt": 1.6668531219589382,
|
|
"best_score": 0.22668889253907415,
|
|
"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": 218,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 113,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 124,
|
|
"weight": 1.0
|
|
}
|
|
]
|
|
}
|
|
},
|
|
{
|
|
"link": "Ellbow",
|
|
"joint_variable": "z",
|
|
"joint_type": "revolute",
|
|
"old": -1.9466162215247689,
|
|
"new": -1.301051300558706,
|
|
"info": {
|
|
"reason": "2d_alignment+normal_tiebreak",
|
|
"used_markers": 4,
|
|
"axis_world": [
|
|
-0.999429899484619,
|
|
-0.01619412884844312,
|
|
-0.029624756623547046
|
|
],
|
|
"axis_id": 0,
|
|
"theta_rad": 1.8405413530310875,
|
|
"theta_alt_rad": -1.301051300558706,
|
|
"score_theta": 0.4858685597126915,
|
|
"score_theta_alt": 0.1684997417214469,
|
|
"best_score": 0.1684997417214469,
|
|
"per_marker": [
|
|
{
|
|
"marker_id": 245,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 218,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 113,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 124,
|
|
"weight": 1.0
|
|
}
|
|
]
|
|
}
|
|
},
|
|
{
|
|
"link": "Arm2",
|
|
"joint_variable": "a",
|
|
"joint_type": "revolute",
|
|
"old": 0.0,
|
|
"new": -1.3848631894881365,
|
|
"info": {
|
|
"reason": "2d_alignment+normal_tiebreak",
|
|
"used_markers": 3,
|
|
"axis_world": [
|
|
0.033719888068824595,
|
|
-0.43494468638559897,
|
|
-0.8998255880622417
|
|
],
|
|
"axis_id": 2,
|
|
"theta_rad": 1.7567294641016562,
|
|
"theta_alt_rad": -1.3848631894881365,
|
|
"score_theta": 0.1224425414854914,
|
|
"score_theta_alt": 0.10278177844287473,
|
|
"best_score": 0.10278177844287473,
|
|
"per_marker": [
|
|
{
|
|
"marker_id": 218,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 113,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 124,
|
|
"weight": 1.0
|
|
}
|
|
]
|
|
}
|
|
}
|
|
]
|
|
},
|
|
{
|
|
"pass": 1,
|
|
"updates": [
|
|
{
|
|
"link": "Base",
|
|
"joint_variable": "x",
|
|
"joint_type": "linear",
|
|
"old": 0.053287321626320716,
|
|
"new": 0.049601955968715646,
|
|
"info": {
|
|
"reason": "weighted_projection",
|
|
"used_markers": 8,
|
|
"axis_world": [
|
|
0.999429899484619,
|
|
0.01619412884844312,
|
|
0.029624756623547046
|
|
],
|
|
"per_marker": [
|
|
{
|
|
"marker_id": 198,
|
|
"q_i": 0.016119811341528758,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 229,
|
|
"q_i": 0.05888877390306695,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 243,
|
|
"q_i": 0.0315215262724927,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 244,
|
|
"q_i": 0.020872012899893176,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 245,
|
|
"q_i": 0.043660020299714136,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 218,
|
|
"q_i": 0.11606808125252807,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 113,
|
|
"q_i": 0.03825536880485574,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 124,
|
|
"q_i": 0.07143005297564563,
|
|
"weight": 1.0
|
|
}
|
|
]
|
|
}
|
|
},
|
|
{
|
|
"link": "Arm1",
|
|
"joint_variable": "y",
|
|
"joint_type": "revolute",
|
|
"old": 0.17201947162039577,
|
|
"new": 0.1983555527659142,
|
|
"info": {
|
|
"reason": "2d_alignment+normal_tiebreak",
|
|
"used_markers": 8,
|
|
"axis_world": [
|
|
-0.999429899484619,
|
|
-0.01619412884844312,
|
|
-0.029624756623547046
|
|
],
|
|
"axis_id": 0,
|
|
"theta_rad": 0.19835555276591402,
|
|
"theta_alt_rad": -2.943237100823879,
|
|
"score_theta": 0.2505014941221992,
|
|
"score_theta_alt": 1.9489481052680921,
|
|
"best_score": 0.2505014941221992,
|
|
"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": 218,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 113,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 124,
|
|
"weight": 1.0
|
|
}
|
|
]
|
|
}
|
|
},
|
|
{
|
|
"link": "Ellbow",
|
|
"joint_variable": "z",
|
|
"joint_type": "revolute",
|
|
"old": -1.301051300558706,
|
|
"new": -1.383202430654766,
|
|
"info": {
|
|
"reason": "2d_alignment+normal_tiebreak",
|
|
"used_markers": 4,
|
|
"axis_world": [
|
|
-0.999429899484619,
|
|
-0.01619412884844312,
|
|
-0.029624756623547042
|
|
],
|
|
"axis_id": 0,
|
|
"theta_rad": 1.7583902229350281,
|
|
"theta_alt_rad": -1.383202430654766,
|
|
"score_theta": 0.5127930258443426,
|
|
"score_theta_alt": 0.1623665168102192,
|
|
"best_score": 0.1623665168102192,
|
|
"per_marker": [
|
|
{
|
|
"marker_id": 245,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 218,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 113,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 124,
|
|
"weight": 1.0
|
|
}
|
|
]
|
|
}
|
|
},
|
|
{
|
|
"link": "Arm2",
|
|
"joint_variable": "a",
|
|
"joint_type": "revolute",
|
|
"old": -1.3848631894881365,
|
|
"new": -1.370706275771358,
|
|
"info": {
|
|
"reason": "2d_alignment+normal_tiebreak",
|
|
"used_markers": 3,
|
|
"axis_world": [
|
|
0.033573279813030994,
|
|
-0.38404252089788654,
|
|
-0.9227048157579933
|
|
],
|
|
"axis_id": 2,
|
|
"theta_rad": 1.7708863778184347,
|
|
"theta_alt_rad": -1.370706275771358,
|
|
"score_theta": 0.11837128978227772,
|
|
"score_theta_alt": 0.09961150321808115,
|
|
"best_score": 0.09961150321808115,
|
|
"per_marker": [
|
|
{
|
|
"marker_id": 218,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 113,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 124,
|
|
"weight": 1.0
|
|
}
|
|
]
|
|
}
|
|
}
|
|
]
|
|
}
|
|
],
|
|
"root_link": "Board",
|
|
"root_pose": {
|
|
"reason": "kabsch",
|
|
"used_markers": [
|
|
210,
|
|
211,
|
|
215,
|
|
214,
|
|
208,
|
|
206,
|
|
205,
|
|
217,
|
|
46,
|
|
47,
|
|
51,
|
|
53,
|
|
54,
|
|
55,
|
|
56,
|
|
58,
|
|
59,
|
|
60,
|
|
61,
|
|
62,
|
|
63,
|
|
64,
|
|
66,
|
|
68,
|
|
69,
|
|
71,
|
|
72,
|
|
75,
|
|
79,
|
|
83,
|
|
84,
|
|
85,
|
|
86,
|
|
92,
|
|
95,
|
|
96,
|
|
97,
|
|
102,
|
|
103,
|
|
105
|
|
]
|
|
},
|
|
"marker_stats": {
|
|
"num_markers_used": 48,
|
|
"mean_error_m": 0.05229086401595959,
|
|
"rms_error_m": 0.07744223285373272,
|
|
"median_error_m": 0.03006151707959503,
|
|
"worst_error_m": 0.2323985370693703
|
|
},
|
|
"marker_reports": [
|
|
{
|
|
"marker_id": 46,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.02977436173539516,
|
|
-0.020163450777703845,
|
|
0.025920185947828564
|
|
],
|
|
"error_norm_m": 0.044327569339915975,
|
|
"predicted_m": [
|
|
0.5309846348696204,
|
|
0.19509678982540885,
|
|
-0.019264100052690733
|
|
],
|
|
"observed_m": [
|
|
0.5607589966050156,
|
|
0.2152602406031127,
|
|
-0.0451842860005193
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 47,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.0073628555498681525,
|
|
0.013876041434123187,
|
|
0.00755179109565474
|
|
],
|
|
"error_norm_m": 0.017429449689595422,
|
|
"predicted_m": [
|
|
0.34613832842165204,
|
|
-0.2799222036201479,
|
|
-0.02083561477221712
|
|
],
|
|
"observed_m": [
|
|
0.3535011839715202,
|
|
-0.2937982450542711,
|
|
-0.02838740586787186
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 51,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.010179977403965035,
|
|
0.011477065013790283,
|
|
0.003743682480280102
|
|
],
|
|
"error_norm_m": 0.015791457177511004,
|
|
"predicted_m": [
|
|
0.1679842734935269,
|
|
-0.16833826230017254,
|
|
-0.027064037699958576
|
|
],
|
|
"observed_m": [
|
|
0.15780429608956187,
|
|
-0.17981532731396282,
|
|
-0.03080772018023868
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 53,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.016244608790811632,
|
|
0.0037909543104679977,
|
|
0.007199594102783712
|
|
],
|
|
"error_norm_m": 0.018168456307441433,
|
|
"predicted_m": [
|
|
0.4801261761061199,
|
|
0.2210752021028367,
|
|
-0.02099351259610001
|
|
],
|
|
"observed_m": [
|
|
0.49637078489693154,
|
|
0.2172842477923687,
|
|
-0.02819310669888372
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 54,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.005601583835458779,
|
|
0.011561463851464115,
|
|
0.007033803115922211
|
|
],
|
|
"error_norm_m": 0.014646486750341926,
|
|
"predicted_m": [
|
|
0.34488165876126636,
|
|
-0.32399665945755224,
|
|
-0.02050816401048711
|
|
],
|
|
"observed_m": [
|
|
0.3392800749258076,
|
|
-0.33555812330901635,
|
|
-0.02754196712640932
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 55,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.006056503298817462,
|
|
0.01870992578690267,
|
|
0.012050310969998125
|
|
],
|
|
"error_norm_m": 0.02306409654926135,
|
|
"predicted_m": [
|
|
0.28528087237506344,
|
|
-0.2569460726799718,
|
|
-0.022837901104742542
|
|
],
|
|
"observed_m": [
|
|
0.2913373756738809,
|
|
-0.2756559984668745,
|
|
-0.03488821207474067
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 56,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.03602729562188883,
|
|
-0.010860700071165463,
|
|
0.020033714398758302
|
|
],
|
|
"error_norm_m": 0.0426294563473873,
|
|
"predicted_m": [
|
|
0.49324365088974215,
|
|
0.17771370040079967,
|
|
-0.020243962434154047
|
|
],
|
|
"observed_m": [
|
|
0.529270946511631,
|
|
0.18857440047196514,
|
|
-0.04027767683291235
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 58,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.013819968450056397,
|
|
0.0033860150421816393,
|
|
-0.0013047456083081603
|
|
],
|
|
"error_norm_m": 0.014288421428864492,
|
|
"predicted_m": [
|
|
0.051075156682240865,
|
|
-0.21626686111439278,
|
|
-0.030148324021068627
|
|
],
|
|
"observed_m": [
|
|
0.03725518823218447,
|
|
-0.21965287615657442,
|
|
-0.028843578412760466
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 59,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.0046474248509768,
|
|
-0.02007838972427911,
|
|
-0.022453303766810324
|
|
],
|
|
"error_norm_m": 0.030477715493622094,
|
|
"predicted_m": [
|
|
0.6278333889854647,
|
|
-0.2675670714186178,
|
|
-0.012550202155299117
|
|
],
|
|
"observed_m": [
|
|
0.6231859641344879,
|
|
-0.24748868169433869,
|
|
0.009903101611511207
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 60,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.020840498292304166,
|
|
0.05467635371103319,
|
|
-0.004062124678497342
|
|
],
|
|
"error_norm_m": 0.05865433386467877,
|
|
"predicted_m": [
|
|
0.4271248419293634,
|
|
0.2917930530527297,
|
|
-0.023157105097589194
|
|
],
|
|
"observed_m": [
|
|
0.44796534022166756,
|
|
0.2371166993416965,
|
|
-0.019094980419091852
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 61,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.016715411671068464,
|
|
0.03419778990423655,
|
|
-0.02822582122801697
|
|
],
|
|
"error_norm_m": 0.04738766512145928,
|
|
"predicted_m": [
|
|
-0.030224012422021617,
|
|
0.33640729620399756,
|
|
-0.0371443682864659
|
|
],
|
|
"observed_m": [
|
|
-0.013508600750953155,
|
|
0.302209506299761,
|
|
-0.008918547058448923
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 62,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.003008904985095595,
|
|
-0.0013059949002687254,
|
|
-0.003520345318250663
|
|
],
|
|
"error_norm_m": 0.004811648682997378,
|
|
"predicted_m": [
|
|
0.4047973593170085,
|
|
-0.16752137375126158,
|
|
-0.020019502523033472
|
|
],
|
|
"observed_m": [
|
|
0.4017884543319129,
|
|
-0.16621537885099286,
|
|
-0.01649915720478281
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 63,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.04095440242177373,
|
|
-0.03467808983161946,
|
|
-0.02694626301594327
|
|
],
|
|
"error_norm_m": 0.06004943032718001,
|
|
"predicted_m": [
|
|
0.7782580973875596,
|
|
-0.22252572594314765,
|
|
-0.008444060425642552
|
|
],
|
|
"observed_m": [
|
|
0.7373036949657858,
|
|
-0.1878476361115282,
|
|
0.018502202590300717
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 64,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.01303797844057802,
|
|
0.0013062603141276996,
|
|
-0.0036475044849425577
|
|
],
|
|
"error_norm_m": 0.01360145164285483,
|
|
"predicted_m": [
|
|
-0.020720486092046558,
|
|
-0.18754741547695392,
|
|
-0.03252384941666012
|
|
],
|
|
"observed_m": [
|
|
-0.03375846453262458,
|
|
-0.18885367579108162,
|
|
-0.02887634493171756
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 66,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.0063447633974443585,
|
|
0.009736616801269415,
|
|
0.005253599481634341
|
|
],
|
|
"error_norm_m": 0.012753745991579891,
|
|
"predicted_m": [
|
|
0.21295753153357003,
|
|
-0.3587773076567335,
|
|
-0.02414837912162585
|
|
],
|
|
"observed_m": [
|
|
0.20661276813612567,
|
|
-0.3685139244580029,
|
|
-0.02940197860326019
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 68,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.020994195458070353,
|
|
-0.008215071481563724,
|
|
0.017325649618756017
|
|
],
|
|
"error_norm_m": 0.0284327588723072,
|
|
"predicted_m": [
|
|
0.5682194605442779,
|
|
0.18089874398720743,
|
|
-0.01803786542823528
|
|
],
|
|
"observed_m": [
|
|
0.5892136560023482,
|
|
0.18911381546877115,
|
|
-0.0353635150469913
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 69,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.01686947656630972,
|
|
0.001361555528239744,
|
|
-0.0016296205514579852
|
|
],
|
|
"error_norm_m": 0.017002609688500387,
|
|
"predicted_m": [
|
|
0.009625268687811486,
|
|
-0.2800443527081194,
|
|
-0.030854547258707378
|
|
],
|
|
"observed_m": [
|
|
-0.007244207878498232,
|
|
-0.28140590823635914,
|
|
-0.029224926707249393
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 71,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.04534155679981389,
|
|
-0.03798045328533087,
|
|
-0.03464448159198996
|
|
],
|
|
"error_norm_m": 0.06854642010760066,
|
|
"predicted_m": [
|
|
0.7513868098480112,
|
|
-0.2708255788817454,
|
|
-0.00884432543376851
|
|
],
|
|
"observed_m": [
|
|
0.7060452530481973,
|
|
-0.23284512559641454,
|
|
0.025800156158221454
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 72,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.017621858058974815,
|
|
0.005352047115575104,
|
|
-0.0019367446397366012
|
|
],
|
|
"error_norm_m": 0.018518241535781414,
|
|
"predicted_m": [
|
|
0.43517764641343726,
|
|
0.20242521930493712,
|
|
-0.022177497437249876
|
|
],
|
|
"observed_m": [
|
|
0.4527995044724121,
|
|
0.19707317218936202,
|
|
-0.020240752797513275
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 75,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.023906225247401484,
|
|
-0.007770682755671776,
|
|
-0.027792825309228542
|
|
],
|
|
"error_norm_m": 0.0374744213396029,
|
|
"predicted_m": [
|
|
-0.031250438107700465,
|
|
0.19512753831582025,
|
|
-0.036005350565022076
|
|
],
|
|
"observed_m": [
|
|
-0.05515666335510195,
|
|
0.20289822107149202,
|
|
-0.008212525255793534
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 79,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.019741398794198728,
|
|
-0.0011177056092179505,
|
|
0.0012677730605323637
|
|
],
|
|
"error_norm_m": 0.01981361503394774,
|
|
"predicted_m": [
|
|
0.3121951356975619,
|
|
-0.15303035556186867,
|
|
-0.022896770770637617
|
|
],
|
|
"observed_m": [
|
|
0.33193653449176064,
|
|
-0.15191264995265072,
|
|
-0.02416454383116998
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 83,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.01687722352482758,
|
|
0.039320246776119006,
|
|
-0.0276298736317439
|
|
],
|
|
"error_norm_m": 0.05093458940001409,
|
|
"predicted_m": [
|
|
0.036263989380499614,
|
|
0.3408749406902213,
|
|
-0.03520162047662422
|
|
],
|
|
"observed_m": [
|
|
0.053141212905327195,
|
|
0.3015546939141023,
|
|
-0.0075717468448803235
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 84,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.026911733970135576,
|
|
0.002932553919758163,
|
|
0.012083195811184826
|
|
],
|
|
"error_norm_m": 0.02964531866556797,
|
|
"predicted_m": [
|
|
0.40067490937496975,
|
|
0.26597211561633705,
|
|
-0.023730914973698225
|
|
],
|
|
"observed_m": [
|
|
0.4275866433451053,
|
|
0.2630395616965789,
|
|
-0.03581411078488305
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 85,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.0025391176517612912,
|
|
-0.0027037961933991106,
|
|
0.0018538776460073694
|
|
],
|
|
"error_norm_m": 0.004146624486409533,
|
|
"predicted_m": [
|
|
0.5068147334903392,
|
|
-0.3035311406481469,
|
|
-0.015855901265281372
|
|
],
|
|
"observed_m": [
|
|
0.5042756158385779,
|
|
-0.3008273444547478,
|
|
-0.01770977891128874
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 86,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.02596059090385272,
|
|
0.04311787354616786,
|
|
-0.020219255040303467
|
|
],
|
|
"error_norm_m": 0.05423948353003889,
|
|
"predicted_m": [
|
|
0.35556486859929265,
|
|
0.2988343026100792,
|
|
-0.02534615093326374
|
|
],
|
|
"observed_m": [
|
|
0.38152545950314537,
|
|
0.25571642906391134,
|
|
-0.005126895892960272
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 92,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.02969931702418649,
|
|
-0.023918618882797116,
|
|
-0.023441802911906187
|
|
],
|
|
"error_norm_m": 0.0447623489634345,
|
|
"predicted_m": [
|
|
0.6452055808239586,
|
|
-0.17336685639000132,
|
|
-0.012812765079129634
|
|
],
|
|
"observed_m": [
|
|
0.6155062637997721,
|
|
-0.1494482375072042,
|
|
0.010629037832776555
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 95,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.013702574585451543,
|
|
0.012142477556413345,
|
|
0.00566938744275803
|
|
],
|
|
"error_norm_m": 0.019166175034522847,
|
|
"predicted_m": [
|
|
0.18783972498537516,
|
|
-0.2700160150567737,
|
|
-0.025631089542372705
|
|
],
|
|
"observed_m": [
|
|
0.1741371503999236,
|
|
-0.28215849261318704,
|
|
-0.031300476985130735
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 96,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.009663996874285041,
|
|
0.014444741665975702,
|
|
0.005375074043238701
|
|
],
|
|
"error_norm_m": 0.018191613956800644,
|
|
"predicted_m": [
|
|
0.37006884399304474,
|
|
-0.17947515108006473,
|
|
-0.020954612659116977
|
|
],
|
|
"observed_m": [
|
|
0.3797328408673298,
|
|
-0.19391989274604043,
|
|
-0.02632968670235568
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 97,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.006285106572075261,
|
|
0.010720622571001592,
|
|
0.005088768789963002
|
|
],
|
|
"error_norm_m": 0.013428696166415932,
|
|
"predicted_m": [
|
|
0.3074468491037817,
|
|
-0.35368593179348745,
|
|
-0.021377033431382277
|
|
],
|
|
"observed_m": [
|
|
0.30116174253170647,
|
|
-0.36440655436448904,
|
|
-0.02646580222134528
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 102,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.028741460534945418,
|
|
-0.024315124538578953,
|
|
-0.018563396358892592
|
|
],
|
|
"error_norm_m": 0.041974951094501306,
|
|
"predicted_m": [
|
|
0.6504112772240183,
|
|
-0.2114460527857186,
|
|
-0.012342523814674385
|
|
],
|
|
"observed_m": [
|
|
0.6216698166890728,
|
|
-0.18713092824713964,
|
|
0.006220872544218209
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 103,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.01081495654735981,
|
|
0.009167931106118604,
|
|
0.000583746578498745
|
|
],
|
|
"error_norm_m": 0.014189961450114193,
|
|
"predicted_m": [
|
|
0.10617883308424775,
|
|
-0.18497117098943547,
|
|
-0.028766648738828778
|
|
],
|
|
"observed_m": [
|
|
0.09536387653688794,
|
|
-0.19413910209555407,
|
|
-0.029350395317327523
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 105,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.002169453738404714,
|
|
-0.0024040942166324575,
|
|
-0.0015873780630882503
|
|
],
|
|
"error_norm_m": 0.0036063787433792396,
|
|
"predicted_m": [
|
|
0.5263219141998613,
|
|
-0.2567107374152468,
|
|
-0.015662660807077906
|
|
],
|
|
"observed_m": [
|
|
0.5241524604614566,
|
|
-0.25430664319861435,
|
|
-0.014075282743989656
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 113,
|
|
"link": "Arm2",
|
|
"error_m": [
|
|
0.013969809555760548,
|
|
-0.12070947392163119,
|
|
-0.025044532427430516
|
|
],
|
|
"error_norm_m": 0.12406917940395107,
|
|
"predicted_m": [
|
|
0.28060409757691523,
|
|
-0.20582328455247456,
|
|
-0.052217517264738715
|
|
],
|
|
"observed_m": [
|
|
0.2666342880211547,
|
|
-0.08511381063084338,
|
|
-0.0271729848373082
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 124,
|
|
"link": "Arm2",
|
|
"error_m": [
|
|
-0.018350090431261956,
|
|
-0.10823174575858835,
|
|
-0.0750060599809553
|
|
],
|
|
"error_norm_m": 0.1329539230058815,
|
|
"predicted_m": [
|
|
0.24561009571164888,
|
|
-0.24678343219260476,
|
|
-0.07654211672156906
|
|
],
|
|
"observed_m": [
|
|
0.26396018614291084,
|
|
-0.1385516864340164,
|
|
-0.0015360567406137618
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 198,
|
|
"link": "Arm1",
|
|
"error_m": [
|
|
0.02668223155332597,
|
|
0.0013586915271852629,
|
|
0.22930557332125973
|
|
],
|
|
"error_norm_m": 0.23085673799896544,
|
|
"predicted_m": [
|
|
0.15312917902049855,
|
|
-0.03710278501945731,
|
|
0.12562370834961964
|
|
],
|
|
"observed_m": [
|
|
0.12644694746717258,
|
|
-0.03846147654664257,
|
|
-0.1036818649716401
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 205,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.006692388656711068,
|
|
-0.015336273349981625,
|
|
0.033582364675758314
|
|
],
|
|
"error_norm_m": 0.037520188744374024,
|
|
"predicted_m": [
|
|
0.7477224817955899,
|
|
-0.07661523749543495,
|
|
0.017051979293681192
|
|
],
|
|
"observed_m": [
|
|
0.7544148704523009,
|
|
-0.06127896414545332,
|
|
-0.01653038538207712
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 206,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.042495346284374236,
|
|
-0.010745826187502815,
|
|
-0.01824910683832149
|
|
],
|
|
"error_norm_m": 0.04748007094221082,
|
|
"predicted_m": [
|
|
0.6465041902486512,
|
|
0.0017521198260508023,
|
|
0.013389362365103831
|
|
],
|
|
"observed_m": [
|
|
0.604008843964277,
|
|
0.012497946013553618,
|
|
0.03163846920342532
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 208,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.007987851932816703,
|
|
-0.012480629087450679,
|
|
0.012472121561776833
|
|
],
|
|
"error_norm_m": 0.01936816194611306,
|
|
"predicted_m": [
|
|
0.3479505220013427,
|
|
-0.08309288903481866,
|
|
0.00520207664425053
|
|
],
|
|
"observed_m": [
|
|
0.339962670068526,
|
|
-0.07061225994736799,
|
|
-0.007270044917526303
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 210,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.0074463115848725815,
|
|
0.0021649915371987245,
|
|
-0.0006177274601281944
|
|
],
|
|
"error_norm_m": 0.007779224369443663,
|
|
"predicted_m": [
|
|
0.017022766272509048,
|
|
-0.01844852762427002,
|
|
-0.0051867166494720006
|
|
],
|
|
"observed_m": [
|
|
0.009576454687636467,
|
|
-0.020613519161468745,
|
|
-0.004568989189343806
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 211,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.02511171094906539,
|
|
-0.015707281435153327,
|
|
0.025551753476736872
|
|
],
|
|
"error_norm_m": 0.03911788366730053,
|
|
"predicted_m": [
|
|
0.24673223045440407,
|
|
-0.004725531713332921,
|
|
0.0015394597156731674
|
|
],
|
|
"observed_m": [
|
|
0.27184394140346946,
|
|
0.010981749721820406,
|
|
-0.024012293761063706
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 214,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.0040600458965698305,
|
|
-0.011765868314021733,
|
|
0.011116536860858665
|
|
],
|
|
"error_norm_m": 0.016688230033289436,
|
|
"predicted_m": [
|
|
0.3466752204029659,
|
|
-0.0031061188284869905,
|
|
0.0045019353780308335
|
|
],
|
|
"observed_m": [
|
|
0.3507352662995357,
|
|
0.008659749485534742,
|
|
-0.006614601482827832
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 215,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.037228036202207826,
|
|
-0.01737982614105754,
|
|
0.035715321528362806
|
|
],
|
|
"error_norm_m": 0.05443867401067572,
|
|
"predicted_m": [
|
|
0.2480075320527808,
|
|
-0.0847123019196646,
|
|
0.0022396009818928635
|
|
],
|
|
"observed_m": [
|
|
0.28523556825498864,
|
|
-0.06733247577860706,
|
|
-0.033475720546469946
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 217,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.008290955393926769,
|
|
-0.024515650708768183,
|
|
0.010000067810273669
|
|
],
|
|
"error_norm_m": 0.027744520670368065,
|
|
"predicted_m": [
|
|
0.647779491847028,
|
|
-0.07823465038028088,
|
|
0.014089503631323526
|
|
],
|
|
"observed_m": [
|
|
0.6394885364531012,
|
|
-0.053718999671512696,
|
|
0.004089435821049857
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 218,
|
|
"link": "Arm2",
|
|
"error_m": [
|
|
-0.06983952845228092,
|
|
-0.0021526861052450497,
|
|
0.13011872735598679
|
|
],
|
|
"error_norm_m": 0.14769250827528896,
|
|
"predicted_m": [
|
|
0.2556782667308758,
|
|
-0.1421327330367756,
|
|
-0.00376943573175992
|
|
],
|
|
"observed_m": [
|
|
0.3255177951831567,
|
|
-0.13998004693153054,
|
|
-0.1338881630877467
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 229,
|
|
"link": "Arm1",
|
|
"error_m": [
|
|
-0.013734753331897553,
|
|
-0.049598521231027246,
|
|
0.17699082283206807
|
|
],
|
|
"error_norm_m": 0.1843214803655972,
|
|
"predicted_m": [
|
|
0.1540079347418492,
|
|
-0.12517671919233822,
|
|
0.14412262474200851
|
|
],
|
|
"observed_m": [
|
|
0.16774268807374676,
|
|
-0.07557819796131098,
|
|
-0.032868198090059565
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 243,
|
|
"link": "Arm1",
|
|
"error_m": [
|
|
0.016467541905549332,
|
|
-0.10509049234745793,
|
|
0.11220767011738797
|
|
],
|
|
"error_norm_m": 0.15461485294568145,
|
|
"predicted_m": [
|
|
0.15548085079473972,
|
|
-0.16660749140311587,
|
|
0.11707966572640516
|
|
],
|
|
"observed_m": [
|
|
0.1390133088891904,
|
|
-0.061516999055657946,
|
|
0.00487199560901719
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 244,
|
|
"link": "Ellbow",
|
|
"error_m": [
|
|
0.029221404125318207,
|
|
-0.20867014191929295,
|
|
0.09804061119918853
|
|
],
|
|
"error_norm_m": 0.2323985370693703,
|
|
"predicted_m": [
|
|
0.28006784989415295,
|
|
-0.13033225089649697,
|
|
0.11358873726286149
|
|
],
|
|
"observed_m": [
|
|
0.25084644576883475,
|
|
0.07833789102279598,
|
|
0.015548126063672972
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 245,
|
|
"link": "Ellbow",
|
|
"error_m": [
|
|
0.005719977312683422,
|
|
-0.128862384185638,
|
|
0.07804396170463611
|
|
],
|
|
"error_norm_m": 0.15076170653391824,
|
|
"predicted_m": [
|
|
0.2449630202060875,
|
|
-0.09858797705329242,
|
|
0.09909901639829634
|
|
],
|
|
"observed_m": [
|
|
0.2392430428934041,
|
|
0.030274407132345596,
|
|
0.021055054693660227
|
|
]
|
|
}
|
|
],
|
|
"stage_idx": 2,
|
|
"num_active_links": 5
|
|
}
|
|
],
|
|
"markers": [
|
|
{
|
|
"marker_id": 41,
|
|
"link": "FingerA",
|
|
"observed_position_m": [
|
|
0.31475315281264754,
|
|
0.016790823616325497,
|
|
-0.23417786729944443
|
|
],
|
|
"predicted_position_m": [
|
|
0.2810924985394696,
|
|
-0.2405267131055785,
|
|
-0.1517683259560873
|
|
],
|
|
"error_m": [
|
|
-0.03366065427317794,
|
|
-0.257317536721904,
|
|
0.08240954134335712
|
|
],
|
|
"error_norm_m": 0.27228052970263833
|
|
},
|
|
{
|
|
"marker_id": 42,
|
|
"link": "FingerA",
|
|
"observed_position_m": [
|
|
0.34054124967789434,
|
|
0.051868201633841135,
|
|
-0.2529814794757987
|
|
],
|
|
"predicted_position_m": [
|
|
0.2594923074095744,
|
|
-0.23946013791759316,
|
|
-0.19396470210984026
|
|
],
|
|
"error_m": [
|
|
-0.08104894226831993,
|
|
-0.2913283395514343,
|
|
0.05901677736595842
|
|
],
|
|
"error_norm_m": 0.30809756973931546
|
|
},
|
|
{
|
|
"marker_id": 43,
|
|
"link": "FingerB",
|
|
"observed_position_m": [
|
|
0.2806952388771512,
|
|
0.139741624598429,
|
|
-0.06306073445420023
|
|
],
|
|
"predicted_position_m": [
|
|
0.26910093976697064,
|
|
-0.2669620065691915,
|
|
-0.16482810304811896
|
|
],
|
|
"error_m": [
|
|
-0.011594299110180561,
|
|
-0.40670363116762054,
|
|
-0.10176736859391873
|
|
],
|
|
"error_norm_m": 0.4194029907944324
|
|
},
|
|
{
|
|
"marker_id": 46,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.5607589966050156,
|
|
0.2152602406031127,
|
|
-0.0451842860005193
|
|
],
|
|
"predicted_position_m": [
|
|
0.5309846348696204,
|
|
0.19509678982540885,
|
|
-0.019264100052690733
|
|
],
|
|
"error_m": [
|
|
-0.02977436173539516,
|
|
-0.020163450777703845,
|
|
0.025920185947828564
|
|
],
|
|
"error_norm_m": 0.044327569339915975
|
|
},
|
|
{
|
|
"marker_id": 47,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.3535011839715202,
|
|
-0.2937982450542711,
|
|
-0.02838740586787186
|
|
],
|
|
"predicted_position_m": [
|
|
0.34613832842165204,
|
|
-0.2799222036201479,
|
|
-0.02083561477221712
|
|
],
|
|
"error_m": [
|
|
-0.0073628555498681525,
|
|
0.013876041434123187,
|
|
0.00755179109565474
|
|
],
|
|
"error_norm_m": 0.017429449689595422
|
|
},
|
|
{
|
|
"marker_id": 51,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.15780429608956187,
|
|
-0.17981532731396282,
|
|
-0.03080772018023868
|
|
],
|
|
"predicted_position_m": [
|
|
0.1679842734935269,
|
|
-0.16833826230017254,
|
|
-0.027064037699958576
|
|
],
|
|
"error_m": [
|
|
0.010179977403965035,
|
|
0.011477065013790283,
|
|
0.003743682480280102
|
|
],
|
|
"error_norm_m": 0.015791457177511004
|
|
},
|
|
{
|
|
"marker_id": 53,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.49637078489693154,
|
|
0.2172842477923687,
|
|
-0.02819310669888372
|
|
],
|
|
"predicted_position_m": [
|
|
0.4801261761061199,
|
|
0.2210752021028367,
|
|
-0.02099351259610001
|
|
],
|
|
"error_m": [
|
|
-0.016244608790811632,
|
|
0.0037909543104679977,
|
|
0.007199594102783712
|
|
],
|
|
"error_norm_m": 0.018168456307441433
|
|
},
|
|
{
|
|
"marker_id": 54,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.3392800749258076,
|
|
-0.33555812330901635,
|
|
-0.02754196712640932
|
|
],
|
|
"predicted_position_m": [
|
|
0.34488165876126636,
|
|
-0.32399665945755224,
|
|
-0.02050816401048711
|
|
],
|
|
"error_m": [
|
|
0.005601583835458779,
|
|
0.011561463851464115,
|
|
0.007033803115922211
|
|
],
|
|
"error_norm_m": 0.014646486750341926
|
|
},
|
|
{
|
|
"marker_id": 55,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.2913373756738809,
|
|
-0.2756559984668745,
|
|
-0.03488821207474067
|
|
],
|
|
"predicted_position_m": [
|
|
0.28528087237506344,
|
|
-0.2569460726799718,
|
|
-0.022837901104742542
|
|
],
|
|
"error_m": [
|
|
-0.006056503298817462,
|
|
0.01870992578690267,
|
|
0.012050310969998125
|
|
],
|
|
"error_norm_m": 0.02306409654926135
|
|
},
|
|
{
|
|
"marker_id": 56,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.529270946511631,
|
|
0.18857440047196514,
|
|
-0.04027767683291235
|
|
],
|
|
"predicted_position_m": [
|
|
0.49324365088974215,
|
|
0.17771370040079967,
|
|
-0.020243962434154047
|
|
],
|
|
"error_m": [
|
|
-0.03602729562188883,
|
|
-0.010860700071165463,
|
|
0.020033714398758302
|
|
],
|
|
"error_norm_m": 0.0426294563473873
|
|
},
|
|
{
|
|
"marker_id": 58,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.03725518823218447,
|
|
-0.21965287615657442,
|
|
-0.028843578412760466
|
|
],
|
|
"predicted_position_m": [
|
|
0.051075156682240865,
|
|
-0.21626686111439278,
|
|
-0.030148324021068627
|
|
],
|
|
"error_m": [
|
|
0.013819968450056397,
|
|
0.0033860150421816393,
|
|
-0.0013047456083081603
|
|
],
|
|
"error_norm_m": 0.014288421428864492
|
|
},
|
|
{
|
|
"marker_id": 59,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.6231859641344879,
|
|
-0.24748868169433869,
|
|
0.009903101611511207
|
|
],
|
|
"predicted_position_m": [
|
|
0.6278333889854647,
|
|
-0.2675670714186178,
|
|
-0.012550202155299117
|
|
],
|
|
"error_m": [
|
|
0.0046474248509768,
|
|
-0.02007838972427911,
|
|
-0.022453303766810324
|
|
],
|
|
"error_norm_m": 0.030477715493622094
|
|
},
|
|
{
|
|
"marker_id": 60,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.44796534022166756,
|
|
0.2371166993416965,
|
|
-0.019094980419091852
|
|
],
|
|
"predicted_position_m": [
|
|
0.4271248419293634,
|
|
0.2917930530527297,
|
|
-0.023157105097589194
|
|
],
|
|
"error_m": [
|
|
-0.020840498292304166,
|
|
0.05467635371103319,
|
|
-0.004062124678497342
|
|
],
|
|
"error_norm_m": 0.05865433386467877
|
|
},
|
|
{
|
|
"marker_id": 61,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
-0.013508600750953155,
|
|
0.302209506299761,
|
|
-0.008918547058448923
|
|
],
|
|
"predicted_position_m": [
|
|
-0.030224012422021617,
|
|
0.33640729620399756,
|
|
-0.0371443682864659
|
|
],
|
|
"error_m": [
|
|
-0.016715411671068464,
|
|
0.03419778990423655,
|
|
-0.02822582122801697
|
|
],
|
|
"error_norm_m": 0.04738766512145928
|
|
},
|
|
{
|
|
"marker_id": 62,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.4017884543319129,
|
|
-0.16621537885099286,
|
|
-0.01649915720478281
|
|
],
|
|
"predicted_position_m": [
|
|
0.4047973593170085,
|
|
-0.16752137375126158,
|
|
-0.020019502523033472
|
|
],
|
|
"error_m": [
|
|
0.003008904985095595,
|
|
-0.0013059949002687254,
|
|
-0.003520345318250663
|
|
],
|
|
"error_norm_m": 0.004811648682997378
|
|
},
|
|
{
|
|
"marker_id": 63,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.7373036949657858,
|
|
-0.1878476361115282,
|
|
0.018502202590300717
|
|
],
|
|
"predicted_position_m": [
|
|
0.7782580973875596,
|
|
-0.22252572594314765,
|
|
-0.008444060425642552
|
|
],
|
|
"error_m": [
|
|
0.04095440242177373,
|
|
-0.03467808983161946,
|
|
-0.02694626301594327
|
|
],
|
|
"error_norm_m": 0.06004943032718001
|
|
},
|
|
{
|
|
"marker_id": 64,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
-0.03375846453262458,
|
|
-0.18885367579108162,
|
|
-0.02887634493171756
|
|
],
|
|
"predicted_position_m": [
|
|
-0.020720486092046558,
|
|
-0.18754741547695392,
|
|
-0.03252384941666012
|
|
],
|
|
"error_m": [
|
|
0.01303797844057802,
|
|
0.0013062603141276996,
|
|
-0.0036475044849425577
|
|
],
|
|
"error_norm_m": 0.01360145164285483
|
|
},
|
|
{
|
|
"marker_id": 66,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.20661276813612567,
|
|
-0.3685139244580029,
|
|
-0.02940197860326019
|
|
],
|
|
"predicted_position_m": [
|
|
0.21295753153357003,
|
|
-0.3587773076567335,
|
|
-0.02414837912162585
|
|
],
|
|
"error_m": [
|
|
0.0063447633974443585,
|
|
0.009736616801269415,
|
|
0.005253599481634341
|
|
],
|
|
"error_norm_m": 0.012753745991579891
|
|
},
|
|
{
|
|
"marker_id": 68,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.5892136560023482,
|
|
0.18911381546877115,
|
|
-0.0353635150469913
|
|
],
|
|
"predicted_position_m": [
|
|
0.5682194605442779,
|
|
0.18089874398720743,
|
|
-0.01803786542823528
|
|
],
|
|
"error_m": [
|
|
-0.020994195458070353,
|
|
-0.008215071481563724,
|
|
0.017325649618756017
|
|
],
|
|
"error_norm_m": 0.0284327588723072
|
|
},
|
|
{
|
|
"marker_id": 69,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
-0.007244207878498232,
|
|
-0.28140590823635914,
|
|
-0.029224926707249393
|
|
],
|
|
"predicted_position_m": [
|
|
0.009625268687811486,
|
|
-0.2800443527081194,
|
|
-0.030854547258707378
|
|
],
|
|
"error_m": [
|
|
0.01686947656630972,
|
|
0.001361555528239744,
|
|
-0.0016296205514579852
|
|
],
|
|
"error_norm_m": 0.017002609688500387
|
|
},
|
|
{
|
|
"marker_id": 71,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.7060452530481973,
|
|
-0.23284512559641454,
|
|
0.025800156158221454
|
|
],
|
|
"predicted_position_m": [
|
|
0.7513868098480112,
|
|
-0.2708255788817454,
|
|
-0.00884432543376851
|
|
],
|
|
"error_m": [
|
|
0.04534155679981389,
|
|
-0.03798045328533087,
|
|
-0.03464448159198996
|
|
],
|
|
"error_norm_m": 0.06854642010760066
|
|
},
|
|
{
|
|
"marker_id": 72,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.4527995044724121,
|
|
0.19707317218936202,
|
|
-0.020240752797513275
|
|
],
|
|
"predicted_position_m": [
|
|
0.43517764641343726,
|
|
0.20242521930493712,
|
|
-0.022177497437249876
|
|
],
|
|
"error_m": [
|
|
-0.017621858058974815,
|
|
0.005352047115575104,
|
|
-0.0019367446397366012
|
|
],
|
|
"error_norm_m": 0.018518241535781414
|
|
},
|
|
{
|
|
"marker_id": 75,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
-0.05515666335510195,
|
|
0.20289822107149202,
|
|
-0.008212525255793534
|
|
],
|
|
"predicted_position_m": [
|
|
-0.031250438107700465,
|
|
0.19512753831582025,
|
|
-0.036005350565022076
|
|
],
|
|
"error_m": [
|
|
0.023906225247401484,
|
|
-0.007770682755671776,
|
|
-0.027792825309228542
|
|
],
|
|
"error_norm_m": 0.0374744213396029
|
|
},
|
|
{
|
|
"marker_id": 79,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.33193653449176064,
|
|
-0.15191264995265072,
|
|
-0.02416454383116998
|
|
],
|
|
"predicted_position_m": [
|
|
0.3121951356975619,
|
|
-0.15303035556186867,
|
|
-0.022896770770637617
|
|
],
|
|
"error_m": [
|
|
-0.019741398794198728,
|
|
-0.0011177056092179505,
|
|
0.0012677730605323637
|
|
],
|
|
"error_norm_m": 0.01981361503394774
|
|
},
|
|
{
|
|
"marker_id": 83,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.053141212905327195,
|
|
0.3015546939141023,
|
|
-0.0075717468448803235
|
|
],
|
|
"predicted_position_m": [
|
|
0.036263989380499614,
|
|
0.3408749406902213,
|
|
-0.03520162047662422
|
|
],
|
|
"error_m": [
|
|
-0.01687722352482758,
|
|
0.039320246776119006,
|
|
-0.0276298736317439
|
|
],
|
|
"error_norm_m": 0.05093458940001409
|
|
},
|
|
{
|
|
"marker_id": 84,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.4275866433451053,
|
|
0.2630395616965789,
|
|
-0.03581411078488305
|
|
],
|
|
"predicted_position_m": [
|
|
0.40067490937496975,
|
|
0.26597211561633705,
|
|
-0.023730914973698225
|
|
],
|
|
"error_m": [
|
|
-0.026911733970135576,
|
|
0.002932553919758163,
|
|
0.012083195811184826
|
|
],
|
|
"error_norm_m": 0.02964531866556797
|
|
},
|
|
{
|
|
"marker_id": 85,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.5042756158385779,
|
|
-0.3008273444547478,
|
|
-0.01770977891128874
|
|
],
|
|
"predicted_position_m": [
|
|
0.5068147334903392,
|
|
-0.3035311406481469,
|
|
-0.015855901265281372
|
|
],
|
|
"error_m": [
|
|
0.0025391176517612912,
|
|
-0.0027037961933991106,
|
|
0.0018538776460073694
|
|
],
|
|
"error_norm_m": 0.004146624486409533
|
|
},
|
|
{
|
|
"marker_id": 86,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.38152545950314537,
|
|
0.25571642906391134,
|
|
-0.005126895892960272
|
|
],
|
|
"predicted_position_m": [
|
|
0.35556486859929265,
|
|
0.2988343026100792,
|
|
-0.02534615093326374
|
|
],
|
|
"error_m": [
|
|
-0.02596059090385272,
|
|
0.04311787354616786,
|
|
-0.020219255040303467
|
|
],
|
|
"error_norm_m": 0.05423948353003889
|
|
},
|
|
{
|
|
"marker_id": 92,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.6155062637997721,
|
|
-0.1494482375072042,
|
|
0.010629037832776555
|
|
],
|
|
"predicted_position_m": [
|
|
0.6452055808239586,
|
|
-0.17336685639000132,
|
|
-0.012812765079129634
|
|
],
|
|
"error_m": [
|
|
0.02969931702418649,
|
|
-0.023918618882797116,
|
|
-0.023441802911906187
|
|
],
|
|
"error_norm_m": 0.0447623489634345
|
|
},
|
|
{
|
|
"marker_id": 95,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.1741371503999236,
|
|
-0.28215849261318704,
|
|
-0.031300476985130735
|
|
],
|
|
"predicted_position_m": [
|
|
0.18783972498537516,
|
|
-0.2700160150567737,
|
|
-0.025631089542372705
|
|
],
|
|
"error_m": [
|
|
0.013702574585451543,
|
|
0.012142477556413345,
|
|
0.00566938744275803
|
|
],
|
|
"error_norm_m": 0.019166175034522847
|
|
},
|
|
{
|
|
"marker_id": 96,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.3797328408673298,
|
|
-0.19391989274604043,
|
|
-0.02632968670235568
|
|
],
|
|
"predicted_position_m": [
|
|
0.37006884399304474,
|
|
-0.17947515108006473,
|
|
-0.020954612659116977
|
|
],
|
|
"error_m": [
|
|
-0.009663996874285041,
|
|
0.014444741665975702,
|
|
0.005375074043238701
|
|
],
|
|
"error_norm_m": 0.018191613956800644
|
|
},
|
|
{
|
|
"marker_id": 97,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.30116174253170647,
|
|
-0.36440655436448904,
|
|
-0.02646580222134528
|
|
],
|
|
"predicted_position_m": [
|
|
0.3074468491037817,
|
|
-0.35368593179348745,
|
|
-0.021377033431382277
|
|
],
|
|
"error_m": [
|
|
0.006285106572075261,
|
|
0.010720622571001592,
|
|
0.005088768789963002
|
|
],
|
|
"error_norm_m": 0.013428696166415932
|
|
},
|
|
{
|
|
"marker_id": 102,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.6216698166890728,
|
|
-0.18713092824713964,
|
|
0.006220872544218209
|
|
],
|
|
"predicted_position_m": [
|
|
0.6504112772240183,
|
|
-0.2114460527857186,
|
|
-0.012342523814674385
|
|
],
|
|
"error_m": [
|
|
0.028741460534945418,
|
|
-0.024315124538578953,
|
|
-0.018563396358892592
|
|
],
|
|
"error_norm_m": 0.041974951094501306
|
|
},
|
|
{
|
|
"marker_id": 103,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.09536387653688794,
|
|
-0.19413910209555407,
|
|
-0.029350395317327523
|
|
],
|
|
"predicted_position_m": [
|
|
0.10617883308424775,
|
|
-0.18497117098943547,
|
|
-0.028766648738828778
|
|
],
|
|
"error_m": [
|
|
0.01081495654735981,
|
|
0.009167931106118604,
|
|
0.000583746578498745
|
|
],
|
|
"error_norm_m": 0.014189961450114193
|
|
},
|
|
{
|
|
"marker_id": 105,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.5241524604614566,
|
|
-0.25430664319861435,
|
|
-0.014075282743989656
|
|
],
|
|
"predicted_position_m": [
|
|
0.5263219141998613,
|
|
-0.2567107374152468,
|
|
-0.015662660807077906
|
|
],
|
|
"error_m": [
|
|
0.002169453738404714,
|
|
-0.0024040942166324575,
|
|
-0.0015873780630882503
|
|
],
|
|
"error_norm_m": 0.0036063787433792396
|
|
},
|
|
{
|
|
"marker_id": 113,
|
|
"link": "Arm2",
|
|
"observed_position_m": [
|
|
0.2666342880211547,
|
|
-0.08511381063084338,
|
|
-0.0271729848373082
|
|
],
|
|
"predicted_position_m": [
|
|
0.28060409757691523,
|
|
-0.20582328455247456,
|
|
-0.052217517264738715
|
|
],
|
|
"error_m": [
|
|
0.013969809555760548,
|
|
-0.12070947392163119,
|
|
-0.025044532427430516
|
|
],
|
|
"error_norm_m": 0.12406917940395107
|
|
},
|
|
{
|
|
"marker_id": 124,
|
|
"link": "Arm2",
|
|
"observed_position_m": [
|
|
0.26396018614291084,
|
|
-0.1385516864340164,
|
|
-0.0015360567406137618
|
|
],
|
|
"predicted_position_m": [
|
|
0.24561009571164888,
|
|
-0.24678343219260476,
|
|
-0.07654211672156906
|
|
],
|
|
"error_m": [
|
|
-0.018350090431261956,
|
|
-0.10823174575858835,
|
|
-0.0750060599809553
|
|
],
|
|
"error_norm_m": 0.1329539230058815
|
|
},
|
|
{
|
|
"marker_id": 198,
|
|
"link": "Arm1",
|
|
"observed_position_m": [
|
|
0.12644694746717258,
|
|
-0.03846147654664257,
|
|
-0.1036818649716401
|
|
],
|
|
"predicted_position_m": [
|
|
0.15312917902049855,
|
|
-0.03710278501945731,
|
|
0.12562370834961964
|
|
],
|
|
"error_m": [
|
|
0.02668223155332597,
|
|
0.0013586915271852629,
|
|
0.22930557332125973
|
|
],
|
|
"error_norm_m": 0.23085673799896544
|
|
},
|
|
{
|
|
"marker_id": 205,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.7544148704523009,
|
|
-0.06127896414545332,
|
|
-0.01653038538207712
|
|
],
|
|
"predicted_position_m": [
|
|
0.7477224817955899,
|
|
-0.07661523749543495,
|
|
0.017051979293681192
|
|
],
|
|
"error_m": [
|
|
-0.006692388656711068,
|
|
-0.015336273349981625,
|
|
0.033582364675758314
|
|
],
|
|
"error_norm_m": 0.037520188744374024
|
|
},
|
|
{
|
|
"marker_id": 206,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.604008843964277,
|
|
0.012497946013553618,
|
|
0.03163846920342532
|
|
],
|
|
"predicted_position_m": [
|
|
0.6465041902486512,
|
|
0.0017521198260508023,
|
|
0.013389362365103831
|
|
],
|
|
"error_m": [
|
|
0.042495346284374236,
|
|
-0.010745826187502815,
|
|
-0.01824910683832149
|
|
],
|
|
"error_norm_m": 0.04748007094221082
|
|
},
|
|
{
|
|
"marker_id": 208,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.339962670068526,
|
|
-0.07061225994736799,
|
|
-0.007270044917526303
|
|
],
|
|
"predicted_position_m": [
|
|
0.3479505220013427,
|
|
-0.08309288903481866,
|
|
0.00520207664425053
|
|
],
|
|
"error_m": [
|
|
0.007987851932816703,
|
|
-0.012480629087450679,
|
|
0.012472121561776833
|
|
],
|
|
"error_norm_m": 0.01936816194611306
|
|
},
|
|
{
|
|
"marker_id": 210,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.009576454687636467,
|
|
-0.020613519161468745,
|
|
-0.004568989189343806
|
|
],
|
|
"predicted_position_m": [
|
|
0.017022766272509048,
|
|
-0.01844852762427002,
|
|
-0.0051867166494720006
|
|
],
|
|
"error_m": [
|
|
0.0074463115848725815,
|
|
0.0021649915371987245,
|
|
-0.0006177274601281944
|
|
],
|
|
"error_norm_m": 0.007779224369443663
|
|
},
|
|
{
|
|
"marker_id": 211,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.27184394140346946,
|
|
0.010981749721820406,
|
|
-0.024012293761063706
|
|
],
|
|
"predicted_position_m": [
|
|
0.24673223045440407,
|
|
-0.004725531713332921,
|
|
0.0015394597156731674
|
|
],
|
|
"error_m": [
|
|
-0.02511171094906539,
|
|
-0.015707281435153327,
|
|
0.025551753476736872
|
|
],
|
|
"error_norm_m": 0.03911788366730053
|
|
},
|
|
{
|
|
"marker_id": 214,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.3507352662995357,
|
|
0.008659749485534742,
|
|
-0.006614601482827832
|
|
],
|
|
"predicted_position_m": [
|
|
0.3466752204029659,
|
|
-0.0031061188284869905,
|
|
0.0045019353780308335
|
|
],
|
|
"error_m": [
|
|
-0.0040600458965698305,
|
|
-0.011765868314021733,
|
|
0.011116536860858665
|
|
],
|
|
"error_norm_m": 0.016688230033289436
|
|
},
|
|
{
|
|
"marker_id": 215,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.28523556825498864,
|
|
-0.06733247577860706,
|
|
-0.033475720546469946
|
|
],
|
|
"predicted_position_m": [
|
|
0.2480075320527808,
|
|
-0.0847123019196646,
|
|
0.0022396009818928635
|
|
],
|
|
"error_m": [
|
|
-0.037228036202207826,
|
|
-0.01737982614105754,
|
|
0.035715321528362806
|
|
],
|
|
"error_norm_m": 0.05443867401067572
|
|
},
|
|
{
|
|
"marker_id": 217,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.6394885364531012,
|
|
-0.053718999671512696,
|
|
0.004089435821049857
|
|
],
|
|
"predicted_position_m": [
|
|
0.647779491847028,
|
|
-0.07823465038028088,
|
|
0.014089503631323526
|
|
],
|
|
"error_m": [
|
|
0.008290955393926769,
|
|
-0.024515650708768183,
|
|
0.010000067810273669
|
|
],
|
|
"error_norm_m": 0.027744520670368065
|
|
},
|
|
{
|
|
"marker_id": 218,
|
|
"link": "Arm2",
|
|
"observed_position_m": [
|
|
0.3255177951831567,
|
|
-0.13998004693153054,
|
|
-0.1338881630877467
|
|
],
|
|
"predicted_position_m": [
|
|
0.2556782667308758,
|
|
-0.1421327330367756,
|
|
-0.00376943573175992
|
|
],
|
|
"error_m": [
|
|
-0.06983952845228092,
|
|
-0.0021526861052450497,
|
|
0.13011872735598679
|
|
],
|
|
"error_norm_m": 0.14769250827528896
|
|
},
|
|
{
|
|
"marker_id": 229,
|
|
"link": "Arm1",
|
|
"observed_position_m": [
|
|
0.16774268807374676,
|
|
-0.07557819796131098,
|
|
-0.032868198090059565
|
|
],
|
|
"predicted_position_m": [
|
|
0.1540079347418492,
|
|
-0.12517671919233822,
|
|
0.14412262474200851
|
|
],
|
|
"error_m": [
|
|
-0.013734753331897553,
|
|
-0.049598521231027246,
|
|
0.17699082283206807
|
|
],
|
|
"error_norm_m": 0.1843214803655972
|
|
},
|
|
{
|
|
"marker_id": 243,
|
|
"link": "Arm1",
|
|
"observed_position_m": [
|
|
0.1390133088891904,
|
|
-0.061516999055657946,
|
|
0.00487199560901719
|
|
],
|
|
"predicted_position_m": [
|
|
0.15548085079473972,
|
|
-0.16660749140311587,
|
|
0.11707966572640516
|
|
],
|
|
"error_m": [
|
|
0.016467541905549332,
|
|
-0.10509049234745793,
|
|
0.11220767011738797
|
|
],
|
|
"error_norm_m": 0.15461485294568145
|
|
},
|
|
{
|
|
"marker_id": 244,
|
|
"link": "Ellbow",
|
|
"observed_position_m": [
|
|
0.25084644576883475,
|
|
0.07833789102279598,
|
|
0.015548126063672972
|
|
],
|
|
"predicted_position_m": [
|
|
0.28006784989415295,
|
|
-0.13033225089649697,
|
|
0.11358873726286149
|
|
],
|
|
"error_m": [
|
|
0.029221404125318207,
|
|
-0.20867014191929295,
|
|
0.09804061119918853
|
|
],
|
|
"error_norm_m": 0.2323985370693703
|
|
},
|
|
{
|
|
"marker_id": 245,
|
|
"link": "Ellbow",
|
|
"observed_position_m": [
|
|
0.2392430428934041,
|
|
0.030274407132345596,
|
|
0.021055054693660227
|
|
],
|
|
"predicted_position_m": [
|
|
0.2449630202060875,
|
|
-0.09858797705329242,
|
|
0.09909901639829634
|
|
],
|
|
"error_m": [
|
|
0.005719977312683422,
|
|
-0.128862384185638,
|
|
0.07804396170463611
|
|
],
|
|
"error_norm_m": 0.15076170653391824
|
|
}
|
|
]
|
|
} |