5489 lines
143 KiB
JSON
5489 lines
143 KiB
JSON
{
|
|
"schema_version": "1.0",
|
|
"method": "deterministic_geometric_sequential_prefix",
|
|
"created_utc": "2026-06-01T18:52:19Z",
|
|
"root_pose": {
|
|
"translation_m": [
|
|
2.522185138842392e-05,
|
|
7.88837756199312e-06,
|
|
4.613156500766699e-05
|
|
],
|
|
"rotation_matrix": [
|
|
[
|
|
0.9999999825452351,
|
|
7.933775773991147e-06,
|
|
0.00018667239901209626
|
|
],
|
|
[
|
|
-7.911330830307139e-06,
|
|
0.9999999927401763,
|
|
-0.0001202375069444404
|
|
],
|
|
[
|
|
-0.00018667335159430908,
|
|
0.00012023602801862844,
|
|
0.9999999753481786
|
|
]
|
|
],
|
|
"euler_xyz_deg": [
|
|
0.006889017087513451,
|
|
0.010695595256033755,
|
|
-0.0004532858748108697
|
|
]
|
|
},
|
|
"movements": {
|
|
"x": {
|
|
"value_m": 0.02894587263620346,
|
|
"value_mm": 28.945872636203458,
|
|
"joint_type": "linear",
|
|
"link": "Base"
|
|
},
|
|
"y": {
|
|
"value_rad": -0.08818746829453605,
|
|
"value_deg": -5.052769739220675,
|
|
"joint_type": "revolute",
|
|
"link": "Arm1"
|
|
},
|
|
"z": {
|
|
"value_rad": 1.4953740918354965,
|
|
"value_deg": 85.67862425538233,
|
|
"joint_type": "revolute",
|
|
"link": "Ellbow"
|
|
},
|
|
"a": {
|
|
"value_rad": 1.0840347802398904,
|
|
"value_deg": 62.11061775313741,
|
|
"joint_type": "revolute",
|
|
"link": "Arm2"
|
|
},
|
|
"b": {
|
|
"value_rad": 0.0,
|
|
"value_deg": 0.0,
|
|
"joint_type": "revolute",
|
|
"link": "Hand"
|
|
},
|
|
"c": {
|
|
"value_rad": 0.0,
|
|
"value_deg": 0.0,
|
|
"joint_type": "revolute",
|
|
"link": "Palm"
|
|
},
|
|
"e": {
|
|
"value_m": 0.0,
|
|
"value_mm": 0.0,
|
|
"joint_type": "linear",
|
|
"link": "FingerB"
|
|
}
|
|
},
|
|
"link_poses": {
|
|
"Board": {
|
|
"translation_m": [
|
|
2.522185138842392e-05,
|
|
7.88837756199312e-06,
|
|
4.613156500766699e-05
|
|
],
|
|
"rotation_matrix": [
|
|
[
|
|
0.9999999825452351,
|
|
7.933775773991147e-06,
|
|
0.00018667239901209626
|
|
],
|
|
[
|
|
-7.911330830307139e-06,
|
|
0.9999999927401763,
|
|
-0.0001202375069444404
|
|
],
|
|
[
|
|
-0.00018667335159430908,
|
|
0.00012023602801862844,
|
|
0.9999999753481786
|
|
]
|
|
]
|
|
},
|
|
"Base": {
|
|
"translation_m": [
|
|
0.02897408074070373,
|
|
5.735577076285363e-06,
|
|
0.016040727747518708
|
|
],
|
|
"rotation_matrix": [
|
|
[
|
|
0.9999999825452351,
|
|
7.933775773991147e-06,
|
|
0.00018667239901209626
|
|
],
|
|
[
|
|
-7.911330830307139e-06,
|
|
0.9999999927401763,
|
|
-0.0001202375069444404
|
|
],
|
|
[
|
|
-0.00018667335159430908,
|
|
0.00012023602801862844,
|
|
0.9999999753481786
|
|
]
|
|
]
|
|
},
|
|
"Arm1": {
|
|
"translation_m": [
|
|
0.1389833359264187,
|
|
0.10799945385881149,
|
|
0.06103317806053739
|
|
],
|
|
"rotation_matrix": [
|
|
[
|
|
0.9999999825452274,
|
|
2.4343781931001343e-05,
|
|
0.00018524823786546138
|
|
],
|
|
[
|
|
-7.911330830307078e-06,
|
|
0.9961034077214911,
|
|
-0.08819297626811436
|
|
],
|
|
[
|
|
-0.00018667335159430762,
|
|
0.08819297326316664,
|
|
0.9961033905273324
|
|
]
|
|
]
|
|
},
|
|
"Ellbow": {
|
|
"translation_m": [
|
|
0.13897724998093597,
|
|
-0.14102639807156128,
|
|
0.03898493474474573
|
|
],
|
|
"rotation_matrix": [
|
|
[
|
|
0.9999999825433781,
|
|
-0.0001828872718432975,
|
|
3.823316817383942e-05
|
|
],
|
|
[
|
|
-7.911330830292448e-06,
|
|
0.16299938910282458,
|
|
0.9866261698776861
|
|
],
|
|
[
|
|
-0.0001866733515939624,
|
|
-0.986626152958834,
|
|
0.16299938481082693
|
|
]
|
|
]
|
|
},
|
|
"Arm2": {
|
|
"translation_m": [
|
|
0.22897724840984,
|
|
-0.141027110091336,
|
|
0.038968134143102275
|
|
],
|
|
"rotation_matrix": [
|
|
[
|
|
0.4677998157278742,
|
|
-0.00018288727184310284,
|
|
-0.8838344296031561
|
|
],
|
|
[
|
|
0.8720281376536912,
|
|
0.16299938910265108,
|
|
0.46151720042574373
|
|
],
|
|
[
|
|
0.14398006647193082,
|
|
-0.9866261529577838,
|
|
0.07641056703326514
|
|
]
|
|
]
|
|
},
|
|
"Hand": {
|
|
"translation_m": [
|
|
0.22902297022780077,
|
|
-0.18177695736699878,
|
|
0.28562467238254824
|
|
],
|
|
"rotation_matrix": [
|
|
[
|
|
0.4677998157278742,
|
|
-0.00018288727184310284,
|
|
-0.8838344296031561
|
|
],
|
|
[
|
|
0.8720281376536912,
|
|
0.16299938910265108,
|
|
0.46151720042574373
|
|
],
|
|
[
|
|
0.14398006647193082,
|
|
-0.9866261529577838,
|
|
0.07641056703326514
|
|
]
|
|
]
|
|
},
|
|
"Palm": {
|
|
"translation_m": [
|
|
0.22902297022780077,
|
|
-0.18177695736699878,
|
|
0.28562467238254824
|
|
],
|
|
"rotation_matrix": [
|
|
[
|
|
0.4677998157278742,
|
|
-0.00018288727184310284,
|
|
-0.8838344296031561
|
|
],
|
|
[
|
|
0.8720281376536912,
|
|
0.16299938910265108,
|
|
0.46151720042574373
|
|
],
|
|
[
|
|
0.14398006647193082,
|
|
-0.9866261529577838,
|
|
0.07641056703326514
|
|
]
|
|
]
|
|
},
|
|
"FingerA": {
|
|
"translation_m": [
|
|
0.23090057054522678,
|
|
-0.1839938234349768,
|
|
0.3207325080019584
|
|
],
|
|
"rotation_matrix": [
|
|
[
|
|
0.4677998157278742,
|
|
-0.00018288727184310284,
|
|
-0.8838344296031561
|
|
],
|
|
[
|
|
0.8720281376536912,
|
|
0.16299938910265108,
|
|
0.46151720042574373
|
|
],
|
|
[
|
|
0.14398006647193082,
|
|
-0.9866261529577838,
|
|
0.07641056703326514
|
|
]
|
|
]
|
|
},
|
|
"FingerB": {
|
|
"translation_m": [
|
|
0.22715817201940378,
|
|
-0.19097004853620633,
|
|
0.31958066747018293
|
|
],
|
|
"rotation_matrix": [
|
|
[
|
|
0.4677998157278742,
|
|
-0.00018288727184310284,
|
|
-0.8838344296031561
|
|
],
|
|
[
|
|
0.8720281376536912,
|
|
0.16299938910265108,
|
|
0.46151720042574373
|
|
],
|
|
[
|
|
0.14398006647193082,
|
|
-0.9866261529577838,
|
|
0.07641056703326514
|
|
]
|
|
]
|
|
}
|
|
},
|
|
"stage_reports": [
|
|
{
|
|
"method": "deterministic_geometric_prefix",
|
|
"active_links": [
|
|
"Board",
|
|
"Base",
|
|
"Arm1"
|
|
],
|
|
"active_observations": 45,
|
|
"joint_updates": [
|
|
{
|
|
"pass": 0,
|
|
"updates": [
|
|
{
|
|
"link": "Base",
|
|
"joint_variable": "x",
|
|
"joint_type": "linear",
|
|
"old": 0.0,
|
|
"new": 0.03005780230191435,
|
|
"info": {
|
|
"reason": "weighted_projection",
|
|
"used_markers": 3,
|
|
"axis_world": [
|
|
0.9999999825442352,
|
|
-7.911330830299229e-06,
|
|
-0.0001866733515941224
|
|
],
|
|
"per_marker": [
|
|
{
|
|
"marker_id": 198,
|
|
"q_i": 0.03007599697268205,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 229,
|
|
"q_i": 0.02996354643060487,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 243,
|
|
"q_i": 0.03013386350245613,
|
|
"weight": 1.0
|
|
}
|
|
]
|
|
}
|
|
},
|
|
{
|
|
"link": "Arm1",
|
|
"joint_variable": "y",
|
|
"joint_type": "revolute",
|
|
"old": 0.0,
|
|
"new": 0.035233325052451914,
|
|
"info": {
|
|
"reason": "2d_alignment+normal_tiebreak",
|
|
"used_markers": 3,
|
|
"axis_world": [
|
|
-0.9999999825442352,
|
|
7.911330830299229e-06,
|
|
0.0001866733515941224
|
|
],
|
|
"axis_id": 0,
|
|
"theta_rad": 0.0352333250524521,
|
|
"theta_alt_rad": -3.1063593285373408,
|
|
"score_theta": 0.0009147871933339627,
|
|
"score_theta_alt": 0.8864885289918489,
|
|
"best_score": 0.0009147871933339627,
|
|
"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.03005780230191435,
|
|
"new": 0.03005780230191434,
|
|
"info": {
|
|
"reason": "weighted_projection",
|
|
"used_markers": 3,
|
|
"axis_world": [
|
|
0.9999999825442352,
|
|
-7.911330830299229e-06,
|
|
-0.0001866733515941224
|
|
],
|
|
"per_marker": [
|
|
{
|
|
"marker_id": 198,
|
|
"q_i": 0.03007599697268204,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 229,
|
|
"q_i": 0.029963546430604854,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 243,
|
|
"q_i": 0.03013386350245613,
|
|
"weight": 1.0
|
|
}
|
|
]
|
|
}
|
|
},
|
|
{
|
|
"link": "Arm1",
|
|
"joint_variable": "y",
|
|
"joint_type": "revolute",
|
|
"old": 0.035233325052451914,
|
|
"new": 0.035233325052451914,
|
|
"info": {
|
|
"reason": "2d_alignment+normal_tiebreak",
|
|
"used_markers": 3,
|
|
"axis_world": [
|
|
-0.9999999825442352,
|
|
7.911330830299229e-06,
|
|
0.0001866733515941224
|
|
],
|
|
"axis_id": 0,
|
|
"theta_rad": 0.0352333250524521,
|
|
"theta_alt_rad": -3.1063593285373408,
|
|
"score_theta": 0.0009147871933339627,
|
|
"score_theta_alt": 0.8864885289918489,
|
|
"best_score": 0.0009147871933339627,
|
|
"per_marker": [
|
|
{
|
|
"marker_id": 198,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 229,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 243,
|
|
"weight": 1.0
|
|
}
|
|
]
|
|
}
|
|
}
|
|
]
|
|
}
|
|
],
|
|
"root_link": "Board",
|
|
"root_pose": {
|
|
"reason": "kabsch",
|
|
"used_markers": [
|
|
210,
|
|
211,
|
|
215,
|
|
214,
|
|
208,
|
|
206,
|
|
205,
|
|
207,
|
|
217,
|
|
46,
|
|
47,
|
|
51,
|
|
52,
|
|
53,
|
|
54,
|
|
55,
|
|
56,
|
|
58,
|
|
60,
|
|
61,
|
|
62,
|
|
63,
|
|
64,
|
|
66,
|
|
68,
|
|
69,
|
|
72,
|
|
73,
|
|
79,
|
|
82,
|
|
83,
|
|
84,
|
|
85,
|
|
86,
|
|
92,
|
|
95,
|
|
96,
|
|
97,
|
|
101,
|
|
102,
|
|
103,
|
|
105
|
|
]
|
|
},
|
|
"marker_stats": {
|
|
"num_markers_used": 45,
|
|
"mean_error_m": 0.0013702169454727078,
|
|
"rms_error_m": 0.004367018789821951,
|
|
"median_error_m": 0.00023458082696422862,
|
|
"worst_error_m": 0.020305043665621827
|
|
},
|
|
"marker_reports": [
|
|
{
|
|
"marker_id": 46,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.00024014580635156602,
|
|
0.00019849948688827057,
|
|
-0.0001325889838793802
|
|
],
|
|
"error_norm_m": 0.00033860285475659696,
|
|
"predicted_m": [
|
|
0.5367315875661282,
|
|
0.18544692342486993,
|
|
-0.02733176064749602
|
|
],
|
|
"observed_m": [
|
|
0.5364914417597766,
|
|
0.18524842393798166,
|
|
-0.02719917166361664
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 47,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.0001356286636347015,
|
|
0.00012133053072427291,
|
|
-0.00014802679586498058
|
|
],
|
|
"error_norm_m": 0.00023458082696422862,
|
|
"predicted_m": [
|
|
0.34424784634233146,
|
|
-0.2865315503756803,
|
|
-0.02735257876128538
|
|
],
|
|
"observed_m": [
|
|
0.34438347500596617,
|
|
-0.28665288090640456,
|
|
-0.0272045519654204
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 51,
|
|
"link": "Board",
|
|
"error_m": [
|
|
6.307287002968454e-05,
|
|
-0.00014999963369966007,
|
|
0.00013641978209038771
|
|
],
|
|
"error_norm_m": 0.0002123403729614379,
|
|
"predicted_m": [
|
|
0.1678187575218507,
|
|
-0.1720701554105413,
|
|
-0.027305881766096583
|
|
],
|
|
"observed_m": [
|
|
0.167755684651821,
|
|
-0.17192015577684164,
|
|
-0.02744230154818697
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 52,
|
|
"link": "Board",
|
|
"error_m": [
|
|
5.976559091475098e-05,
|
|
-0.00019726439713532717,
|
|
5.5558001508391325e-05
|
|
],
|
|
"error_norm_m": 0.00021347566551286321,
|
|
"predicted_m": [
|
|
0.09470177950393126,
|
|
0.20867042030186375,
|
|
-0.027246453545320196
|
|
],
|
|
"observed_m": [
|
|
0.0946420139130165,
|
|
0.20886768469899908,
|
|
-0.027302011546828587
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 53,
|
|
"link": "Board",
|
|
"error_m": [
|
|
2.2465988035458295e-06,
|
|
0.00015843318946973106,
|
|
2.8051563047696432e-05
|
|
],
|
|
"error_norm_m": 0.00016091306013234192,
|
|
"predicted_m": [
|
|
0.4862718010720863,
|
|
0.21224732243606034,
|
|
-0.02731911878462367
|
|
],
|
|
"observed_m": [
|
|
0.48626955447328274,
|
|
0.2120888892465906,
|
|
-0.027347170347671368
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 54,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-9.480154294294607e-05,
|
|
1.627539552162549e-05,
|
|
-0.00012362426496341158
|
|
],
|
|
"error_norm_m": 0.00015663709628147604,
|
|
"predicted_m": [
|
|
0.34228749689371984,
|
|
-0.3305815345496766,
|
|
-0.027357509278550476
|
|
],
|
|
"observed_m": [
|
|
0.3423822984366628,
|
|
-0.3305978099451982,
|
|
-0.027233885013587065
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 55,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-1.0716649648634391e-05,
|
|
0.00011026767914773528,
|
|
-6.97715080855317e-05
|
|
],
|
|
"error_norm_m": 0.0001309269681343339,
|
|
"predicted_m": [
|
|
0.28373803749178683,
|
|
-0.26257107183499706,
|
|
-0.027338402301549082
|
|
],
|
|
"observed_m": [
|
|
0.28374875414143547,
|
|
-0.2626813395141448,
|
|
-0.02726863079346355
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 56,
|
|
"link": "Board",
|
|
"error_m": [
|
|
6.356140605623395e-05,
|
|
-2.3035154325057317e-05,
|
|
-4.765688565996212e-05
|
|
],
|
|
"error_norm_m": 8.271547270874637e-05,
|
|
"predicted_m": [
|
|
0.49870145518051306,
|
|
0.16867722441452865,
|
|
-0.02732667781812476
|
|
],
|
|
"observed_m": [
|
|
0.49863789377445683,
|
|
0.1687002595688537,
|
|
-0.027279020932464797
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 58,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.00010114347277415808,
|
|
-0.000100406862560104,
|
|
1.7625811855784268e-05
|
|
],
|
|
"error_norm_m": 0.00014360435013451362,
|
|
"predicted_m": [
|
|
0.050108394384752154,
|
|
-0.21809922383361957,
|
|
-0.027289442910250115
|
|
],
|
|
"observed_m": [
|
|
0.050007250911977996,
|
|
-0.21799881697105947,
|
|
-0.0273070687221059
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 60,
|
|
"link": "Board",
|
|
"error_m": [
|
|
2.5816559448055276e-05,
|
|
0.00010821188574633434,
|
|
-2.1284107574501276e-05
|
|
],
|
|
"error_norm_m": 0.00011326658904441165,
|
|
"predicted_m": [
|
|
0.4343823697981462,
|
|
0.28381773243543157,
|
|
-0.027300827011884146
|
|
],
|
|
"observed_m": [
|
|
0.43435655323869815,
|
|
0.28370952054968523,
|
|
-0.027279542904309645
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 61,
|
|
"link": "Board",
|
|
"error_m": [
|
|
2.213673047626874e-05,
|
|
-0.0004748026529825533,
|
|
0.00036777003104209935
|
|
],
|
|
"error_norm_m": 0.000600984517145123,
|
|
"predicted_m": [
|
|
-0.022397209513850602,
|
|
0.3358413457954722,
|
|
-0.02720930368016537
|
|
],
|
|
"observed_m": [
|
|
-0.02241934624432687,
|
|
0.33631614844845475,
|
|
-0.02757707371120747
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 62,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-5.2027625080386386e-05,
|
|
-0.00019686027029469644,
|
|
0.0001104321380561088
|
|
],
|
|
"error_norm_m": 0.00023163785724196654,
|
|
"predicted_m": [
|
|
0.4047187294268141,
|
|
-0.1750920295828903,
|
|
-0.027350467795893892
|
|
],
|
|
"observed_m": [
|
|
0.40477075705189447,
|
|
-0.1748951693125956,
|
|
-0.02746089993395
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 63,
|
|
"link": "Board",
|
|
"error_m": [
|
|
5.97205525321165e-05,
|
|
8.612992450571233e-05,
|
|
0.00017768133054744256
|
|
],
|
|
"error_norm_m": 0.00020628999858260345,
|
|
"predicted_m": [
|
|
0.7774182385644122,
|
|
-0.23614497769267853,
|
|
-0.02742738136354363
|
|
],
|
|
"observed_m": [
|
|
0.77735851801188,
|
|
-0.23623110761718424,
|
|
-0.027605062694091072
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 64,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-7.91293138496553e-05,
|
|
-0.0001473370794227158,
|
|
0.00015746330336172815
|
|
],
|
|
"error_norm_m": 0.0002297049307018039,
|
|
"predicted_m": [
|
|
-0.0212513673084557,
|
|
-0.18821865949797503,
|
|
-0.027272529247363148
|
|
],
|
|
"observed_m": [
|
|
-0.021172237994606043,
|
|
-0.18807132241855232,
|
|
-0.027429992550724876
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 66,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-9.67864364553872e-05,
|
|
0.0001370872909244869,
|
|
-1.2083618247695632e-05
|
|
],
|
|
"error_norm_m": 0.0001682455153776874,
|
|
"predicted_m": [
|
|
0.20976724024838408,
|
|
-0.3632204859031543,
|
|
-0.027336695829951723
|
|
],
|
|
"observed_m": [
|
|
0.20986402668483947,
|
|
-0.3633575731940788,
|
|
-0.027324612211704027
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 68,
|
|
"link": "Board",
|
|
"error_m": [
|
|
1.5700754685266105e-05,
|
|
0.00018632529536974363,
|
|
-3.095209368547333e-05
|
|
],
|
|
"error_norm_m": 0.00018953010709600582,
|
|
"predicted_m": [
|
|
0.5737514695000713,
|
|
0.17064663065484797,
|
|
-0.027340450788186716
|
|
],
|
|
"observed_m": [
|
|
0.573735768745386,
|
|
0.17046030535947823,
|
|
-0.027309498694501243
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 69,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-2.0034684490774328e-05,
|
|
-0.00030379998350144044,
|
|
0.0002071791909846396
|
|
],
|
|
"error_norm_m": 0.0003682648988638072,
|
|
"predicted_m": [
|
|
0.00762789450497923,
|
|
-0.28119888730219095,
|
|
-0.027289099919642363
|
|
],
|
|
"observed_m": [
|
|
0.007647929189470004,
|
|
-0.2808950873186895,
|
|
-0.027496279110627003
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 72,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.00047090395286775166,
|
|
0.00012575615412688257,
|
|
-0.00035486948541986474
|
|
],
|
|
"error_norm_m": 0.0006029075342118536,
|
|
"predicted_m": [
|
|
0.44101165968882705,
|
|
0.19432768063298977,
|
|
-0.02731282457835261
|
|
],
|
|
"observed_m": [
|
|
0.4405407557359593,
|
|
0.1942019244788629,
|
|
-0.026957955092932744
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 73,
|
|
"link": "Board",
|
|
"error_m": [
|
|
5.680208949179755e-05,
|
|
0.0004589062252717824,
|
|
-0.0004479530621591017
|
|
],
|
|
"error_norm_m": 0.0006438038108473311,
|
|
"predicted_m": [
|
|
0.22175276464469845,
|
|
0.3331194142637967,
|
|
-0.02725520702095333
|
|
],
|
|
"observed_m": [
|
|
0.22169596255520665,
|
|
0.3326605080385249,
|
|
-0.026807253958794228
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 79,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.00013968223420696146,
|
|
-0.0005000676111311941,
|
|
0.00022277023191346126
|
|
],
|
|
"error_norm_m": 0.0005649825824592162,
|
|
"predicted_m": [
|
|
0.31231885790070896,
|
|
-0.1591012986920062,
|
|
-0.02733129660411856
|
|
],
|
|
"observed_m": [
|
|
0.3124585401349159,
|
|
-0.158601231080875,
|
|
-0.02755406683603202
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 82,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-7.405616276753846e-05,
|
|
-8.325803470837778e-05,
|
|
7.280887590920687e-05
|
|
],
|
|
"error_norm_m": 0.00013310652875992175,
|
|
"predicted_m": [
|
|
0.2191824801050202,
|
|
0.29724943485632677,
|
|
-0.02725904013676476
|
|
],
|
|
"observed_m": [
|
|
0.21925653626778774,
|
|
0.29733269289103514,
|
|
-0.027331849012673968
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 83,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-4.62492650498067e-05,
|
|
-0.00012746911940025862,
|
|
0.00018718614259173594
|
|
],
|
|
"error_norm_m": 0.00023114069935149535,
|
|
"predicted_m": [
|
|
0.04418281621951103,
|
|
0.33923081903445473,
|
|
-0.02722132479177954
|
|
],
|
|
"observed_m": [
|
|
0.044229065484560834,
|
|
0.339358288153855,
|
|
-0.027408510934371275
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 84,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.00017232694873475785,
|
|
0.00011817015158627209,
|
|
-5.607158385221092e-05
|
|
],
|
|
"error_norm_m": 0.00021634413442903855,
|
|
"predicted_m": [
|
|
0.4075121688285888,
|
|
0.2584279451972179,
|
|
-0.027298863891678203
|
|
],
|
|
"observed_m": [
|
|
0.40733984187985406,
|
|
0.25830977504563163,
|
|
-0.027242792307825992
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 85,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.00020312592435511867,
|
|
-0.00015599653047260187,
|
|
0.0001347694972127153
|
|
],
|
|
"error_norm_m": 0.0002894095299805776,
|
|
"predicted_m": [
|
|
0.5045976355991969,
|
|
-0.3127428187672989,
|
|
-0.027385663219507896
|
|
],
|
|
"observed_m": [
|
|
0.5043945096748418,
|
|
-0.3125868222368263,
|
|
-0.02752043271672061
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 86,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.00035883263285391154,
|
|
-0.00015731092163612237,
|
|
0.00010075824908208422
|
|
],
|
|
"error_norm_m": 0.00040454889596310066,
|
|
"predicted_m": [
|
|
0.3629124361025995,
|
|
0.29201829779871546,
|
|
-0.02728649953201595
|
|
],
|
|
"observed_m": [
|
|
0.3632712687354534,
|
|
0.2921756087203516,
|
|
-0.027387257781098035
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 92,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.0002934523327690064,
|
|
0.0002629017827487645,
|
|
-0.00018794120863876995
|
|
],
|
|
"error_norm_m": 0.0004365243600128771,
|
|
"predicted_m": [
|
|
0.6451086479558872,
|
|
-0.18483393131699793,
|
|
-0.027396513301796547
|
|
],
|
|
"observed_m": [
|
|
0.6454021002886562,
|
|
-0.1850968330997467,
|
|
-0.027208572093157777
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 95,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.00019812064350874237,
|
|
0.00014999898375817056,
|
|
-6.225838941766731e-05
|
|
],
|
|
"error_norm_m": 0.00025617882731733316,
|
|
"predicted_m": [
|
|
0.18605794803768458,
|
|
-0.27406029897278616,
|
|
-0.02732154956052728
|
|
],
|
|
"observed_m": [
|
|
0.18585982739417584,
|
|
-0.27421029795654434,
|
|
-0.027259291171109614
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 96,
|
|
"link": "Board",
|
|
"error_m": [
|
|
8.627927498106036e-05,
|
|
9.213278406036696e-05,
|
|
-9.836286334074032e-05
|
|
],
|
|
"error_norm_m": 0.000160024423368937,
|
|
"predicted_m": [
|
|
0.3697886396708029,
|
|
-0.18648175315741503,
|
|
-0.027345316784081836
|
|
],
|
|
"observed_m": [
|
|
0.3697023603958218,
|
|
-0.1865738859414754,
|
|
-0.027246953920741095
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 97,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.00022164513432659794,
|
|
8.413999103396019e-05,
|
|
-0.00021176258327362807
|
|
],
|
|
"error_norm_m": 0.0003178828327176081,
|
|
"predicted_m": [
|
|
0.30436726684140514,
|
|
-0.35966123434089586,
|
|
-0.0273539270887528
|
|
],
|
|
"observed_m": [
|
|
0.30414562170707854,
|
|
-0.3597453743319298,
|
|
-0.027142164505479172
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 101,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-5.676935748405443e-05,
|
|
0.00011481105218846821,
|
|
-1.1951448038453188e-05
|
|
],
|
|
"error_norm_m": 0.00012863582224245074,
|
|
"predicted_m": [
|
|
0.11772249314194222,
|
|
0.29867023752964394,
|
|
-0.02723992952335222
|
|
],
|
|
"observed_m": [
|
|
0.11777926249942627,
|
|
0.2985554264774555,
|
|
-0.027227978075313766
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 102,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.00012606484361721293,
|
|
-0.00019410822228813074,
|
|
0.00036249867615404524
|
|
],
|
|
"error_norm_m": 0.00043008794097199016,
|
|
"predicted_m": [
|
|
0.6497083451227117,
|
|
-0.22299396743208486,
|
|
-0.027401960206043074
|
|
],
|
|
"observed_m": [
|
|
0.6498344099663289,
|
|
-0.22279985920979672,
|
|
-0.02776445888219712
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 103,
|
|
"link": "Board",
|
|
"error_m": [
|
|
3.75396160226249e-05,
|
|
0.00021848045899708346,
|
|
-7.526325638289658e-05
|
|
],
|
|
"error_norm_m": 0.00023410999871013627,
|
|
"predicted_m": [
|
|
0.10572863460070166,
|
|
-0.18769966408253902,
|
|
-0.027296170506814023
|
|
],
|
|
"observed_m": [
|
|
0.10569109498467903,
|
|
-0.1879181445415361,
|
|
-0.027220907250431126
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 105,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.00017913342661046716,
|
|
0.000210656851415858,
|
|
-0.0002720035290025881
|
|
],
|
|
"error_norm_m": 0.0003878801533560492,
|
|
"predicted_m": [
|
|
0.5248580041661369,
|
|
-0.26624297938844327,
|
|
-0.02738385424630833
|
|
],
|
|
"observed_m": [
|
|
0.5246788707395265,
|
|
-0.2664536362398591,
|
|
-0.027111850717305742
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 198,
|
|
"link": "Arm1",
|
|
"error_m": [
|
|
-1.6088001288744325e-05,
|
|
0.0024111437455629284,
|
|
0.011183141279931988
|
|
],
|
|
"error_norm_m": 0.011440127703503644,
|
|
"predicted_m": [
|
|
0.14010158833370714,
|
|
-0.050673225210058376,
|
|
0.10162833560725015
|
|
],
|
|
"observed_m": [
|
|
0.1401176763349959,
|
|
-0.053084368955621304,
|
|
0.09044519432731817
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 205,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-3.964650851695506e-05,
|
|
1.2098030970658646e-05,
|
|
-0.00023363467438157246
|
|
],
|
|
"error_norm_m": 0.00023728330970452892,
|
|
"predicted_m": [
|
|
0.7500245507222149,
|
|
-0.08999808053842868,
|
|
0.00019530530139471217
|
|
],
|
|
"observed_m": [
|
|
0.7500641972307318,
|
|
-0.09001017856939934,
|
|
0.0004289399757762846
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 206,
|
|
"link": "Board",
|
|
"error_m": [
|
|
5.497735281512206e-05,
|
|
-0.0003467456861196462,
|
|
7.08540774461642e-05
|
|
],
|
|
"error_norm_m": 0.0003581555255135535,
|
|
"predicted_m": [
|
|
0.6500251871697533,
|
|
-0.009997289986131553,
|
|
0.00022359151879563336
|
|
],
|
|
"observed_m": [
|
|
0.6499702098169382,
|
|
-0.009650544300011906,
|
|
0.00015273744134946916
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 207,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.000675204086429404,
|
|
-0.0004522642832782489,
|
|
0.000567904346721304
|
|
],
|
|
"error_norm_m": 0.0009914428310725258,
|
|
"predicted_m": [
|
|
0.7500251854242768,
|
|
-0.009998081119214583,
|
|
0.00020492418363620245
|
|
],
|
|
"observed_m": [
|
|
0.7507003895107062,
|
|
-0.009545816835936334,
|
|
-0.0003629801630851015
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 208,
|
|
"link": "Board",
|
|
"error_m": [
|
|
8.103369664302917e-05,
|
|
8.449754240932861e-05,
|
|
-5.784049800828736e-05
|
|
],
|
|
"error_norm_m": 0.00013058260938845362,
|
|
"predicted_m": [
|
|
0.3500245577041208,
|
|
-0.08999491600609656,
|
|
0.0002699746420324358
|
|
],
|
|
"observed_m": [
|
|
0.34994352400747775,
|
|
-0.09007941354850589,
|
|
0.0003278151400407232
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 210,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-4.0705434832904314e-05,
|
|
0.0002875021340621245,
|
|
-0.00011130962817117374
|
|
],
|
|
"error_norm_m": 0.0003109730580594026,
|
|
"predicted_m": [
|
|
0.02002511882849735,
|
|
-0.01999230577511022,
|
|
0.00033999337001986183
|
|
],
|
|
"observed_m": [
|
|
0.020065824263330253,
|
|
-0.020279807909172345,
|
|
0.0004513029981910356
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 211,
|
|
"link": "Board",
|
|
"error_m": [
|
|
1.33701774804873e-05,
|
|
9.383654401974931e-05,
|
|
-1.0346849726384035e-05
|
|
],
|
|
"error_norm_m": 9.534734363730566e-05,
|
|
"predicted_m": [
|
|
0.25002519415165914,
|
|
-0.00999412545379943,
|
|
0.000298260859433357
|
|
],
|
|
"observed_m": [
|
|
0.25001182397417865,
|
|
-0.01008796199781918,
|
|
0.00030860770915974104
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 214,
|
|
"link": "Board",
|
|
"error_m": [
|
|
3.487801149665293e-05,
|
|
0.00044274628708106806,
|
|
-0.00029472423741045946
|
|
],
|
|
"error_norm_m": 0.0005330132517369611,
|
|
"predicted_m": [
|
|
0.3500251924061827,
|
|
-0.00999491658688246,
|
|
0.0002795935242739261
|
|
],
|
|
"observed_m": [
|
|
0.34999031439468603,
|
|
-0.010437662873963529,
|
|
0.0005743177616843856
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 215,
|
|
"link": "Board",
|
|
"error_m": [
|
|
5.814383252331079e-05,
|
|
3.1566079447112316e-05,
|
|
-8.698037465849884e-06
|
|
],
|
|
"error_norm_m": 6.672914271828725e-05,
|
|
"predicted_m": [
|
|
0.25002455944959723,
|
|
-0.08999412487301353,
|
|
0.0002886419771918667
|
|
],
|
|
"observed_m": [
|
|
0.24996641561707392,
|
|
-0.09002569095246064,
|
|
0.0002973400146577166
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 217,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.00018180264930645063,
|
|
-0.0003000352885192542,
|
|
0.00010324834312563732
|
|
],
|
|
"error_norm_m": 0.000365696045931407,
|
|
"predicted_m": [
|
|
0.6500245524676914,
|
|
-0.08999728940534565,
|
|
0.00021397263655414307
|
|
],
|
|
"observed_m": [
|
|
0.6502063551169979,
|
|
-0.0896972541168264,
|
|
0.00011072429342850576
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 229,
|
|
"link": "Arm1",
|
|
"error_m": [
|
|
9.752888367287049e-05,
|
|
0.002500000767718197,
|
|
0.017427406537361564
|
|
],
|
|
"error_norm_m": 0.017606078903044102,
|
|
"predicted_m": [
|
|
0.14010146655261663,
|
|
-0.14061774910617264,
|
|
0.10478786422501525
|
|
],
|
|
"observed_m": [
|
|
0.14000393766894376,
|
|
-0.14311774987389084,
|
|
0.08736045768765369
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 243,
|
|
"link": "Arm1",
|
|
"error_m": [
|
|
-7.226925354825164e-05,
|
|
0.00022747565451403107,
|
|
0.02030364081253419
|
|
],
|
|
"error_norm_m": 0.020305043665621827,
|
|
"predicted_m": [
|
|
0.14009487993259997,
|
|
-0.17682488060906051,
|
|
0.07103814444915608
|
|
],
|
|
"observed_m": [
|
|
0.14016714918614823,
|
|
-0.17705235626357455,
|
|
0.050734503636621894
|
|
]
|
|
}
|
|
],
|
|
"stage_idx": 0,
|
|
"num_active_links": 3
|
|
},
|
|
{
|
|
"method": "deterministic_geometric_prefix",
|
|
"active_links": [
|
|
"Board",
|
|
"Base",
|
|
"Arm1",
|
|
"Ellbow"
|
|
],
|
|
"active_observations": 49,
|
|
"joint_updates": [
|
|
{
|
|
"pass": 0,
|
|
"updates": [
|
|
{
|
|
"link": "Base",
|
|
"joint_variable": "x",
|
|
"joint_type": "linear",
|
|
"old": 0.03005780230191434,
|
|
"new": 0.03008008223991194,
|
|
"info": {
|
|
"reason": "weighted_projection",
|
|
"used_markers": 7,
|
|
"axis_world": [
|
|
0.9999999825442352,
|
|
-7.911330830299229e-06,
|
|
-0.0001866733515941224
|
|
],
|
|
"per_marker": [
|
|
{
|
|
"marker_id": 198,
|
|
"q_i": 0.03007599697268204,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 229,
|
|
"q_i": 0.029963546430604854,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 243,
|
|
"q_i": 0.03013386350245613,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 244,
|
|
"q_i": 0.03052059692573975,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 245,
|
|
"q_i": 0.029952785895270544,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 248,
|
|
"q_i": 0.03004782901698107,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 232,
|
|
"q_i": 0.029865956935649182,
|
|
"weight": 1.0
|
|
}
|
|
]
|
|
}
|
|
},
|
|
{
|
|
"link": "Arm1",
|
|
"joint_variable": "y",
|
|
"joint_type": "revolute",
|
|
"old": 0.035233325052451914,
|
|
"new": -0.01709056164052214,
|
|
"info": {
|
|
"reason": "2d_alignment+normal_tiebreak",
|
|
"used_markers": 7,
|
|
"axis_world": [
|
|
-0.9999999825442352,
|
|
7.911330830299229e-06,
|
|
0.0001866733515941224
|
|
],
|
|
"axis_id": 0,
|
|
"theta_rad": -0.017090561640522268,
|
|
"theta_alt_rad": 3.124502091949271,
|
|
"score_theta": 0.007377603144415212,
|
|
"score_theta_alt": 1.9681402101890386,
|
|
"best_score": 0.007377603144415212,
|
|
"per_marker": [
|
|
{
|
|
"marker_id": 198,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 229,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 243,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 244,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 245,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 248,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 232,
|
|
"weight": 1.0
|
|
}
|
|
]
|
|
}
|
|
},
|
|
{
|
|
"link": "Ellbow",
|
|
"joint_variable": "z",
|
|
"joint_type": "revolute",
|
|
"old": 0.0,
|
|
"new": 1.6206480172155189,
|
|
"info": {
|
|
"reason": "2d_alignment+normal_tiebreak",
|
|
"used_markers": 3,
|
|
"axis_world": [
|
|
-0.9999999825442352,
|
|
7.911330830299227e-06,
|
|
0.0001866733515941224
|
|
],
|
|
"axis_id": 0,
|
|
"theta_rad": -1.5209446363742747,
|
|
"theta_alt_rad": 1.6206480172155189,
|
|
"score_theta": 0.19621666885710629,
|
|
"score_theta_alt": 0.11915769622974923,
|
|
"best_score": 0.11915769622974923,
|
|
"per_marker": [
|
|
{
|
|
"marker_id": 245,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 248,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 232,
|
|
"weight": 1.0
|
|
}
|
|
]
|
|
}
|
|
}
|
|
]
|
|
},
|
|
{
|
|
"pass": 1,
|
|
"updates": [
|
|
{
|
|
"link": "Base",
|
|
"joint_variable": "x",
|
|
"joint_type": "linear",
|
|
"old": 0.03008008223991194,
|
|
"new": 0.03008008224001913,
|
|
"info": {
|
|
"reason": "weighted_projection",
|
|
"used_markers": 7,
|
|
"axis_world": [
|
|
0.9999999825442352,
|
|
-7.911330830299229e-06,
|
|
-0.0001866733515941224
|
|
],
|
|
"per_marker": [
|
|
{
|
|
"marker_id": 198,
|
|
"q_i": 0.030075996972682033,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 229,
|
|
"q_i": 0.029963546430604848,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 243,
|
|
"q_i": 0.030133863502456143,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 244,
|
|
"q_i": 0.0305205969260021,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 245,
|
|
"q_i": 0.029952785895459435,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 248,
|
|
"q_i": 0.030047829017091274,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 232,
|
|
"q_i": 0.02986595693583809,
|
|
"weight": 1.0
|
|
}
|
|
]
|
|
}
|
|
},
|
|
{
|
|
"link": "Arm1",
|
|
"joint_variable": "y",
|
|
"joint_type": "revolute",
|
|
"old": -0.01709056164052214,
|
|
"new": 0.03362140443012329,
|
|
"info": {
|
|
"reason": "2d_alignment+normal_tiebreak",
|
|
"used_markers": 7,
|
|
"axis_world": [
|
|
-0.9999999825442352,
|
|
7.911330830299229e-06,
|
|
0.0001866733515941224
|
|
],
|
|
"axis_id": 0,
|
|
"theta_rad": 0.033621404430123514,
|
|
"theta_alt_rad": -3.10797124915967,
|
|
"score_theta": 0.002202747189759713,
|
|
"score_theta_alt": 2.0939306729503113,
|
|
"best_score": 0.002202747189759713,
|
|
"per_marker": [
|
|
{
|
|
"marker_id": 198,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 229,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 243,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 244,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 245,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 248,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 232,
|
|
"weight": 1.0
|
|
}
|
|
]
|
|
}
|
|
},
|
|
{
|
|
"link": "Ellbow",
|
|
"joint_variable": "z",
|
|
"joint_type": "revolute",
|
|
"old": 1.6206480172155189,
|
|
"new": -1.199306941308583,
|
|
"info": {
|
|
"reason": "2d_alignment+normal_tiebreak",
|
|
"used_markers": 3,
|
|
"axis_world": [
|
|
-0.9999999825442352,
|
|
7.911330830299229e-06,
|
|
0.00018667335159412238
|
|
],
|
|
"axis_id": 0,
|
|
"theta_rad": -1.199306941308583,
|
|
"theta_alt_rad": 1.94228571228121,
|
|
"score_theta": 0.1449652535403994,
|
|
"score_theta_alt": 0.17371317628502098,
|
|
"best_score": 0.1449652535403994,
|
|
"per_marker": [
|
|
{
|
|
"marker_id": 245,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 248,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 232,
|
|
"weight": 1.0
|
|
}
|
|
]
|
|
}
|
|
}
|
|
]
|
|
}
|
|
],
|
|
"root_link": "Board",
|
|
"root_pose": {
|
|
"reason": "kabsch",
|
|
"used_markers": [
|
|
210,
|
|
211,
|
|
215,
|
|
214,
|
|
208,
|
|
206,
|
|
205,
|
|
207,
|
|
217,
|
|
46,
|
|
47,
|
|
51,
|
|
52,
|
|
53,
|
|
54,
|
|
55,
|
|
56,
|
|
58,
|
|
60,
|
|
61,
|
|
62,
|
|
63,
|
|
64,
|
|
66,
|
|
68,
|
|
69,
|
|
72,
|
|
73,
|
|
79,
|
|
82,
|
|
83,
|
|
84,
|
|
85,
|
|
86,
|
|
92,
|
|
95,
|
|
96,
|
|
97,
|
|
101,
|
|
102,
|
|
103,
|
|
105
|
|
]
|
|
},
|
|
"marker_stats": {
|
|
"num_markers_used": 49,
|
|
"mean_error_m": 0.0059748628308253894,
|
|
"rms_error_m": 0.018417460752568476,
|
|
"median_error_m": 0.00025617882731733316,
|
|
"worst_error_m": 0.08008046701372831
|
|
},
|
|
"marker_reports": [
|
|
{
|
|
"marker_id": 46,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.00024014580635156602,
|
|
0.00019849948688827057,
|
|
-0.0001325889838793802
|
|
],
|
|
"error_norm_m": 0.00033860285475659696,
|
|
"predicted_m": [
|
|
0.5367315875661282,
|
|
0.18544692342486993,
|
|
-0.02733176064749602
|
|
],
|
|
"observed_m": [
|
|
0.5364914417597766,
|
|
0.18524842393798166,
|
|
-0.02719917166361664
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 47,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.0001356286636347015,
|
|
0.00012133053072427291,
|
|
-0.00014802679586498058
|
|
],
|
|
"error_norm_m": 0.00023458082696422862,
|
|
"predicted_m": [
|
|
0.34424784634233146,
|
|
-0.2865315503756803,
|
|
-0.02735257876128538
|
|
],
|
|
"observed_m": [
|
|
0.34438347500596617,
|
|
-0.28665288090640456,
|
|
-0.0272045519654204
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 51,
|
|
"link": "Board",
|
|
"error_m": [
|
|
6.307287002968454e-05,
|
|
-0.00014999963369966007,
|
|
0.00013641978209038771
|
|
],
|
|
"error_norm_m": 0.0002123403729614379,
|
|
"predicted_m": [
|
|
0.1678187575218507,
|
|
-0.1720701554105413,
|
|
-0.027305881766096583
|
|
],
|
|
"observed_m": [
|
|
0.167755684651821,
|
|
-0.17192015577684164,
|
|
-0.02744230154818697
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 52,
|
|
"link": "Board",
|
|
"error_m": [
|
|
5.976559091475098e-05,
|
|
-0.00019726439713532717,
|
|
5.5558001508391325e-05
|
|
],
|
|
"error_norm_m": 0.00021347566551286321,
|
|
"predicted_m": [
|
|
0.09470177950393126,
|
|
0.20867042030186375,
|
|
-0.027246453545320196
|
|
],
|
|
"observed_m": [
|
|
0.0946420139130165,
|
|
0.20886768469899908,
|
|
-0.027302011546828587
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 53,
|
|
"link": "Board",
|
|
"error_m": [
|
|
2.2465988035458295e-06,
|
|
0.00015843318946973106,
|
|
2.8051563047696432e-05
|
|
],
|
|
"error_norm_m": 0.00016091306013234192,
|
|
"predicted_m": [
|
|
0.4862718010720863,
|
|
0.21224732243606034,
|
|
-0.02731911878462367
|
|
],
|
|
"observed_m": [
|
|
0.48626955447328274,
|
|
0.2120888892465906,
|
|
-0.027347170347671368
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 54,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-9.480154294294607e-05,
|
|
1.627539552162549e-05,
|
|
-0.00012362426496341158
|
|
],
|
|
"error_norm_m": 0.00015663709628147604,
|
|
"predicted_m": [
|
|
0.34228749689371984,
|
|
-0.3305815345496766,
|
|
-0.027357509278550476
|
|
],
|
|
"observed_m": [
|
|
0.3423822984366628,
|
|
-0.3305978099451982,
|
|
-0.027233885013587065
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 55,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-1.0716649648634391e-05,
|
|
0.00011026767914773528,
|
|
-6.97715080855317e-05
|
|
],
|
|
"error_norm_m": 0.0001309269681343339,
|
|
"predicted_m": [
|
|
0.28373803749178683,
|
|
-0.26257107183499706,
|
|
-0.027338402301549082
|
|
],
|
|
"observed_m": [
|
|
0.28374875414143547,
|
|
-0.2626813395141448,
|
|
-0.02726863079346355
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 56,
|
|
"link": "Board",
|
|
"error_m": [
|
|
6.356140605623395e-05,
|
|
-2.3035154325057317e-05,
|
|
-4.765688565996212e-05
|
|
],
|
|
"error_norm_m": 8.271547270874637e-05,
|
|
"predicted_m": [
|
|
0.49870145518051306,
|
|
0.16867722441452865,
|
|
-0.02732667781812476
|
|
],
|
|
"observed_m": [
|
|
0.49863789377445683,
|
|
0.1687002595688537,
|
|
-0.027279020932464797
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 58,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.00010114347277415808,
|
|
-0.000100406862560104,
|
|
1.7625811855784268e-05
|
|
],
|
|
"error_norm_m": 0.00014360435013451362,
|
|
"predicted_m": [
|
|
0.050108394384752154,
|
|
-0.21809922383361957,
|
|
-0.027289442910250115
|
|
],
|
|
"observed_m": [
|
|
0.050007250911977996,
|
|
-0.21799881697105947,
|
|
-0.0273070687221059
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 60,
|
|
"link": "Board",
|
|
"error_m": [
|
|
2.5816559448055276e-05,
|
|
0.00010821188574633434,
|
|
-2.1284107574501276e-05
|
|
],
|
|
"error_norm_m": 0.00011326658904441165,
|
|
"predicted_m": [
|
|
0.4343823697981462,
|
|
0.28381773243543157,
|
|
-0.027300827011884146
|
|
],
|
|
"observed_m": [
|
|
0.43435655323869815,
|
|
0.28370952054968523,
|
|
-0.027279542904309645
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 61,
|
|
"link": "Board",
|
|
"error_m": [
|
|
2.213673047626874e-05,
|
|
-0.0004748026529825533,
|
|
0.00036777003104209935
|
|
],
|
|
"error_norm_m": 0.000600984517145123,
|
|
"predicted_m": [
|
|
-0.022397209513850602,
|
|
0.3358413457954722,
|
|
-0.02720930368016537
|
|
],
|
|
"observed_m": [
|
|
-0.02241934624432687,
|
|
0.33631614844845475,
|
|
-0.02757707371120747
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 62,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-5.2027625080386386e-05,
|
|
-0.00019686027029469644,
|
|
0.0001104321380561088
|
|
],
|
|
"error_norm_m": 0.00023163785724196654,
|
|
"predicted_m": [
|
|
0.4047187294268141,
|
|
-0.1750920295828903,
|
|
-0.027350467795893892
|
|
],
|
|
"observed_m": [
|
|
0.40477075705189447,
|
|
-0.1748951693125956,
|
|
-0.02746089993395
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 63,
|
|
"link": "Board",
|
|
"error_m": [
|
|
5.97205525321165e-05,
|
|
8.612992450571233e-05,
|
|
0.00017768133054744256
|
|
],
|
|
"error_norm_m": 0.00020628999858260345,
|
|
"predicted_m": [
|
|
0.7774182385644122,
|
|
-0.23614497769267853,
|
|
-0.02742738136354363
|
|
],
|
|
"observed_m": [
|
|
0.77735851801188,
|
|
-0.23623110761718424,
|
|
-0.027605062694091072
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 64,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-7.91293138496553e-05,
|
|
-0.0001473370794227158,
|
|
0.00015746330336172815
|
|
],
|
|
"error_norm_m": 0.0002297049307018039,
|
|
"predicted_m": [
|
|
-0.0212513673084557,
|
|
-0.18821865949797503,
|
|
-0.027272529247363148
|
|
],
|
|
"observed_m": [
|
|
-0.021172237994606043,
|
|
-0.18807132241855232,
|
|
-0.027429992550724876
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 66,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-9.67864364553872e-05,
|
|
0.0001370872909244869,
|
|
-1.2083618247695632e-05
|
|
],
|
|
"error_norm_m": 0.0001682455153776874,
|
|
"predicted_m": [
|
|
0.20976724024838408,
|
|
-0.3632204859031543,
|
|
-0.027336695829951723
|
|
],
|
|
"observed_m": [
|
|
0.20986402668483947,
|
|
-0.3633575731940788,
|
|
-0.027324612211704027
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 68,
|
|
"link": "Board",
|
|
"error_m": [
|
|
1.5700754685266105e-05,
|
|
0.00018632529536974363,
|
|
-3.095209368547333e-05
|
|
],
|
|
"error_norm_m": 0.00018953010709600582,
|
|
"predicted_m": [
|
|
0.5737514695000713,
|
|
0.17064663065484797,
|
|
-0.027340450788186716
|
|
],
|
|
"observed_m": [
|
|
0.573735768745386,
|
|
0.17046030535947823,
|
|
-0.027309498694501243
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 69,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-2.0034684490774328e-05,
|
|
-0.00030379998350144044,
|
|
0.0002071791909846396
|
|
],
|
|
"error_norm_m": 0.0003682648988638072,
|
|
"predicted_m": [
|
|
0.00762789450497923,
|
|
-0.28119888730219095,
|
|
-0.027289099919642363
|
|
],
|
|
"observed_m": [
|
|
0.007647929189470004,
|
|
-0.2808950873186895,
|
|
-0.027496279110627003
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 72,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.00047090395286775166,
|
|
0.00012575615412688257,
|
|
-0.00035486948541986474
|
|
],
|
|
"error_norm_m": 0.0006029075342118536,
|
|
"predicted_m": [
|
|
0.44101165968882705,
|
|
0.19432768063298977,
|
|
-0.02731282457835261
|
|
],
|
|
"observed_m": [
|
|
0.4405407557359593,
|
|
0.1942019244788629,
|
|
-0.026957955092932744
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 73,
|
|
"link": "Board",
|
|
"error_m": [
|
|
5.680208949179755e-05,
|
|
0.0004589062252717824,
|
|
-0.0004479530621591017
|
|
],
|
|
"error_norm_m": 0.0006438038108473311,
|
|
"predicted_m": [
|
|
0.22175276464469845,
|
|
0.3331194142637967,
|
|
-0.02725520702095333
|
|
],
|
|
"observed_m": [
|
|
0.22169596255520665,
|
|
0.3326605080385249,
|
|
-0.026807253958794228
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 79,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.00013968223420696146,
|
|
-0.0005000676111311941,
|
|
0.00022277023191346126
|
|
],
|
|
"error_norm_m": 0.0005649825824592162,
|
|
"predicted_m": [
|
|
0.31231885790070896,
|
|
-0.1591012986920062,
|
|
-0.02733129660411856
|
|
],
|
|
"observed_m": [
|
|
0.3124585401349159,
|
|
-0.158601231080875,
|
|
-0.02755406683603202
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 82,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-7.405616276753846e-05,
|
|
-8.325803470837778e-05,
|
|
7.280887590920687e-05
|
|
],
|
|
"error_norm_m": 0.00013310652875992175,
|
|
"predicted_m": [
|
|
0.2191824801050202,
|
|
0.29724943485632677,
|
|
-0.02725904013676476
|
|
],
|
|
"observed_m": [
|
|
0.21925653626778774,
|
|
0.29733269289103514,
|
|
-0.027331849012673968
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 83,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-4.62492650498067e-05,
|
|
-0.00012746911940025862,
|
|
0.00018718614259173594
|
|
],
|
|
"error_norm_m": 0.00023114069935149535,
|
|
"predicted_m": [
|
|
0.04418281621951103,
|
|
0.33923081903445473,
|
|
-0.02722132479177954
|
|
],
|
|
"observed_m": [
|
|
0.044229065484560834,
|
|
0.339358288153855,
|
|
-0.027408510934371275
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 84,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.00017232694873475785,
|
|
0.00011817015158627209,
|
|
-5.607158385221092e-05
|
|
],
|
|
"error_norm_m": 0.00021634413442903855,
|
|
"predicted_m": [
|
|
0.4075121688285888,
|
|
0.2584279451972179,
|
|
-0.027298863891678203
|
|
],
|
|
"observed_m": [
|
|
0.40733984187985406,
|
|
0.25830977504563163,
|
|
-0.027242792307825992
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 85,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.00020312592435511867,
|
|
-0.00015599653047260187,
|
|
0.0001347694972127153
|
|
],
|
|
"error_norm_m": 0.0002894095299805776,
|
|
"predicted_m": [
|
|
0.5045976355991969,
|
|
-0.3127428187672989,
|
|
-0.027385663219507896
|
|
],
|
|
"observed_m": [
|
|
0.5043945096748418,
|
|
-0.3125868222368263,
|
|
-0.02752043271672061
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 86,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.00035883263285391154,
|
|
-0.00015731092163612237,
|
|
0.00010075824908208422
|
|
],
|
|
"error_norm_m": 0.00040454889596310066,
|
|
"predicted_m": [
|
|
0.3629124361025995,
|
|
0.29201829779871546,
|
|
-0.02728649953201595
|
|
],
|
|
"observed_m": [
|
|
0.3632712687354534,
|
|
0.2921756087203516,
|
|
-0.027387257781098035
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 92,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.0002934523327690064,
|
|
0.0002629017827487645,
|
|
-0.00018794120863876995
|
|
],
|
|
"error_norm_m": 0.0004365243600128771,
|
|
"predicted_m": [
|
|
0.6451086479558872,
|
|
-0.18483393131699793,
|
|
-0.027396513301796547
|
|
],
|
|
"observed_m": [
|
|
0.6454021002886562,
|
|
-0.1850968330997467,
|
|
-0.027208572093157777
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 95,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.00019812064350874237,
|
|
0.00014999898375817056,
|
|
-6.225838941766731e-05
|
|
],
|
|
"error_norm_m": 0.00025617882731733316,
|
|
"predicted_m": [
|
|
0.18605794803768458,
|
|
-0.27406029897278616,
|
|
-0.02732154956052728
|
|
],
|
|
"observed_m": [
|
|
0.18585982739417584,
|
|
-0.27421029795654434,
|
|
-0.027259291171109614
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 96,
|
|
"link": "Board",
|
|
"error_m": [
|
|
8.627927498106036e-05,
|
|
9.213278406036696e-05,
|
|
-9.836286334074032e-05
|
|
],
|
|
"error_norm_m": 0.000160024423368937,
|
|
"predicted_m": [
|
|
0.3697886396708029,
|
|
-0.18648175315741503,
|
|
-0.027345316784081836
|
|
],
|
|
"observed_m": [
|
|
0.3697023603958218,
|
|
-0.1865738859414754,
|
|
-0.027246953920741095
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 97,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.00022164513432659794,
|
|
8.413999103396019e-05,
|
|
-0.00021176258327362807
|
|
],
|
|
"error_norm_m": 0.0003178828327176081,
|
|
"predicted_m": [
|
|
0.30436726684140514,
|
|
-0.35966123434089586,
|
|
-0.0273539270887528
|
|
],
|
|
"observed_m": [
|
|
0.30414562170707854,
|
|
-0.3597453743319298,
|
|
-0.027142164505479172
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 101,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-5.676935748405443e-05,
|
|
0.00011481105218846821,
|
|
-1.1951448038453188e-05
|
|
],
|
|
"error_norm_m": 0.00012863582224245074,
|
|
"predicted_m": [
|
|
0.11772249314194222,
|
|
0.29867023752964394,
|
|
-0.02723992952335222
|
|
],
|
|
"observed_m": [
|
|
0.11777926249942627,
|
|
0.2985554264774555,
|
|
-0.027227978075313766
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 102,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.00012606484361721293,
|
|
-0.00019410822228813074,
|
|
0.00036249867615404524
|
|
],
|
|
"error_norm_m": 0.00043008794097199016,
|
|
"predicted_m": [
|
|
0.6497083451227117,
|
|
-0.22299396743208486,
|
|
-0.027401960206043074
|
|
],
|
|
"observed_m": [
|
|
0.6498344099663289,
|
|
-0.22279985920979672,
|
|
-0.02776445888219712
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 103,
|
|
"link": "Board",
|
|
"error_m": [
|
|
3.75396160226249e-05,
|
|
0.00021848045899708346,
|
|
-7.526325638289658e-05
|
|
],
|
|
"error_norm_m": 0.00023410999871013627,
|
|
"predicted_m": [
|
|
0.10572863460070166,
|
|
-0.18769966408253902,
|
|
-0.027296170506814023
|
|
],
|
|
"observed_m": [
|
|
0.10569109498467903,
|
|
-0.1879181445415361,
|
|
-0.027220907250431126
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 105,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.00017913342661046716,
|
|
0.000210656851415858,
|
|
-0.0002720035290025881
|
|
],
|
|
"error_norm_m": 0.0003878801533560492,
|
|
"predicted_m": [
|
|
0.5248580041661369,
|
|
-0.26624297938844327,
|
|
-0.02738385424630833
|
|
],
|
|
"observed_m": [
|
|
0.5246788707395265,
|
|
-0.2664536362398591,
|
|
-0.027111850717305742
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 198,
|
|
"link": "Arm1",
|
|
"error_m": [
|
|
6.1436655210134195e-06,
|
|
0.0023459132292872747,
|
|
0.010927316747539328
|
|
],
|
|
"error_norm_m": 0.011176296252561694,
|
|
"predicted_m": [
|
|
0.1401238200005169,
|
|
-0.05073845572633403,
|
|
0.1013725110748575
|
|
],
|
|
"observed_m": [
|
|
0.1401176763349959,
|
|
-0.053084368955621304,
|
|
0.09044519432731817
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 205,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-3.964650851695506e-05,
|
|
1.2098030970658646e-05,
|
|
-0.00023363467438157246
|
|
],
|
|
"error_norm_m": 0.00023728330970452892,
|
|
"predicted_m": [
|
|
0.7500245507222149,
|
|
-0.08999808053842868,
|
|
0.00019530530139471217
|
|
],
|
|
"observed_m": [
|
|
0.7500641972307318,
|
|
-0.09001017856939934,
|
|
0.0004289399757762846
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 206,
|
|
"link": "Board",
|
|
"error_m": [
|
|
5.497735281512206e-05,
|
|
-0.0003467456861196462,
|
|
7.08540774461642e-05
|
|
],
|
|
"error_norm_m": 0.0003581555255135535,
|
|
"predicted_m": [
|
|
0.6500251871697533,
|
|
-0.009997289986131553,
|
|
0.00022359151879563336
|
|
],
|
|
"observed_m": [
|
|
0.6499702098169382,
|
|
-0.009650544300011906,
|
|
0.00015273744134946916
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 207,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.000675204086429404,
|
|
-0.0004522642832782489,
|
|
0.000567904346721304
|
|
],
|
|
"error_norm_m": 0.0009914428310725258,
|
|
"predicted_m": [
|
|
0.7500251854242768,
|
|
-0.009998081119214583,
|
|
0.00020492418363620245
|
|
],
|
|
"observed_m": [
|
|
0.7507003895107062,
|
|
-0.009545816835936334,
|
|
-0.0003629801630851015
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 208,
|
|
"link": "Board",
|
|
"error_m": [
|
|
8.103369664302917e-05,
|
|
8.449754240932861e-05,
|
|
-5.784049800828736e-05
|
|
],
|
|
"error_norm_m": 0.00013058260938845362,
|
|
"predicted_m": [
|
|
0.3500245577041208,
|
|
-0.08999491600609656,
|
|
0.0002699746420324358
|
|
],
|
|
"observed_m": [
|
|
0.34994352400747775,
|
|
-0.09007941354850589,
|
|
0.0003278151400407232
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 210,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-4.0705434832904314e-05,
|
|
0.0002875021340621245,
|
|
-0.00011130962817117374
|
|
],
|
|
"error_norm_m": 0.0003109730580594026,
|
|
"predicted_m": [
|
|
0.02002511882849735,
|
|
-0.01999230577511022,
|
|
0.00033999337001986183
|
|
],
|
|
"observed_m": [
|
|
0.020065824263330253,
|
|
-0.020279807909172345,
|
|
0.0004513029981910356
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 211,
|
|
"link": "Board",
|
|
"error_m": [
|
|
1.33701774804873e-05,
|
|
9.383654401974931e-05,
|
|
-1.0346849726384035e-05
|
|
],
|
|
"error_norm_m": 9.534734363730566e-05,
|
|
"predicted_m": [
|
|
0.25002519415165914,
|
|
-0.00999412545379943,
|
|
0.000298260859433357
|
|
],
|
|
"observed_m": [
|
|
0.25001182397417865,
|
|
-0.01008796199781918,
|
|
0.00030860770915974104
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 214,
|
|
"link": "Board",
|
|
"error_m": [
|
|
3.487801149665293e-05,
|
|
0.00044274628708106806,
|
|
-0.00029472423741045946
|
|
],
|
|
"error_norm_m": 0.0005330132517369611,
|
|
"predicted_m": [
|
|
0.3500251924061827,
|
|
-0.00999491658688246,
|
|
0.0002795935242739261
|
|
],
|
|
"observed_m": [
|
|
0.34999031439468603,
|
|
-0.010437662873963529,
|
|
0.0005743177616843856
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 215,
|
|
"link": "Board",
|
|
"error_m": [
|
|
5.814383252331079e-05,
|
|
3.1566079447112316e-05,
|
|
-8.698037465849884e-06
|
|
],
|
|
"error_norm_m": 6.672914271828725e-05,
|
|
"predicted_m": [
|
|
0.25002455944959723,
|
|
-0.08999412487301353,
|
|
0.0002886419771918667
|
|
],
|
|
"observed_m": [
|
|
0.24996641561707392,
|
|
-0.09002569095246064,
|
|
0.0002973400146577166
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 217,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.00018180264930645063,
|
|
-0.0003000352885192542,
|
|
0.00010324834312563732
|
|
],
|
|
"error_norm_m": 0.000365696045931407,
|
|
"predicted_m": [
|
|
0.6500245524676914,
|
|
-0.08999728940534565,
|
|
0.00021397263655414307
|
|
],
|
|
"observed_m": [
|
|
0.6502063551169979,
|
|
-0.0896972541168264,
|
|
0.00011072429342850576
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 229,
|
|
"link": "Arm1",
|
|
"error_m": [
|
|
0.00011973344581753254,
|
|
0.002429794195305174,
|
|
0.017026594532667333
|
|
],
|
|
"error_norm_m": 0.017199510379933586,
|
|
"predicted_m": [
|
|
0.1401236711147613,
|
|
-0.14068795567858566,
|
|
0.10438705222032102
|
|
],
|
|
"observed_m": [
|
|
0.14000393766894376,
|
|
-0.14311774987389084,
|
|
0.08736045768765369
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 232,
|
|
"link": "Ellbow",
|
|
"error_m": [
|
|
0.00022468242480011558,
|
|
0.05908853866903127,
|
|
0.05404974849990712
|
|
],
|
|
"error_norm_m": 0.08008046701372831,
|
|
"predicted_m": [
|
|
0.2301198135137316,
|
|
-0.10936136335631019,
|
|
0.08238601791621822
|
|
],
|
|
"observed_m": [
|
|
0.22989513108893148,
|
|
-0.16844990202534146,
|
|
0.0283362694163111
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 243,
|
|
"link": "Arm1",
|
|
"error_m": [
|
|
-5.007514727181639e-05,
|
|
0.0002117179671483338,
|
|
0.01984450965784186
|
|
],
|
|
"error_norm_m": 0.019845702194131773,
|
|
"predicted_m": [
|
|
0.1401170740388764,
|
|
-0.1768406382964262,
|
|
0.07057901329446375
|
|
],
|
|
"observed_m": [
|
|
0.14016714918614823,
|
|
-0.17705235626357455,
|
|
0.050734503636621894
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 244,
|
|
"link": "Ellbow",
|
|
"error_m": [
|
|
-0.0004372769586900027,
|
|
0.00023078772903964428,
|
|
0.017334606237668637
|
|
],
|
|
"error_norm_m": 0.017341656424041417,
|
|
"predicted_m": [
|
|
0.2651171297568875,
|
|
-0.1418612661202376,
|
|
0.06938335756894534
|
|
],
|
|
"observed_m": [
|
|
0.2655544067155775,
|
|
-0.14209205384927726,
|
|
0.052048751331276705
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 245,
|
|
"link": "Ellbow",
|
|
"error_m": [
|
|
0.00012818021745081287,
|
|
0.06734168035893326,
|
|
0.0018808701110254386
|
|
],
|
|
"error_norm_m": 0.06736806376991573,
|
|
"predicted_m": [
|
|
0.23011481057382716,
|
|
-0.10969227503685039,
|
|
0.05559953863227672
|
|
],
|
|
"observed_m": [
|
|
0.22998663035637634,
|
|
-0.17703395539578365,
|
|
0.05371866852125128
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 248,
|
|
"link": "Ellbow",
|
|
"error_m": [
|
|
3.3136616425732957e-05,
|
|
0.06742199808704592,
|
|
0.0018749071636034592
|
|
],
|
|
"error_norm_m": 0.06744807040202933,
|
|
"predicted_m": [
|
|
0.19261481122842866,
|
|
-0.10969197836194426,
|
|
0.055606538882961506
|
|
],
|
|
"observed_m": [
|
|
0.19258167461200293,
|
|
-0.17711397644899018,
|
|
0.05373163171935805
|
|
]
|
|
}
|
|
],
|
|
"stage_idx": 1,
|
|
"num_active_links": 4
|
|
},
|
|
{
|
|
"method": "deterministic_geometric_prefix",
|
|
"active_links": [
|
|
"Board",
|
|
"Base",
|
|
"Arm1",
|
|
"Ellbow",
|
|
"Arm2"
|
|
],
|
|
"active_observations": 53,
|
|
"joint_updates": [
|
|
{
|
|
"pass": 0,
|
|
"updates": [
|
|
{
|
|
"link": "Base",
|
|
"joint_variable": "x",
|
|
"joint_type": "linear",
|
|
"old": 0.03008008224001913,
|
|
"new": 0.0321651305358493,
|
|
"info": {
|
|
"reason": "weighted_projection",
|
|
"used_markers": 11,
|
|
"axis_world": [
|
|
0.9999999825442352,
|
|
-7.911330830299229e-06,
|
|
-0.0001866733515941224
|
|
],
|
|
"per_marker": [
|
|
{
|
|
"marker_id": 198,
|
|
"q_i": 0.030075996972682036,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 229,
|
|
"q_i": 0.02996354643060485,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 243,
|
|
"q_i": 0.03013386350245614,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 244,
|
|
"q_i": 0.03052059692589901,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 245,
|
|
"q_i": 0.029952785895385182,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 248,
|
|
"q_i": 0.03004782901704794,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 232,
|
|
"q_i": 0.02986595693576383,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 120,
|
|
"q_i": 0.037270891354173157,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 114,
|
|
"q_i": 0.03741821802818537,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 115,
|
|
"q_i": 0.03988786819954635,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 219,
|
|
"q_i": 0.02867888263259843,
|
|
"weight": 1.0
|
|
}
|
|
]
|
|
}
|
|
},
|
|
{
|
|
"link": "Arm1",
|
|
"joint_variable": "y",
|
|
"joint_type": "revolute",
|
|
"old": 0.03362140443012329,
|
|
"new": -0.5318264271484381,
|
|
"info": {
|
|
"reason": "2d_alignment+normal_tiebreak",
|
|
"used_markers": 11,
|
|
"axis_world": [
|
|
-0.9999999825442352,
|
|
7.911330830299229e-06,
|
|
0.0001866733515941224
|
|
],
|
|
"axis_id": 0,
|
|
"theta_rad": -0.5318264271484379,
|
|
"theta_alt_rad": 2.609766226441355,
|
|
"score_theta": 1.0319501580739046,
|
|
"score_theta_alt": 2.557477346779494,
|
|
"best_score": 1.0319501580739046,
|
|
"per_marker": [
|
|
{
|
|
"marker_id": 198,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 229,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 243,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 244,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 245,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 248,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 232,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 120,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 114,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 115,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 219,
|
|
"weight": 1.0
|
|
}
|
|
]
|
|
}
|
|
},
|
|
{
|
|
"link": "Ellbow",
|
|
"joint_variable": "z",
|
|
"joint_type": "revolute",
|
|
"old": -1.199306941308583,
|
|
"new": 1.0027658216553856,
|
|
"info": {
|
|
"reason": "2d_alignment+normal_tiebreak",
|
|
"used_markers": 7,
|
|
"axis_world": [
|
|
-0.9999999825442352,
|
|
7.911330830299227e-06,
|
|
0.0001866733515941224
|
|
],
|
|
"axis_id": 0,
|
|
"theta_rad": -2.1388268319344075,
|
|
"theta_alt_rad": 1.0027658216553856,
|
|
"score_theta": 1.0209781366597686,
|
|
"score_theta_alt": 0.3829212775389696,
|
|
"best_score": 0.3829212775389696,
|
|
"per_marker": [
|
|
{
|
|
"marker_id": 245,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 248,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 232,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 120,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 114,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 115,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 219,
|
|
"weight": 1.0
|
|
}
|
|
]
|
|
}
|
|
},
|
|
{
|
|
"link": "Arm2",
|
|
"joint_variable": "a",
|
|
"joint_type": "revolute",
|
|
"old": 0.0,
|
|
"new": 0.948088380748696,
|
|
"info": {
|
|
"reason": "2d_alignment+normal_tiebreak",
|
|
"used_markers": 4,
|
|
"axis_world": [
|
|
7.762755216443495e-05,
|
|
-0.8911970041080515,
|
|
0.4536164611660348
|
|
],
|
|
"axis_id": 1,
|
|
"theta_rad": -2.193504272841097,
|
|
"theta_alt_rad": 0.948088380748696,
|
|
"score_theta": 0.4440521987492321,
|
|
"score_theta_alt": 0.3646813567763245,
|
|
"best_score": 0.3646813567763245,
|
|
"per_marker": [
|
|
{
|
|
"marker_id": 120,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 114,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 115,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 219,
|
|
"weight": 1.0
|
|
}
|
|
]
|
|
}
|
|
}
|
|
]
|
|
},
|
|
{
|
|
"pass": 1,
|
|
"updates": [
|
|
{
|
|
"link": "Base",
|
|
"joint_variable": "x",
|
|
"joint_type": "linear",
|
|
"old": 0.0321651305358493,
|
|
"new": 0.02894587263620346,
|
|
"info": {
|
|
"reason": "weighted_projection",
|
|
"used_markers": 11,
|
|
"axis_world": [
|
|
0.9999999825442352,
|
|
-7.911330830299229e-06,
|
|
-0.0001866733515941224
|
|
],
|
|
"per_marker": [
|
|
{
|
|
"marker_id": 198,
|
|
"q_i": 0.03007599697268204,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 229,
|
|
"q_i": 0.02996354643060486,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 243,
|
|
"q_i": 0.03013386350245612,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 244,
|
|
"q_i": 0.03052059692588964,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 245,
|
|
"q_i": 0.029952785895378434,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 248,
|
|
"q_i": 0.030047829017044024,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 232,
|
|
"q_i": 0.02986595693575709,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 120,
|
|
"q_i": 0.02748130038436775,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 114,
|
|
"q_i": 0.027628627058379953,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 115,
|
|
"q_i": 0.009468507068402972,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 219,
|
|
"q_i": 0.043265588807275164,
|
|
"weight": 1.0
|
|
}
|
|
]
|
|
}
|
|
},
|
|
{
|
|
"link": "Arm1",
|
|
"joint_variable": "y",
|
|
"joint_type": "revolute",
|
|
"old": -0.5318264271484381,
|
|
"new": -0.08818746829453605,
|
|
"info": {
|
|
"reason": "2d_alignment+normal_tiebreak",
|
|
"used_markers": 11,
|
|
"axis_world": [
|
|
-0.9999999825442352,
|
|
7.911330830299229e-06,
|
|
0.0001866733515941224
|
|
],
|
|
"axis_id": 0,
|
|
"theta_rad": -0.08818746829453583,
|
|
"theta_alt_rad": 3.053405185295257,
|
|
"score_theta": 0.05988103606739789,
|
|
"score_theta_alt": 3.881092548073068,
|
|
"best_score": 0.05988103606739789,
|
|
"per_marker": [
|
|
{
|
|
"marker_id": 198,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 229,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 243,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 244,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 245,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 248,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 232,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 120,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 114,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 115,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 219,
|
|
"weight": 1.0
|
|
}
|
|
]
|
|
}
|
|
},
|
|
{
|
|
"link": "Ellbow",
|
|
"joint_variable": "z",
|
|
"joint_type": "revolute",
|
|
"old": 1.0027658216553856,
|
|
"new": 1.4953740918354965,
|
|
"info": {
|
|
"reason": "2d_alignment+normal_tiebreak",
|
|
"used_markers": 7,
|
|
"axis_world": [
|
|
-0.9999999825442352,
|
|
7.911330830299229e-06,
|
|
0.00018667335159412238
|
|
],
|
|
"axis_id": 0,
|
|
"theta_rad": -1.6462185617542968,
|
|
"theta_alt_rad": 1.4953740918354965,
|
|
"score_theta": 0.7697425070037229,
|
|
"score_theta_alt": 0.09893560477387695,
|
|
"best_score": 0.09893560477387695,
|
|
"per_marker": [
|
|
{
|
|
"marker_id": 245,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 248,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 232,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 120,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 114,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 115,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 219,
|
|
"weight": 1.0
|
|
}
|
|
]
|
|
}
|
|
},
|
|
{
|
|
"link": "Arm2",
|
|
"joint_variable": "a",
|
|
"joint_type": "revolute",
|
|
"old": 0.948088380748696,
|
|
"new": 1.0840347802398904,
|
|
"info": {
|
|
"reason": "2d_alignment+normal_tiebreak",
|
|
"used_markers": 4,
|
|
"axis_world": [
|
|
0.0001828872718432978,
|
|
-0.16299938910282485,
|
|
0.9866261529588356
|
|
],
|
|
"axis_id": 2,
|
|
"theta_rad": 1.0840347802398902,
|
|
"theta_alt_rad": -2.0575578733499027,
|
|
"score_theta": 0.1513821515667613,
|
|
"score_theta_alt": 0.1755960639876984,
|
|
"best_score": 0.1513821515667613,
|
|
"per_marker": [
|
|
{
|
|
"marker_id": 120,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 114,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 115,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 219,
|
|
"weight": 1.0
|
|
}
|
|
]
|
|
}
|
|
}
|
|
]
|
|
}
|
|
],
|
|
"root_link": "Board",
|
|
"root_pose": {
|
|
"reason": "kabsch",
|
|
"used_markers": [
|
|
210,
|
|
211,
|
|
215,
|
|
214,
|
|
208,
|
|
206,
|
|
205,
|
|
207,
|
|
217,
|
|
46,
|
|
47,
|
|
51,
|
|
52,
|
|
53,
|
|
54,
|
|
55,
|
|
56,
|
|
58,
|
|
60,
|
|
61,
|
|
62,
|
|
63,
|
|
64,
|
|
66,
|
|
68,
|
|
69,
|
|
72,
|
|
73,
|
|
79,
|
|
82,
|
|
83,
|
|
84,
|
|
85,
|
|
86,
|
|
92,
|
|
95,
|
|
96,
|
|
97,
|
|
101,
|
|
102,
|
|
103,
|
|
105
|
|
]
|
|
},
|
|
"marker_stats": {
|
|
"num_markers_used": 53,
|
|
"mean_error_m": 0.004569083821120897,
|
|
"rms_error_m": 0.010879937404143085,
|
|
"median_error_m": 0.0003109730580594026,
|
|
"worst_error_m": 0.05141331442445902
|
|
},
|
|
"marker_reports": [
|
|
{
|
|
"marker_id": 46,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.00024014580635156602,
|
|
0.00019849948688827057,
|
|
-0.0001325889838793802
|
|
],
|
|
"error_norm_m": 0.00033860285475659696,
|
|
"predicted_m": [
|
|
0.5367315875661282,
|
|
0.18544692342486993,
|
|
-0.02733176064749602
|
|
],
|
|
"observed_m": [
|
|
0.5364914417597766,
|
|
0.18524842393798166,
|
|
-0.02719917166361664
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 47,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.0001356286636347015,
|
|
0.00012133053072427291,
|
|
-0.00014802679586498058
|
|
],
|
|
"error_norm_m": 0.00023458082696422862,
|
|
"predicted_m": [
|
|
0.34424784634233146,
|
|
-0.2865315503756803,
|
|
-0.02735257876128538
|
|
],
|
|
"observed_m": [
|
|
0.34438347500596617,
|
|
-0.28665288090640456,
|
|
-0.0272045519654204
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 51,
|
|
"link": "Board",
|
|
"error_m": [
|
|
6.307287002968454e-05,
|
|
-0.00014999963369966007,
|
|
0.00013641978209038771
|
|
],
|
|
"error_norm_m": 0.0002123403729614379,
|
|
"predicted_m": [
|
|
0.1678187575218507,
|
|
-0.1720701554105413,
|
|
-0.027305881766096583
|
|
],
|
|
"observed_m": [
|
|
0.167755684651821,
|
|
-0.17192015577684164,
|
|
-0.02744230154818697
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 52,
|
|
"link": "Board",
|
|
"error_m": [
|
|
5.976559091475098e-05,
|
|
-0.00019726439713532717,
|
|
5.5558001508391325e-05
|
|
],
|
|
"error_norm_m": 0.00021347566551286321,
|
|
"predicted_m": [
|
|
0.09470177950393126,
|
|
0.20867042030186375,
|
|
-0.027246453545320196
|
|
],
|
|
"observed_m": [
|
|
0.0946420139130165,
|
|
0.20886768469899908,
|
|
-0.027302011546828587
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 53,
|
|
"link": "Board",
|
|
"error_m": [
|
|
2.2465988035458295e-06,
|
|
0.00015843318946973106,
|
|
2.8051563047696432e-05
|
|
],
|
|
"error_norm_m": 0.00016091306013234192,
|
|
"predicted_m": [
|
|
0.4862718010720863,
|
|
0.21224732243606034,
|
|
-0.02731911878462367
|
|
],
|
|
"observed_m": [
|
|
0.48626955447328274,
|
|
0.2120888892465906,
|
|
-0.027347170347671368
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 54,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-9.480154294294607e-05,
|
|
1.627539552162549e-05,
|
|
-0.00012362426496341158
|
|
],
|
|
"error_norm_m": 0.00015663709628147604,
|
|
"predicted_m": [
|
|
0.34228749689371984,
|
|
-0.3305815345496766,
|
|
-0.027357509278550476
|
|
],
|
|
"observed_m": [
|
|
0.3423822984366628,
|
|
-0.3305978099451982,
|
|
-0.027233885013587065
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 55,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-1.0716649648634391e-05,
|
|
0.00011026767914773528,
|
|
-6.97715080855317e-05
|
|
],
|
|
"error_norm_m": 0.0001309269681343339,
|
|
"predicted_m": [
|
|
0.28373803749178683,
|
|
-0.26257107183499706,
|
|
-0.027338402301549082
|
|
],
|
|
"observed_m": [
|
|
0.28374875414143547,
|
|
-0.2626813395141448,
|
|
-0.02726863079346355
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 56,
|
|
"link": "Board",
|
|
"error_m": [
|
|
6.356140605623395e-05,
|
|
-2.3035154325057317e-05,
|
|
-4.765688565996212e-05
|
|
],
|
|
"error_norm_m": 8.271547270874637e-05,
|
|
"predicted_m": [
|
|
0.49870145518051306,
|
|
0.16867722441452865,
|
|
-0.02732667781812476
|
|
],
|
|
"observed_m": [
|
|
0.49863789377445683,
|
|
0.1687002595688537,
|
|
-0.027279020932464797
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 58,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.00010114347277415808,
|
|
-0.000100406862560104,
|
|
1.7625811855784268e-05
|
|
],
|
|
"error_norm_m": 0.00014360435013451362,
|
|
"predicted_m": [
|
|
0.050108394384752154,
|
|
-0.21809922383361957,
|
|
-0.027289442910250115
|
|
],
|
|
"observed_m": [
|
|
0.050007250911977996,
|
|
-0.21799881697105947,
|
|
-0.0273070687221059
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 60,
|
|
"link": "Board",
|
|
"error_m": [
|
|
2.5816559448055276e-05,
|
|
0.00010821188574633434,
|
|
-2.1284107574501276e-05
|
|
],
|
|
"error_norm_m": 0.00011326658904441165,
|
|
"predicted_m": [
|
|
0.4343823697981462,
|
|
0.28381773243543157,
|
|
-0.027300827011884146
|
|
],
|
|
"observed_m": [
|
|
0.43435655323869815,
|
|
0.28370952054968523,
|
|
-0.027279542904309645
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 61,
|
|
"link": "Board",
|
|
"error_m": [
|
|
2.213673047626874e-05,
|
|
-0.0004748026529825533,
|
|
0.00036777003104209935
|
|
],
|
|
"error_norm_m": 0.000600984517145123,
|
|
"predicted_m": [
|
|
-0.022397209513850602,
|
|
0.3358413457954722,
|
|
-0.02720930368016537
|
|
],
|
|
"observed_m": [
|
|
-0.02241934624432687,
|
|
0.33631614844845475,
|
|
-0.02757707371120747
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 62,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-5.2027625080386386e-05,
|
|
-0.00019686027029469644,
|
|
0.0001104321380561088
|
|
],
|
|
"error_norm_m": 0.00023163785724196654,
|
|
"predicted_m": [
|
|
0.4047187294268141,
|
|
-0.1750920295828903,
|
|
-0.027350467795893892
|
|
],
|
|
"observed_m": [
|
|
0.40477075705189447,
|
|
-0.1748951693125956,
|
|
-0.02746089993395
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 63,
|
|
"link": "Board",
|
|
"error_m": [
|
|
5.97205525321165e-05,
|
|
8.612992450571233e-05,
|
|
0.00017768133054744256
|
|
],
|
|
"error_norm_m": 0.00020628999858260345,
|
|
"predicted_m": [
|
|
0.7774182385644122,
|
|
-0.23614497769267853,
|
|
-0.02742738136354363
|
|
],
|
|
"observed_m": [
|
|
0.77735851801188,
|
|
-0.23623110761718424,
|
|
-0.027605062694091072
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 64,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-7.91293138496553e-05,
|
|
-0.0001473370794227158,
|
|
0.00015746330336172815
|
|
],
|
|
"error_norm_m": 0.0002297049307018039,
|
|
"predicted_m": [
|
|
-0.0212513673084557,
|
|
-0.18821865949797503,
|
|
-0.027272529247363148
|
|
],
|
|
"observed_m": [
|
|
-0.021172237994606043,
|
|
-0.18807132241855232,
|
|
-0.027429992550724876
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 66,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-9.67864364553872e-05,
|
|
0.0001370872909244869,
|
|
-1.2083618247695632e-05
|
|
],
|
|
"error_norm_m": 0.0001682455153776874,
|
|
"predicted_m": [
|
|
0.20976724024838408,
|
|
-0.3632204859031543,
|
|
-0.027336695829951723
|
|
],
|
|
"observed_m": [
|
|
0.20986402668483947,
|
|
-0.3633575731940788,
|
|
-0.027324612211704027
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 68,
|
|
"link": "Board",
|
|
"error_m": [
|
|
1.5700754685266105e-05,
|
|
0.00018632529536974363,
|
|
-3.095209368547333e-05
|
|
],
|
|
"error_norm_m": 0.00018953010709600582,
|
|
"predicted_m": [
|
|
0.5737514695000713,
|
|
0.17064663065484797,
|
|
-0.027340450788186716
|
|
],
|
|
"observed_m": [
|
|
0.573735768745386,
|
|
0.17046030535947823,
|
|
-0.027309498694501243
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 69,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-2.0034684490774328e-05,
|
|
-0.00030379998350144044,
|
|
0.0002071791909846396
|
|
],
|
|
"error_norm_m": 0.0003682648988638072,
|
|
"predicted_m": [
|
|
0.00762789450497923,
|
|
-0.28119888730219095,
|
|
-0.027289099919642363
|
|
],
|
|
"observed_m": [
|
|
0.007647929189470004,
|
|
-0.2808950873186895,
|
|
-0.027496279110627003
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 72,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.00047090395286775166,
|
|
0.00012575615412688257,
|
|
-0.00035486948541986474
|
|
],
|
|
"error_norm_m": 0.0006029075342118536,
|
|
"predicted_m": [
|
|
0.44101165968882705,
|
|
0.19432768063298977,
|
|
-0.02731282457835261
|
|
],
|
|
"observed_m": [
|
|
0.4405407557359593,
|
|
0.1942019244788629,
|
|
-0.026957955092932744
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 73,
|
|
"link": "Board",
|
|
"error_m": [
|
|
5.680208949179755e-05,
|
|
0.0004589062252717824,
|
|
-0.0004479530621591017
|
|
],
|
|
"error_norm_m": 0.0006438038108473311,
|
|
"predicted_m": [
|
|
0.22175276464469845,
|
|
0.3331194142637967,
|
|
-0.02725520702095333
|
|
],
|
|
"observed_m": [
|
|
0.22169596255520665,
|
|
0.3326605080385249,
|
|
-0.026807253958794228
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 79,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.00013968223420696146,
|
|
-0.0005000676111311941,
|
|
0.00022277023191346126
|
|
],
|
|
"error_norm_m": 0.0005649825824592162,
|
|
"predicted_m": [
|
|
0.31231885790070896,
|
|
-0.1591012986920062,
|
|
-0.02733129660411856
|
|
],
|
|
"observed_m": [
|
|
0.3124585401349159,
|
|
-0.158601231080875,
|
|
-0.02755406683603202
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 82,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-7.405616276753846e-05,
|
|
-8.325803470837778e-05,
|
|
7.280887590920687e-05
|
|
],
|
|
"error_norm_m": 0.00013310652875992175,
|
|
"predicted_m": [
|
|
0.2191824801050202,
|
|
0.29724943485632677,
|
|
-0.02725904013676476
|
|
],
|
|
"observed_m": [
|
|
0.21925653626778774,
|
|
0.29733269289103514,
|
|
-0.027331849012673968
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 83,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-4.62492650498067e-05,
|
|
-0.00012746911940025862,
|
|
0.00018718614259173594
|
|
],
|
|
"error_norm_m": 0.00023114069935149535,
|
|
"predicted_m": [
|
|
0.04418281621951103,
|
|
0.33923081903445473,
|
|
-0.02722132479177954
|
|
],
|
|
"observed_m": [
|
|
0.044229065484560834,
|
|
0.339358288153855,
|
|
-0.027408510934371275
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 84,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.00017232694873475785,
|
|
0.00011817015158627209,
|
|
-5.607158385221092e-05
|
|
],
|
|
"error_norm_m": 0.00021634413442903855,
|
|
"predicted_m": [
|
|
0.4075121688285888,
|
|
0.2584279451972179,
|
|
-0.027298863891678203
|
|
],
|
|
"observed_m": [
|
|
0.40733984187985406,
|
|
0.25830977504563163,
|
|
-0.027242792307825992
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 85,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.00020312592435511867,
|
|
-0.00015599653047260187,
|
|
0.0001347694972127153
|
|
],
|
|
"error_norm_m": 0.0002894095299805776,
|
|
"predicted_m": [
|
|
0.5045976355991969,
|
|
-0.3127428187672989,
|
|
-0.027385663219507896
|
|
],
|
|
"observed_m": [
|
|
0.5043945096748418,
|
|
-0.3125868222368263,
|
|
-0.02752043271672061
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 86,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.00035883263285391154,
|
|
-0.00015731092163612237,
|
|
0.00010075824908208422
|
|
],
|
|
"error_norm_m": 0.00040454889596310066,
|
|
"predicted_m": [
|
|
0.3629124361025995,
|
|
0.29201829779871546,
|
|
-0.02728649953201595
|
|
],
|
|
"observed_m": [
|
|
0.3632712687354534,
|
|
0.2921756087203516,
|
|
-0.027387257781098035
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 92,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.0002934523327690064,
|
|
0.0002629017827487645,
|
|
-0.00018794120863876995
|
|
],
|
|
"error_norm_m": 0.0004365243600128771,
|
|
"predicted_m": [
|
|
0.6451086479558872,
|
|
-0.18483393131699793,
|
|
-0.027396513301796547
|
|
],
|
|
"observed_m": [
|
|
0.6454021002886562,
|
|
-0.1850968330997467,
|
|
-0.027208572093157777
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 95,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.00019812064350874237,
|
|
0.00014999898375817056,
|
|
-6.225838941766731e-05
|
|
],
|
|
"error_norm_m": 0.00025617882731733316,
|
|
"predicted_m": [
|
|
0.18605794803768458,
|
|
-0.27406029897278616,
|
|
-0.02732154956052728
|
|
],
|
|
"observed_m": [
|
|
0.18585982739417584,
|
|
-0.27421029795654434,
|
|
-0.027259291171109614
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 96,
|
|
"link": "Board",
|
|
"error_m": [
|
|
8.627927498106036e-05,
|
|
9.213278406036696e-05,
|
|
-9.836286334074032e-05
|
|
],
|
|
"error_norm_m": 0.000160024423368937,
|
|
"predicted_m": [
|
|
0.3697886396708029,
|
|
-0.18648175315741503,
|
|
-0.027345316784081836
|
|
],
|
|
"observed_m": [
|
|
0.3697023603958218,
|
|
-0.1865738859414754,
|
|
-0.027246953920741095
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 97,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.00022164513432659794,
|
|
8.413999103396019e-05,
|
|
-0.00021176258327362807
|
|
],
|
|
"error_norm_m": 0.0003178828327176081,
|
|
"predicted_m": [
|
|
0.30436726684140514,
|
|
-0.35966123434089586,
|
|
-0.0273539270887528
|
|
],
|
|
"observed_m": [
|
|
0.30414562170707854,
|
|
-0.3597453743319298,
|
|
-0.027142164505479172
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 101,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-5.676935748405443e-05,
|
|
0.00011481105218846821,
|
|
-1.1951448038453188e-05
|
|
],
|
|
"error_norm_m": 0.00012863582224245074,
|
|
"predicted_m": [
|
|
0.11772249314194222,
|
|
0.29867023752964394,
|
|
-0.02723992952335222
|
|
],
|
|
"observed_m": [
|
|
0.11777926249942627,
|
|
0.2985554264774555,
|
|
-0.027227978075313766
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 102,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.00012606484361721293,
|
|
-0.00019410822228813074,
|
|
0.00036249867615404524
|
|
],
|
|
"error_norm_m": 0.00043008794097199016,
|
|
"predicted_m": [
|
|
0.6497083451227117,
|
|
-0.22299396743208486,
|
|
-0.027401960206043074
|
|
],
|
|
"observed_m": [
|
|
0.6498344099663289,
|
|
-0.22279985920979672,
|
|
-0.02776445888219712
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 103,
|
|
"link": "Board",
|
|
"error_m": [
|
|
3.75396160226249e-05,
|
|
0.00021848045899708346,
|
|
-7.526325638289658e-05
|
|
],
|
|
"error_norm_m": 0.00023410999871013627,
|
|
"predicted_m": [
|
|
0.10572863460070166,
|
|
-0.18769966408253902,
|
|
-0.027296170506814023
|
|
],
|
|
"observed_m": [
|
|
0.10569109498467903,
|
|
-0.1879181445415361,
|
|
-0.027220907250431126
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 105,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.00017913342661046716,
|
|
0.000210656851415858,
|
|
-0.0002720035290025881
|
|
],
|
|
"error_norm_m": 0.0003878801533560492,
|
|
"predicted_m": [
|
|
0.5248580041661369,
|
|
-0.26624297938844327,
|
|
-0.02738385424630833
|
|
],
|
|
"observed_m": [
|
|
0.5246788707395265,
|
|
-0.2664536362398591,
|
|
-0.027111850717305742
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 114,
|
|
"link": "Arm2",
|
|
"error_m": [
|
|
0.00022742006601100817,
|
|
-0.013195818895620992,
|
|
-0.014381136174735493
|
|
],
|
|
"error_norm_m": 0.01951918117874667,
|
|
"predicted_m": [
|
|
0.26246348146525844,
|
|
-0.1605328532116268,
|
|
0.22020643909252588
|
|
],
|
|
"observed_m": [
|
|
0.26223606139924743,
|
|
-0.1473370343160058,
|
|
0.23458757526726137
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 115,
|
|
"link": "Arm2",
|
|
"error_m": [
|
|
0.024101686045126552,
|
|
-0.03962705510808118,
|
|
-0.02218409640601879
|
|
],
|
|
"error_norm_m": 0.05141331442445902,
|
|
"predicted_m": [
|
|
0.23930739058672867,
|
|
-0.20369824602548453,
|
|
0.2130794258021653
|
|
],
|
|
"observed_m": [
|
|
0.21520570454160212,
|
|
-0.16407119091740335,
|
|
0.23526352220818408
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 120,
|
|
"link": "Arm2",
|
|
"error_m": [
|
|
0.0003750467534565094,
|
|
0.002301022538397951,
|
|
-0.013430758333365406
|
|
],
|
|
"error_norm_m": 0.013631604241568852,
|
|
"predicted_m": [
|
|
0.26245067935622945,
|
|
-0.14912289597444123,
|
|
0.15114260838548105
|
|
],
|
|
"observed_m": [
|
|
0.26207563260277295,
|
|
-0.15142391851283918,
|
|
0.16457336671884645
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 198,
|
|
"link": "Arm1",
|
|
"error_m": [
|
|
-0.0011317517253608689,
|
|
-0.0013794765903897763,
|
|
-0.008659273320430802
|
|
],
|
|
"error_norm_m": 0.008841200827331964,
|
|
"predicted_m": [
|
|
0.13898592460963502,
|
|
-0.05446384554601108,
|
|
0.08178592100688736
|
|
],
|
|
"observed_m": [
|
|
0.1401176763349959,
|
|
-0.053084368955621304,
|
|
0.09044519432731817
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 205,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-3.964650851695506e-05,
|
|
1.2098030970658646e-05,
|
|
-0.00023363467438157246
|
|
],
|
|
"error_norm_m": 0.00023728330970452892,
|
|
"predicted_m": [
|
|
0.7500245507222149,
|
|
-0.08999808053842868,
|
|
0.00019530530139471217
|
|
],
|
|
"observed_m": [
|
|
0.7500641972307318,
|
|
-0.09001017856939934,
|
|
0.0004289399757762846
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 206,
|
|
"link": "Board",
|
|
"error_m": [
|
|
5.497735281512206e-05,
|
|
-0.0003467456861196462,
|
|
7.08540774461642e-05
|
|
],
|
|
"error_norm_m": 0.0003581555255135535,
|
|
"predicted_m": [
|
|
0.6500251871697533,
|
|
-0.009997289986131553,
|
|
0.00022359151879563336
|
|
],
|
|
"observed_m": [
|
|
0.6499702098169382,
|
|
-0.009650544300011906,
|
|
0.00015273744134946916
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 207,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.000675204086429404,
|
|
-0.0004522642832782489,
|
|
0.000567904346721304
|
|
],
|
|
"error_norm_m": 0.0009914428310725258,
|
|
"predicted_m": [
|
|
0.7500251854242768,
|
|
-0.009998081119214583,
|
|
0.00020492418363620245
|
|
],
|
|
"observed_m": [
|
|
0.7507003895107062,
|
|
-0.009545816835936334,
|
|
-0.0003629801630851015
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 208,
|
|
"link": "Board",
|
|
"error_m": [
|
|
8.103369664302917e-05,
|
|
8.449754240932861e-05,
|
|
-5.784049800828736e-05
|
|
],
|
|
"error_norm_m": 0.00013058260938845362,
|
|
"predicted_m": [
|
|
0.3500245577041208,
|
|
-0.08999491600609656,
|
|
0.0002699746420324358
|
|
],
|
|
"observed_m": [
|
|
0.34994352400747775,
|
|
-0.09007941354850589,
|
|
0.0003278151400407232
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 210,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-4.0705434832904314e-05,
|
|
0.0002875021340621245,
|
|
-0.00011130962817117374
|
|
],
|
|
"error_norm_m": 0.0003109730580594026,
|
|
"predicted_m": [
|
|
0.02002511882849735,
|
|
-0.01999230577511022,
|
|
0.00033999337001986183
|
|
],
|
|
"observed_m": [
|
|
0.020065824263330253,
|
|
-0.020279807909172345,
|
|
0.0004513029981910356
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 211,
|
|
"link": "Board",
|
|
"error_m": [
|
|
1.33701774804873e-05,
|
|
9.383654401974931e-05,
|
|
-1.0346849726384035e-05
|
|
],
|
|
"error_norm_m": 9.534734363730566e-05,
|
|
"predicted_m": [
|
|
0.25002519415165914,
|
|
-0.00999412545379943,
|
|
0.000298260859433357
|
|
],
|
|
"observed_m": [
|
|
0.25001182397417865,
|
|
-0.01008796199781918,
|
|
0.00030860770915974104
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 214,
|
|
"link": "Board",
|
|
"error_m": [
|
|
3.487801149665293e-05,
|
|
0.00044274628708106806,
|
|
-0.00029472423741045946
|
|
],
|
|
"error_norm_m": 0.0005330132517369611,
|
|
"predicted_m": [
|
|
0.3500251924061827,
|
|
-0.00999491658688246,
|
|
0.0002795935242739261
|
|
],
|
|
"observed_m": [
|
|
0.34999031439468603,
|
|
-0.010437662873963529,
|
|
0.0005743177616843856
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 215,
|
|
"link": "Board",
|
|
"error_m": [
|
|
5.814383252331079e-05,
|
|
3.1566079447112316e-05,
|
|
-8.698037465849884e-06
|
|
],
|
|
"error_norm_m": 6.672914271828725e-05,
|
|
"predicted_m": [
|
|
0.25002455944959723,
|
|
-0.08999412487301353,
|
|
0.0002886419771918667
|
|
],
|
|
"observed_m": [
|
|
0.24996641561707392,
|
|
-0.09002569095246064,
|
|
0.0002973400146577166
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 217,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.00018180264930645063,
|
|
-0.0003000352885192542,
|
|
0.00010324834312563732
|
|
],
|
|
"error_norm_m": 0.000365696045931407,
|
|
"predicted_m": [
|
|
0.6500245524676914,
|
|
-0.08999728940534565,
|
|
0.00021397263655414307
|
|
],
|
|
"observed_m": [
|
|
0.6502063551169979,
|
|
-0.0896972541168264,
|
|
0.00011072429342850576
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 219,
|
|
"link": "Arm2",
|
|
"error_m": [
|
|
-0.01836328866173864,
|
|
-0.027353550305363933,
|
|
-0.010033790979104729
|
|
],
|
|
"error_norm_m": 0.03443986129755428,
|
|
"predicted_m": [
|
|
0.24539029427284925,
|
|
-0.14620299148693738,
|
|
0.2600785639673745
|
|
],
|
|
"observed_m": [
|
|
0.2637535829345879,
|
|
-0.11884944118157345,
|
|
0.2701123549464792
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 229,
|
|
"link": "Arm1",
|
|
"error_m": [
|
|
-0.0010202039996825008,
|
|
-0.0009954023670544487,
|
|
-0.013511904274451314
|
|
],
|
|
"error_norm_m": 0.013586875991015795,
|
|
"predicted_m": [
|
|
0.13898373366926126,
|
|
-0.14411315224094529,
|
|
0.07384855341320237
|
|
],
|
|
"observed_m": [
|
|
0.14000393766894376,
|
|
-0.14311774987389084,
|
|
0.08736045768765369
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 232,
|
|
"link": "Ellbow",
|
|
"error_m": [
|
|
-0.0009233554099819241,
|
|
0.007038029109827648,
|
|
-0.01782136733300794
|
|
],
|
|
"error_norm_m": 0.01918300217854147,
|
|
"predicted_m": [
|
|
0.22897177567894955,
|
|
-0.16141187291551382,
|
|
0.01051490208330316
|
|
],
|
|
"observed_m": [
|
|
0.22989513108893148,
|
|
-0.16844990202534146,
|
|
0.0283362694163111
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 243,
|
|
"link": "Arm1",
|
|
"error_m": [
|
|
-0.0011907512375798623,
|
|
0.0011623389217610691,
|
|
-0.014836322956087
|
|
],
|
|
"error_norm_m": 0.014929346909230583,
|
|
"predicted_m": [
|
|
0.13897639794856836,
|
|
-0.17589001734181348,
|
|
0.035898180680534894
|
|
],
|
|
"observed_m": [
|
|
0.14016714918614823,
|
|
-0.17705235626357455,
|
|
0.050734503636621894
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 244,
|
|
"link": "Ellbow",
|
|
"error_m": [
|
|
-0.001577158916719279,
|
|
0.0010646668613621957,
|
|
-0.013087150755480219
|
|
],
|
|
"error_norm_m": 0.013224766942027236,
|
|
"predicted_m": [
|
|
0.26397724779885823,
|
|
-0.14102738698791506,
|
|
0.038961600575796486
|
|
],
|
|
"observed_m": [
|
|
0.2655544067155775,
|
|
-0.14209205384927726,
|
|
0.052048751331276705
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 245,
|
|
"link": "Ellbow",
|
|
"error_m": [
|
|
-0.0010107201074224248,
|
|
0.001474929358728616,
|
|
-0.020455512846527954
|
|
],
|
|
"error_norm_m": 0.0205335086520365,
|
|
"predicted_m": [
|
|
0.22897591024895392,
|
|
-0.17555902603705503,
|
|
0.03326315567472333
|
|
],
|
|
"observed_m": [
|
|
0.22998663035637634,
|
|
-0.17703395539578365,
|
|
0.05371866852125128
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 248,
|
|
"link": "Ellbow",
|
|
"error_m": [
|
|
-0.0011057637084256888,
|
|
0.0015552470868412938,
|
|
-0.02046147579394994
|
|
],
|
|
"error_norm_m": 0.02055026760279289,
|
|
"predicted_m": [
|
|
0.19147591090357724,
|
|
-0.1755587293621489,
|
|
0.03327015592540811
|
|
],
|
|
"observed_m": [
|
|
0.19258167461200293,
|
|
-0.17711397644899018,
|
|
0.05373163171935805
|
|
]
|
|
}
|
|
],
|
|
"stage_idx": 2,
|
|
"num_active_links": 5
|
|
}
|
|
],
|
|
"markers": [
|
|
{
|
|
"marker_id": 41,
|
|
"link": "FingerA",
|
|
"observed_position_m": [
|
|
0.23584374215104642,
|
|
-0.1128637439184499,
|
|
0.3458290400120677
|
|
],
|
|
"predicted_position_m": [
|
|
0.20879974433705523,
|
|
-0.17113723611353793,
|
|
0.32509044826763167
|
|
],
|
|
"error_m": [
|
|
-0.027043997813991194,
|
|
-0.058273492195088025,
|
|
-0.02073859174443604
|
|
],
|
|
"error_norm_m": 0.0675075321569122
|
|
},
|
|
{
|
|
"marker_id": 44,
|
|
"link": "FingerB",
|
|
"observed_position_m": [
|
|
0.23408985021029313,
|
|
-0.16868760189173954,
|
|
0.32755212243754706
|
|
],
|
|
"predicted_position_m": [
|
|
0.24925980293157143,
|
|
-0.20454383316969688,
|
|
0.3195638822775239
|
|
],
|
|
"error_m": [
|
|
0.015169952721278301,
|
|
-0.03585623127795734,
|
|
-0.007988240160023141
|
|
],
|
|
"error_norm_m": 0.03974429226792687
|
|
},
|
|
{
|
|
"marker_id": 45,
|
|
"link": "FingerB",
|
|
"observed_position_m": [
|
|
0.21603169851187431,
|
|
-0.16584169538942475,
|
|
0.37116193876962195
|
|
],
|
|
"predicted_position_m": [
|
|
0.22066307007166003,
|
|
-0.2096112152136987,
|
|
0.3570443906645345
|
|
],
|
|
"error_m": [
|
|
0.004631371559785713,
|
|
-0.043769519824273934,
|
|
-0.014117548105087474
|
|
],
|
|
"error_norm_m": 0.046222566270943455
|
|
},
|
|
{
|
|
"marker_id": 46,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.5364914417597766,
|
|
0.18524842393798166,
|
|
-0.02719917166361664
|
|
],
|
|
"predicted_position_m": [
|
|
0.5367315875661282,
|
|
0.18544692342486993,
|
|
-0.02733176064749602
|
|
],
|
|
"error_m": [
|
|
0.00024014580635156602,
|
|
0.00019849948688827057,
|
|
-0.0001325889838793802
|
|
],
|
|
"error_norm_m": 0.00033860285475659696
|
|
},
|
|
{
|
|
"marker_id": 47,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.34438347500596617,
|
|
-0.28665288090640456,
|
|
-0.0272045519654204
|
|
],
|
|
"predicted_position_m": [
|
|
0.34424784634233146,
|
|
-0.2865315503756803,
|
|
-0.02735257876128538
|
|
],
|
|
"error_m": [
|
|
-0.0001356286636347015,
|
|
0.00012133053072427291,
|
|
-0.00014802679586498058
|
|
],
|
|
"error_norm_m": 0.00023458082696422862
|
|
},
|
|
{
|
|
"marker_id": 51,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.167755684651821,
|
|
-0.17192015577684164,
|
|
-0.02744230154818697
|
|
],
|
|
"predicted_position_m": [
|
|
0.1678187575218507,
|
|
-0.1720701554105413,
|
|
-0.027305881766096583
|
|
],
|
|
"error_m": [
|
|
6.307287002968454e-05,
|
|
-0.00014999963369966007,
|
|
0.00013641978209038771
|
|
],
|
|
"error_norm_m": 0.0002123403729614379
|
|
},
|
|
{
|
|
"marker_id": 52,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.0946420139130165,
|
|
0.20886768469899908,
|
|
-0.027302011546828587
|
|
],
|
|
"predicted_position_m": [
|
|
0.09470177950393126,
|
|
0.20867042030186375,
|
|
-0.027246453545320196
|
|
],
|
|
"error_m": [
|
|
5.976559091475098e-05,
|
|
-0.00019726439713532717,
|
|
5.5558001508391325e-05
|
|
],
|
|
"error_norm_m": 0.00021347566551286321
|
|
},
|
|
{
|
|
"marker_id": 53,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.48626955447328274,
|
|
0.2120888892465906,
|
|
-0.027347170347671368
|
|
],
|
|
"predicted_position_m": [
|
|
0.4862718010720863,
|
|
0.21224732243606034,
|
|
-0.02731911878462367
|
|
],
|
|
"error_m": [
|
|
2.2465988035458295e-06,
|
|
0.00015843318946973106,
|
|
2.8051563047696432e-05
|
|
],
|
|
"error_norm_m": 0.00016091306013234192
|
|
},
|
|
{
|
|
"marker_id": 54,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.3423822984366628,
|
|
-0.3305978099451982,
|
|
-0.027233885013587065
|
|
],
|
|
"predicted_position_m": [
|
|
0.34228749689371984,
|
|
-0.3305815345496766,
|
|
-0.027357509278550476
|
|
],
|
|
"error_m": [
|
|
-9.480154294294607e-05,
|
|
1.627539552162549e-05,
|
|
-0.00012362426496341158
|
|
],
|
|
"error_norm_m": 0.00015663709628147604
|
|
},
|
|
{
|
|
"marker_id": 55,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.28374875414143547,
|
|
-0.2626813395141448,
|
|
-0.02726863079346355
|
|
],
|
|
"predicted_position_m": [
|
|
0.28373803749178683,
|
|
-0.26257107183499706,
|
|
-0.027338402301549082
|
|
],
|
|
"error_m": [
|
|
-1.0716649648634391e-05,
|
|
0.00011026767914773528,
|
|
-6.97715080855317e-05
|
|
],
|
|
"error_norm_m": 0.0001309269681343339
|
|
},
|
|
{
|
|
"marker_id": 56,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.49863789377445683,
|
|
0.1687002595688537,
|
|
-0.027279020932464797
|
|
],
|
|
"predicted_position_m": [
|
|
0.49870145518051306,
|
|
0.16867722441452865,
|
|
-0.02732667781812476
|
|
],
|
|
"error_m": [
|
|
6.356140605623395e-05,
|
|
-2.3035154325057317e-05,
|
|
-4.765688565996212e-05
|
|
],
|
|
"error_norm_m": 8.271547270874637e-05
|
|
},
|
|
{
|
|
"marker_id": 58,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.050007250911977996,
|
|
-0.21799881697105947,
|
|
-0.0273070687221059
|
|
],
|
|
"predicted_position_m": [
|
|
0.050108394384752154,
|
|
-0.21809922383361957,
|
|
-0.027289442910250115
|
|
],
|
|
"error_m": [
|
|
0.00010114347277415808,
|
|
-0.000100406862560104,
|
|
1.7625811855784268e-05
|
|
],
|
|
"error_norm_m": 0.00014360435013451362
|
|
},
|
|
{
|
|
"marker_id": 60,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.43435655323869815,
|
|
0.28370952054968523,
|
|
-0.027279542904309645
|
|
],
|
|
"predicted_position_m": [
|
|
0.4343823697981462,
|
|
0.28381773243543157,
|
|
-0.027300827011884146
|
|
],
|
|
"error_m": [
|
|
2.5816559448055276e-05,
|
|
0.00010821188574633434,
|
|
-2.1284107574501276e-05
|
|
],
|
|
"error_norm_m": 0.00011326658904441165
|
|
},
|
|
{
|
|
"marker_id": 61,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
-0.02241934624432687,
|
|
0.33631614844845475,
|
|
-0.02757707371120747
|
|
],
|
|
"predicted_position_m": [
|
|
-0.022397209513850602,
|
|
0.3358413457954722,
|
|
-0.02720930368016537
|
|
],
|
|
"error_m": [
|
|
2.213673047626874e-05,
|
|
-0.0004748026529825533,
|
|
0.00036777003104209935
|
|
],
|
|
"error_norm_m": 0.000600984517145123
|
|
},
|
|
{
|
|
"marker_id": 62,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.40477075705189447,
|
|
-0.1748951693125956,
|
|
-0.02746089993395
|
|
],
|
|
"predicted_position_m": [
|
|
0.4047187294268141,
|
|
-0.1750920295828903,
|
|
-0.027350467795893892
|
|
],
|
|
"error_m": [
|
|
-5.2027625080386386e-05,
|
|
-0.00019686027029469644,
|
|
0.0001104321380561088
|
|
],
|
|
"error_norm_m": 0.00023163785724196654
|
|
},
|
|
{
|
|
"marker_id": 63,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.77735851801188,
|
|
-0.23623110761718424,
|
|
-0.027605062694091072
|
|
],
|
|
"predicted_position_m": [
|
|
0.7774182385644122,
|
|
-0.23614497769267853,
|
|
-0.02742738136354363
|
|
],
|
|
"error_m": [
|
|
5.97205525321165e-05,
|
|
8.612992450571233e-05,
|
|
0.00017768133054744256
|
|
],
|
|
"error_norm_m": 0.00020628999858260345
|
|
},
|
|
{
|
|
"marker_id": 64,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
-0.021172237994606043,
|
|
-0.18807132241855232,
|
|
-0.027429992550724876
|
|
],
|
|
"predicted_position_m": [
|
|
-0.0212513673084557,
|
|
-0.18821865949797503,
|
|
-0.027272529247363148
|
|
],
|
|
"error_m": [
|
|
-7.91293138496553e-05,
|
|
-0.0001473370794227158,
|
|
0.00015746330336172815
|
|
],
|
|
"error_norm_m": 0.0002297049307018039
|
|
},
|
|
{
|
|
"marker_id": 66,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.20986402668483947,
|
|
-0.3633575731940788,
|
|
-0.027324612211704027
|
|
],
|
|
"predicted_position_m": [
|
|
0.20976724024838408,
|
|
-0.3632204859031543,
|
|
-0.027336695829951723
|
|
],
|
|
"error_m": [
|
|
-9.67864364553872e-05,
|
|
0.0001370872909244869,
|
|
-1.2083618247695632e-05
|
|
],
|
|
"error_norm_m": 0.0001682455153776874
|
|
},
|
|
{
|
|
"marker_id": 68,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.573735768745386,
|
|
0.17046030535947823,
|
|
-0.027309498694501243
|
|
],
|
|
"predicted_position_m": [
|
|
0.5737514695000713,
|
|
0.17064663065484797,
|
|
-0.027340450788186716
|
|
],
|
|
"error_m": [
|
|
1.5700754685266105e-05,
|
|
0.00018632529536974363,
|
|
-3.095209368547333e-05
|
|
],
|
|
"error_norm_m": 0.00018953010709600582
|
|
},
|
|
{
|
|
"marker_id": 69,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.007647929189470004,
|
|
-0.2808950873186895,
|
|
-0.027496279110627003
|
|
],
|
|
"predicted_position_m": [
|
|
0.00762789450497923,
|
|
-0.28119888730219095,
|
|
-0.027289099919642363
|
|
],
|
|
"error_m": [
|
|
-2.0034684490774328e-05,
|
|
-0.00030379998350144044,
|
|
0.0002071791909846396
|
|
],
|
|
"error_norm_m": 0.0003682648988638072
|
|
},
|
|
{
|
|
"marker_id": 72,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.4405407557359593,
|
|
0.1942019244788629,
|
|
-0.026957955092932744
|
|
],
|
|
"predicted_position_m": [
|
|
0.44101165968882705,
|
|
0.19432768063298977,
|
|
-0.02731282457835261
|
|
],
|
|
"error_m": [
|
|
0.00047090395286775166,
|
|
0.00012575615412688257,
|
|
-0.00035486948541986474
|
|
],
|
|
"error_norm_m": 0.0006029075342118536
|
|
},
|
|
{
|
|
"marker_id": 73,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.22169596255520665,
|
|
0.3326605080385249,
|
|
-0.026807253958794228
|
|
],
|
|
"predicted_position_m": [
|
|
0.22175276464469845,
|
|
0.3331194142637967,
|
|
-0.02725520702095333
|
|
],
|
|
"error_m": [
|
|
5.680208949179755e-05,
|
|
0.0004589062252717824,
|
|
-0.0004479530621591017
|
|
],
|
|
"error_norm_m": 0.0006438038108473311
|
|
},
|
|
{
|
|
"marker_id": 79,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.3124585401349159,
|
|
-0.158601231080875,
|
|
-0.02755406683603202
|
|
],
|
|
"predicted_position_m": [
|
|
0.31231885790070896,
|
|
-0.1591012986920062,
|
|
-0.02733129660411856
|
|
],
|
|
"error_m": [
|
|
-0.00013968223420696146,
|
|
-0.0005000676111311941,
|
|
0.00022277023191346126
|
|
],
|
|
"error_norm_m": 0.0005649825824592162
|
|
},
|
|
{
|
|
"marker_id": 82,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.21925653626778774,
|
|
0.29733269289103514,
|
|
-0.027331849012673968
|
|
],
|
|
"predicted_position_m": [
|
|
0.2191824801050202,
|
|
0.29724943485632677,
|
|
-0.02725904013676476
|
|
],
|
|
"error_m": [
|
|
-7.405616276753846e-05,
|
|
-8.325803470837778e-05,
|
|
7.280887590920687e-05
|
|
],
|
|
"error_norm_m": 0.00013310652875992175
|
|
},
|
|
{
|
|
"marker_id": 83,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.044229065484560834,
|
|
0.339358288153855,
|
|
-0.027408510934371275
|
|
],
|
|
"predicted_position_m": [
|
|
0.04418281621951103,
|
|
0.33923081903445473,
|
|
-0.02722132479177954
|
|
],
|
|
"error_m": [
|
|
-4.62492650498067e-05,
|
|
-0.00012746911940025862,
|
|
0.00018718614259173594
|
|
],
|
|
"error_norm_m": 0.00023114069935149535
|
|
},
|
|
{
|
|
"marker_id": 84,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.40733984187985406,
|
|
0.25830977504563163,
|
|
-0.027242792307825992
|
|
],
|
|
"predicted_position_m": [
|
|
0.4075121688285888,
|
|
0.2584279451972179,
|
|
-0.027298863891678203
|
|
],
|
|
"error_m": [
|
|
0.00017232694873475785,
|
|
0.00011817015158627209,
|
|
-5.607158385221092e-05
|
|
],
|
|
"error_norm_m": 0.00021634413442903855
|
|
},
|
|
{
|
|
"marker_id": 85,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.5043945096748418,
|
|
-0.3125868222368263,
|
|
-0.02752043271672061
|
|
],
|
|
"predicted_position_m": [
|
|
0.5045976355991969,
|
|
-0.3127428187672989,
|
|
-0.027385663219507896
|
|
],
|
|
"error_m": [
|
|
0.00020312592435511867,
|
|
-0.00015599653047260187,
|
|
0.0001347694972127153
|
|
],
|
|
"error_norm_m": 0.0002894095299805776
|
|
},
|
|
{
|
|
"marker_id": 86,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.3632712687354534,
|
|
0.2921756087203516,
|
|
-0.027387257781098035
|
|
],
|
|
"predicted_position_m": [
|
|
0.3629124361025995,
|
|
0.29201829779871546,
|
|
-0.02728649953201595
|
|
],
|
|
"error_m": [
|
|
-0.00035883263285391154,
|
|
-0.00015731092163612237,
|
|
0.00010075824908208422
|
|
],
|
|
"error_norm_m": 0.00040454889596310066
|
|
},
|
|
{
|
|
"marker_id": 92,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.6454021002886562,
|
|
-0.1850968330997467,
|
|
-0.027208572093157777
|
|
],
|
|
"predicted_position_m": [
|
|
0.6451086479558872,
|
|
-0.18483393131699793,
|
|
-0.027396513301796547
|
|
],
|
|
"error_m": [
|
|
-0.0002934523327690064,
|
|
0.0002629017827487645,
|
|
-0.00018794120863876995
|
|
],
|
|
"error_norm_m": 0.0004365243600128771
|
|
},
|
|
{
|
|
"marker_id": 95,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.18585982739417584,
|
|
-0.27421029795654434,
|
|
-0.027259291171109614
|
|
],
|
|
"predicted_position_m": [
|
|
0.18605794803768458,
|
|
-0.27406029897278616,
|
|
-0.02732154956052728
|
|
],
|
|
"error_m": [
|
|
0.00019812064350874237,
|
|
0.00014999898375817056,
|
|
-6.225838941766731e-05
|
|
],
|
|
"error_norm_m": 0.00025617882731733316
|
|
},
|
|
{
|
|
"marker_id": 96,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.3697023603958218,
|
|
-0.1865738859414754,
|
|
-0.027246953920741095
|
|
],
|
|
"predicted_position_m": [
|
|
0.3697886396708029,
|
|
-0.18648175315741503,
|
|
-0.027345316784081836
|
|
],
|
|
"error_m": [
|
|
8.627927498106036e-05,
|
|
9.213278406036696e-05,
|
|
-9.836286334074032e-05
|
|
],
|
|
"error_norm_m": 0.000160024423368937
|
|
},
|
|
{
|
|
"marker_id": 97,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.30414562170707854,
|
|
-0.3597453743319298,
|
|
-0.027142164505479172
|
|
],
|
|
"predicted_position_m": [
|
|
0.30436726684140514,
|
|
-0.35966123434089586,
|
|
-0.0273539270887528
|
|
],
|
|
"error_m": [
|
|
0.00022164513432659794,
|
|
8.413999103396019e-05,
|
|
-0.00021176258327362807
|
|
],
|
|
"error_norm_m": 0.0003178828327176081
|
|
},
|
|
{
|
|
"marker_id": 101,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.11777926249942627,
|
|
0.2985554264774555,
|
|
-0.027227978075313766
|
|
],
|
|
"predicted_position_m": [
|
|
0.11772249314194222,
|
|
0.29867023752964394,
|
|
-0.02723992952335222
|
|
],
|
|
"error_m": [
|
|
-5.676935748405443e-05,
|
|
0.00011481105218846821,
|
|
-1.1951448038453188e-05
|
|
],
|
|
"error_norm_m": 0.00012863582224245074
|
|
},
|
|
{
|
|
"marker_id": 102,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.6498344099663289,
|
|
-0.22279985920979672,
|
|
-0.02776445888219712
|
|
],
|
|
"predicted_position_m": [
|
|
0.6497083451227117,
|
|
-0.22299396743208486,
|
|
-0.027401960206043074
|
|
],
|
|
"error_m": [
|
|
-0.00012606484361721293,
|
|
-0.00019410822228813074,
|
|
0.00036249867615404524
|
|
],
|
|
"error_norm_m": 0.00043008794097199016
|
|
},
|
|
{
|
|
"marker_id": 103,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.10569109498467903,
|
|
-0.1879181445415361,
|
|
-0.027220907250431126
|
|
],
|
|
"predicted_position_m": [
|
|
0.10572863460070166,
|
|
-0.18769966408253902,
|
|
-0.027296170506814023
|
|
],
|
|
"error_m": [
|
|
3.75396160226249e-05,
|
|
0.00021848045899708346,
|
|
-7.526325638289658e-05
|
|
],
|
|
"error_norm_m": 0.00023410999871013627
|
|
},
|
|
{
|
|
"marker_id": 105,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.5246788707395265,
|
|
-0.2664536362398591,
|
|
-0.027111850717305742
|
|
],
|
|
"predicted_position_m": [
|
|
0.5248580041661369,
|
|
-0.26624297938844327,
|
|
-0.02738385424630833
|
|
],
|
|
"error_m": [
|
|
0.00017913342661046716,
|
|
0.000210656851415858,
|
|
-0.0002720035290025881
|
|
],
|
|
"error_norm_m": 0.0003878801533560492
|
|
},
|
|
{
|
|
"marker_id": 114,
|
|
"link": "Arm2",
|
|
"observed_position_m": [
|
|
0.26223606139924743,
|
|
-0.1473370343160058,
|
|
0.23458757526726137
|
|
],
|
|
"predicted_position_m": [
|
|
0.26246348146525844,
|
|
-0.1605328532116268,
|
|
0.22020643909252588
|
|
],
|
|
"error_m": [
|
|
0.00022742006601100817,
|
|
-0.013195818895620992,
|
|
-0.014381136174735493
|
|
],
|
|
"error_norm_m": 0.01951918117874667
|
|
},
|
|
{
|
|
"marker_id": 115,
|
|
"link": "Arm2",
|
|
"observed_position_m": [
|
|
0.21520570454160212,
|
|
-0.16407119091740335,
|
|
0.23526352220818408
|
|
],
|
|
"predicted_position_m": [
|
|
0.23930739058672867,
|
|
-0.20369824602548453,
|
|
0.2130794258021653
|
|
],
|
|
"error_m": [
|
|
0.024101686045126552,
|
|
-0.03962705510808118,
|
|
-0.02218409640601879
|
|
],
|
|
"error_norm_m": 0.05141331442445902
|
|
},
|
|
{
|
|
"marker_id": 120,
|
|
"link": "Arm2",
|
|
"observed_position_m": [
|
|
0.26207563260277295,
|
|
-0.15142391851283918,
|
|
0.16457336671884645
|
|
],
|
|
"predicted_position_m": [
|
|
0.26245067935622945,
|
|
-0.14912289597444123,
|
|
0.15114260838548105
|
|
],
|
|
"error_m": [
|
|
0.0003750467534565094,
|
|
0.002301022538397951,
|
|
-0.013430758333365406
|
|
],
|
|
"error_norm_m": 0.013631604241568852
|
|
},
|
|
{
|
|
"marker_id": 198,
|
|
"link": "Arm1",
|
|
"observed_position_m": [
|
|
0.1401176763349959,
|
|
-0.053084368955621304,
|
|
0.09044519432731817
|
|
],
|
|
"predicted_position_m": [
|
|
0.13898592460963502,
|
|
-0.05446384554601108,
|
|
0.08178592100688736
|
|
],
|
|
"error_m": [
|
|
-0.0011317517253608689,
|
|
-0.0013794765903897763,
|
|
-0.008659273320430802
|
|
],
|
|
"error_norm_m": 0.008841200827331964
|
|
},
|
|
{
|
|
"marker_id": 205,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.7500641972307318,
|
|
-0.09001017856939934,
|
|
0.0004289399757762846
|
|
],
|
|
"predicted_position_m": [
|
|
0.7500245507222149,
|
|
-0.08999808053842868,
|
|
0.00019530530139471217
|
|
],
|
|
"error_m": [
|
|
-3.964650851695506e-05,
|
|
1.2098030970658646e-05,
|
|
-0.00023363467438157246
|
|
],
|
|
"error_norm_m": 0.00023728330970452892
|
|
},
|
|
{
|
|
"marker_id": 206,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.6499702098169382,
|
|
-0.009650544300011906,
|
|
0.00015273744134946916
|
|
],
|
|
"predicted_position_m": [
|
|
0.6500251871697533,
|
|
-0.009997289986131553,
|
|
0.00022359151879563336
|
|
],
|
|
"error_m": [
|
|
5.497735281512206e-05,
|
|
-0.0003467456861196462,
|
|
7.08540774461642e-05
|
|
],
|
|
"error_norm_m": 0.0003581555255135535
|
|
},
|
|
{
|
|
"marker_id": 207,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.7507003895107062,
|
|
-0.009545816835936334,
|
|
-0.0003629801630851015
|
|
],
|
|
"predicted_position_m": [
|
|
0.7500251854242768,
|
|
-0.009998081119214583,
|
|
0.00020492418363620245
|
|
],
|
|
"error_m": [
|
|
-0.000675204086429404,
|
|
-0.0004522642832782489,
|
|
0.000567904346721304
|
|
],
|
|
"error_norm_m": 0.0009914428310725258
|
|
},
|
|
{
|
|
"marker_id": 208,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.34994352400747775,
|
|
-0.09007941354850589,
|
|
0.0003278151400407232
|
|
],
|
|
"predicted_position_m": [
|
|
0.3500245577041208,
|
|
-0.08999491600609656,
|
|
0.0002699746420324358
|
|
],
|
|
"error_m": [
|
|
8.103369664302917e-05,
|
|
8.449754240932861e-05,
|
|
-5.784049800828736e-05
|
|
],
|
|
"error_norm_m": 0.00013058260938845362
|
|
},
|
|
{
|
|
"marker_id": 210,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.020065824263330253,
|
|
-0.020279807909172345,
|
|
0.0004513029981910356
|
|
],
|
|
"predicted_position_m": [
|
|
0.02002511882849735,
|
|
-0.01999230577511022,
|
|
0.00033999337001986183
|
|
],
|
|
"error_m": [
|
|
-4.0705434832904314e-05,
|
|
0.0002875021340621245,
|
|
-0.00011130962817117374
|
|
],
|
|
"error_norm_m": 0.0003109730580594026
|
|
},
|
|
{
|
|
"marker_id": 211,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.25001182397417865,
|
|
-0.01008796199781918,
|
|
0.00030860770915974104
|
|
],
|
|
"predicted_position_m": [
|
|
0.25002519415165914,
|
|
-0.00999412545379943,
|
|
0.000298260859433357
|
|
],
|
|
"error_m": [
|
|
1.33701774804873e-05,
|
|
9.383654401974931e-05,
|
|
-1.0346849726384035e-05
|
|
],
|
|
"error_norm_m": 9.534734363730566e-05
|
|
},
|
|
{
|
|
"marker_id": 214,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.34999031439468603,
|
|
-0.010437662873963529,
|
|
0.0005743177616843856
|
|
],
|
|
"predicted_position_m": [
|
|
0.3500251924061827,
|
|
-0.00999491658688246,
|
|
0.0002795935242739261
|
|
],
|
|
"error_m": [
|
|
3.487801149665293e-05,
|
|
0.00044274628708106806,
|
|
-0.00029472423741045946
|
|
],
|
|
"error_norm_m": 0.0005330132517369611
|
|
},
|
|
{
|
|
"marker_id": 215,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.24996641561707392,
|
|
-0.09002569095246064,
|
|
0.0002973400146577166
|
|
],
|
|
"predicted_position_m": [
|
|
0.25002455944959723,
|
|
-0.08999412487301353,
|
|
0.0002886419771918667
|
|
],
|
|
"error_m": [
|
|
5.814383252331079e-05,
|
|
3.1566079447112316e-05,
|
|
-8.698037465849884e-06
|
|
],
|
|
"error_norm_m": 6.672914271828725e-05
|
|
},
|
|
{
|
|
"marker_id": 217,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.6502063551169979,
|
|
-0.0896972541168264,
|
|
0.00011072429342850576
|
|
],
|
|
"predicted_position_m": [
|
|
0.6500245524676914,
|
|
-0.08999728940534565,
|
|
0.00021397263655414307
|
|
],
|
|
"error_m": [
|
|
-0.00018180264930645063,
|
|
-0.0003000352885192542,
|
|
0.00010324834312563732
|
|
],
|
|
"error_norm_m": 0.000365696045931407
|
|
},
|
|
{
|
|
"marker_id": 219,
|
|
"link": "Arm2",
|
|
"observed_position_m": [
|
|
0.2637535829345879,
|
|
-0.11884944118157345,
|
|
0.2701123549464792
|
|
],
|
|
"predicted_position_m": [
|
|
0.24539029427284925,
|
|
-0.14620299148693738,
|
|
0.2600785639673745
|
|
],
|
|
"error_m": [
|
|
-0.01836328866173864,
|
|
-0.027353550305363933,
|
|
-0.010033790979104729
|
|
],
|
|
"error_norm_m": 0.03443986129755428
|
|
},
|
|
{
|
|
"marker_id": 229,
|
|
"link": "Arm1",
|
|
"observed_position_m": [
|
|
0.14000393766894376,
|
|
-0.14311774987389084,
|
|
0.08736045768765369
|
|
],
|
|
"predicted_position_m": [
|
|
0.13898373366926126,
|
|
-0.14411315224094529,
|
|
0.07384855341320237
|
|
],
|
|
"error_m": [
|
|
-0.0010202039996825008,
|
|
-0.0009954023670544487,
|
|
-0.013511904274451314
|
|
],
|
|
"error_norm_m": 0.013586875991015795
|
|
},
|
|
{
|
|
"marker_id": 232,
|
|
"link": "Ellbow",
|
|
"observed_position_m": [
|
|
0.22989513108893148,
|
|
-0.16844990202534146,
|
|
0.0283362694163111
|
|
],
|
|
"predicted_position_m": [
|
|
0.22897177567894955,
|
|
-0.16141187291551382,
|
|
0.01051490208330316
|
|
],
|
|
"error_m": [
|
|
-0.0009233554099819241,
|
|
0.007038029109827648,
|
|
-0.01782136733300794
|
|
],
|
|
"error_norm_m": 0.01918300217854147
|
|
},
|
|
{
|
|
"marker_id": 243,
|
|
"link": "Arm1",
|
|
"observed_position_m": [
|
|
0.14016714918614823,
|
|
-0.17705235626357455,
|
|
0.050734503636621894
|
|
],
|
|
"predicted_position_m": [
|
|
0.13897639794856836,
|
|
-0.17589001734181348,
|
|
0.035898180680534894
|
|
],
|
|
"error_m": [
|
|
-0.0011907512375798623,
|
|
0.0011623389217610691,
|
|
-0.014836322956087
|
|
],
|
|
"error_norm_m": 0.014929346909230583
|
|
},
|
|
{
|
|
"marker_id": 244,
|
|
"link": "Ellbow",
|
|
"observed_position_m": [
|
|
0.2655544067155775,
|
|
-0.14209205384927726,
|
|
0.052048751331276705
|
|
],
|
|
"predicted_position_m": [
|
|
0.26397724779885823,
|
|
-0.14102738698791506,
|
|
0.038961600575796486
|
|
],
|
|
"error_m": [
|
|
-0.001577158916719279,
|
|
0.0010646668613621957,
|
|
-0.013087150755480219
|
|
],
|
|
"error_norm_m": 0.013224766942027236
|
|
},
|
|
{
|
|
"marker_id": 245,
|
|
"link": "Ellbow",
|
|
"observed_position_m": [
|
|
0.22998663035637634,
|
|
-0.17703395539578365,
|
|
0.05371866852125128
|
|
],
|
|
"predicted_position_m": [
|
|
0.22897591024895392,
|
|
-0.17555902603705503,
|
|
0.03326315567472333
|
|
],
|
|
"error_m": [
|
|
-0.0010107201074224248,
|
|
0.001474929358728616,
|
|
-0.020455512846527954
|
|
],
|
|
"error_norm_m": 0.0205335086520365
|
|
},
|
|
{
|
|
"marker_id": 248,
|
|
"link": "Ellbow",
|
|
"observed_position_m": [
|
|
0.19258167461200293,
|
|
-0.17711397644899018,
|
|
0.05373163171935805
|
|
],
|
|
"predicted_position_m": [
|
|
0.19147591090357724,
|
|
-0.1755587293621489,
|
|
0.03327015592540811
|
|
],
|
|
"error_m": [
|
|
-0.0011057637084256888,
|
|
0.0015552470868412938,
|
|
-0.02046147579394994
|
|
],
|
|
"error_norm_m": 0.02055026760279289
|
|
}
|
|
]
|
|
} |