5009 lines
130 KiB
JSON
5009 lines
130 KiB
JSON
{
|
|
"schema_version": "1.0",
|
|
"method": "deterministic_geometric_sequential_prefix",
|
|
"created_utc": "2026-06-01T19:32:14Z",
|
|
"root_pose": {
|
|
"translation_m": [
|
|
2.3297230059116103e-05,
|
|
1.222619303246214e-05,
|
|
0.00010210665465972338
|
|
],
|
|
"rotation_matrix": [
|
|
[
|
|
0.9999999449532615,
|
|
-2.547604725040276e-05,
|
|
0.0003308238887643554
|
|
],
|
|
[
|
|
2.5493121610090167e-05,
|
|
0.9999999983433824,
|
|
-5.160751425483198e-05
|
|
],
|
|
[
|
|
-0.0003308225734608286,
|
|
5.161594514755368e-05,
|
|
0.9999999439461079
|
|
]
|
|
],
|
|
"euler_xyz_deg": [
|
|
0.002957375975679668,
|
|
0.018954737572707832,
|
|
0.0014606483549594238
|
|
]
|
|
},
|
|
"movements": {
|
|
"x": {
|
|
"value_m": 0.06286849126885194,
|
|
"value_mm": 62.86849126885194,
|
|
"joint_type": "linear",
|
|
"link": "Base"
|
|
},
|
|
"y": {
|
|
"value_rad": -0.014603164874364527,
|
|
"value_deg": -0.8366997148347785,
|
|
"joint_type": "revolute",
|
|
"link": "Arm1"
|
|
},
|
|
"z": {
|
|
"value_rad": 1.6464393488237805,
|
|
"value_deg": 94.33402591187016,
|
|
"joint_type": "revolute",
|
|
"link": "Ellbow"
|
|
},
|
|
"a": {
|
|
"value_rad": -2.8679380500321456,
|
|
"value_deg": -164.32074617182107,
|
|
"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.3297230059116103e-05,
|
|
1.222619303246214e-05,
|
|
0.00010210665465972338
|
|
],
|
|
"rotation_matrix": [
|
|
[
|
|
0.9999999449532615,
|
|
-2.547604725040276e-05,
|
|
0.0003308238887643554
|
|
],
|
|
[
|
|
2.5493121610090167e-05,
|
|
0.9999999983433824,
|
|
-5.160751425483198e-05
|
|
],
|
|
[
|
|
-0.0003308225734608286,
|
|
5.161594514755368e-05,
|
|
0.9999999439461079
|
|
]
|
|
]
|
|
},
|
|
"Base": {
|
|
"translation_m": [
|
|
0.06289707822036301,
|
|
1.3003186897742961e-05,
|
|
0.01608130744172631
|
|
],
|
|
"rotation_matrix": [
|
|
[
|
|
0.9999999449532615,
|
|
-2.547604725040276e-05,
|
|
0.0003308238887643554
|
|
],
|
|
[
|
|
2.5493121610090167e-05,
|
|
0.9999999983433824,
|
|
-5.160751425483198e-05
|
|
],
|
|
[
|
|
-0.0003308225734608286,
|
|
5.161594514755368e-05,
|
|
0.9999999439461079
|
|
]
|
|
]
|
|
},
|
|
"Arm1": {
|
|
"translation_m": [
|
|
0.1729092078271131,
|
|
0.10801348491321867,
|
|
0.06105048895829641
|
|
],
|
|
"rotation_matrix": [
|
|
[
|
|
0.9999999449532613,
|
|
-2.06424267968636e-05,
|
|
0.00033116063258879585
|
|
],
|
|
[
|
|
2.549312161009016e-05,
|
|
0.9998926204199757,
|
|
-0.01465424784061317
|
|
],
|
|
[
|
|
-0.00033082257346082856,
|
|
0.014654255476262817,
|
|
0.999892565905388
|
|
]
|
|
]
|
|
},
|
|
"Ellbow": {
|
|
"translation_m": [
|
|
0.17291436843381233,
|
|
-0.14195967019177524,
|
|
0.057386925089230705
|
|
],
|
|
"rotation_matrix": [
|
|
[
|
|
0.99999994495111,
|
|
-0.00032865368884834185,
|
|
-4.560950741713477e-05
|
|
],
|
|
[
|
|
2.5493121610035316e-05,
|
|
-0.06095044834201853,
|
|
0.9981407927717503
|
|
],
|
|
[
|
|
-0.0003308225734601169,
|
|
-0.9981407389900838,
|
|
-0.06095043660848676
|
|
]
|
|
]
|
|
},
|
|
"Arm2": {
|
|
"translation_m": [
|
|
0.2629143634794122,
|
|
-0.14195737581083034,
|
|
0.05735715105761929
|
|
],
|
|
"rotation_matrix": [
|
|
[
|
|
-0.9627772857080142,
|
|
-0.00032865368884705176,
|
|
0.27029574563247005
|
|
],
|
|
[
|
|
-0.26977393847166375,
|
|
-0.060950448341779276,
|
|
-0.960992749694949
|
|
],
|
|
[
|
|
0.016790480693418403,
|
|
-0.9981407389861657,
|
|
0.05859304501750762
|
|
]
|
|
]
|
|
},
|
|
"Hand": {
|
|
"translation_m": [
|
|
0.262996526901624,
|
|
-0.12671976372538551,
|
|
0.30689233580416075
|
|
],
|
|
"rotation_matrix": [
|
|
[
|
|
-0.9627772857080142,
|
|
-0.00032865368884705176,
|
|
0.27029574563247005
|
|
],
|
|
[
|
|
-0.26977393847166375,
|
|
-0.060950448341779276,
|
|
-0.960992749694949
|
|
],
|
|
[
|
|
0.016790480693418403,
|
|
-0.9981407389861657,
|
|
0.05859304501750762
|
|
]
|
|
]
|
|
},
|
|
"Palm": {
|
|
"translation_m": [
|
|
0.262996526901624,
|
|
-0.12671976372538551,
|
|
0.30689233580416075
|
|
],
|
|
"rotation_matrix": [
|
|
[
|
|
-0.9627772857080142,
|
|
-0.00032865368884705176,
|
|
0.27029574563247005
|
|
],
|
|
[
|
|
-0.26977393847166375,
|
|
-0.060950448341779276,
|
|
-0.960992749694949
|
|
],
|
|
[
|
|
0.016790480693418403,
|
|
-0.9981407389861657,
|
|
0.05859304501750762
|
|
]
|
|
]
|
|
},
|
|
"FingerA": {
|
|
"translation_m": [
|
|
0.2591569206379016,
|
|
-0.1256655937873099,
|
|
0.3418944235914502
|
|
],
|
|
"rotation_matrix": [
|
|
[
|
|
-0.9627772857080142,
|
|
-0.00032865368884705176,
|
|
0.27029574563247005
|
|
],
|
|
[
|
|
-0.26977393847166375,
|
|
-0.060950448341779276,
|
|
-0.960992749694949
|
|
],
|
|
[
|
|
0.016790480693418403,
|
|
-0.9981407389861657,
|
|
0.05859304501750762
|
|
]
|
|
]
|
|
},
|
|
"FingerB": {
|
|
"translation_m": [
|
|
0.2668591389235657,
|
|
-0.12350740227953659,
|
|
0.3417600997459029
|
|
],
|
|
"rotation_matrix": [
|
|
[
|
|
-0.9627772857080142,
|
|
-0.00032865368884705176,
|
|
0.27029574563247005
|
|
],
|
|
[
|
|
-0.26977393847166375,
|
|
-0.060950448341779276,
|
|
-0.960992749694949
|
|
],
|
|
[
|
|
0.016790480693418403,
|
|
-0.9981407389861657,
|
|
0.05859304501750762
|
|
]
|
|
]
|
|
}
|
|
},
|
|
"stage_reports": [
|
|
{
|
|
"method": "deterministic_geometric_prefix",
|
|
"active_links": [
|
|
"Board",
|
|
"Base",
|
|
"Arm1"
|
|
],
|
|
"active_observations": 41,
|
|
"joint_updates": [
|
|
{
|
|
"pass": 0,
|
|
"updates": [
|
|
{
|
|
"link": "Base",
|
|
"joint_variable": "x",
|
|
"joint_type": "linear",
|
|
"old": 0.0,
|
|
"new": 0.060037756770435845,
|
|
"info": {
|
|
"reason": "weighted_projection",
|
|
"used_markers": 3,
|
|
"axis_world": [
|
|
0.9999999449522614,
|
|
2.549312161006467e-05,
|
|
-0.00033082257346049777
|
|
],
|
|
"per_marker": [
|
|
{
|
|
"marker_id": 198,
|
|
"q_i": 0.059832246981116805,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 229,
|
|
"q_i": 0.06014948830158834,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 243,
|
|
"q_i": 0.060131535028602384,
|
|
"weight": 1.0
|
|
}
|
|
]
|
|
}
|
|
},
|
|
{
|
|
"link": "Arm1",
|
|
"joint_variable": "y",
|
|
"joint_type": "revolute",
|
|
"old": 0.0,
|
|
"new": 0.03558679028775913,
|
|
"info": {
|
|
"reason": "2d_alignment+normal_tiebreak",
|
|
"used_markers": 3,
|
|
"axis_world": [
|
|
-0.9999999449522614,
|
|
-2.549312161006467e-05,
|
|
0.00033082257346049777
|
|
],
|
|
"axis_id": 0,
|
|
"theta_rad": 0.035586790287759115,
|
|
"theta_alt_rad": -3.106005863302034,
|
|
"score_theta": 0.0009336661355096635,
|
|
"score_theta_alt": 0.8865453876752879,
|
|
"best_score": 0.0009336661355096635,
|
|
"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.060037756770435845,
|
|
"new": 0.06003775677043583,
|
|
"info": {
|
|
"reason": "weighted_projection",
|
|
"used_markers": 3,
|
|
"axis_world": [
|
|
0.9999999449522614,
|
|
2.549312161006467e-05,
|
|
-0.00033082257346049777
|
|
],
|
|
"per_marker": [
|
|
{
|
|
"marker_id": 198,
|
|
"q_i": 0.059832246981116805,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 229,
|
|
"q_i": 0.060149488301588325,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 243,
|
|
"q_i": 0.06013153502860237,
|
|
"weight": 1.0
|
|
}
|
|
]
|
|
}
|
|
},
|
|
{
|
|
"link": "Arm1",
|
|
"joint_variable": "y",
|
|
"joint_type": "revolute",
|
|
"old": 0.03558679028775913,
|
|
"new": 0.03558679028775913,
|
|
"info": {
|
|
"reason": "2d_alignment+normal_tiebreak",
|
|
"used_markers": 3,
|
|
"axis_world": [
|
|
-0.9999999449522614,
|
|
-2.549312161006467e-05,
|
|
0.00033082257346049777
|
|
],
|
|
"axis_id": 0,
|
|
"theta_rad": 0.035586790287759115,
|
|
"theta_alt_rad": -3.106005863302034,
|
|
"score_theta": 0.0009336661355096635,
|
|
"score_theta_alt": 0.8865453876752879,
|
|
"best_score": 0.0009336661355096635,
|
|
"per_marker": [
|
|
{
|
|
"marker_id": 198,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 229,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 243,
|
|
"weight": 1.0
|
|
}
|
|
]
|
|
}
|
|
}
|
|
]
|
|
}
|
|
],
|
|
"root_link": "Board",
|
|
"root_pose": {
|
|
"reason": "kabsch",
|
|
"used_markers": [
|
|
210,
|
|
211,
|
|
214,
|
|
208,
|
|
206,
|
|
205,
|
|
207,
|
|
217,
|
|
46,
|
|
47,
|
|
51,
|
|
53,
|
|
54,
|
|
55,
|
|
56,
|
|
58,
|
|
60,
|
|
61,
|
|
62,
|
|
63,
|
|
64,
|
|
66,
|
|
68,
|
|
69,
|
|
72,
|
|
75,
|
|
79,
|
|
83,
|
|
84,
|
|
85,
|
|
86,
|
|
92,
|
|
95,
|
|
96,
|
|
97,
|
|
102,
|
|
103,
|
|
105
|
|
]
|
|
},
|
|
"marker_stats": {
|
|
"num_markers_used": 41,
|
|
"mean_error_m": 0.001485899654143669,
|
|
"rms_error_m": 0.004619024198663144,
|
|
"median_error_m": 0.0002879790512033235,
|
|
"worst_error_m": 0.020490623031860618
|
|
},
|
|
"marker_reports": [
|
|
{
|
|
"marker_id": 46,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.0002349615114914938,
|
|
0.00015668342864044726,
|
|
-0.0001259912279549802
|
|
],
|
|
"error_norm_m": 0.00030924165019365887,
|
|
"predicted_m": [
|
|
0.5367195119155588,
|
|
0.1854673171842678,
|
|
-0.027365875937603024
|
|
],
|
|
"observed_m": [
|
|
0.5364845504040673,
|
|
0.18531063375562734,
|
|
-0.027239884709648044
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 47,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.00012732899483491877,
|
|
-5.799329427630395e-05,
|
|
1.924752446606781e-05
|
|
],
|
|
"error_norm_m": 0.0001412315910296299,
|
|
"predicted_m": [
|
|
0.3442515466957362,
|
|
-0.2865175889498893,
|
|
-0.027326560902454024
|
|
],
|
|
"observed_m": [
|
|
0.3441242177009013,
|
|
-0.286459595655613,
|
|
-0.027345808426920092
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 51,
|
|
"link": "Board",
|
|
"error_m": [
|
|
2.5002305310467543e-05,
|
|
-0.0001781786598451518,
|
|
0.0002356338359271043
|
|
],
|
|
"error_norm_m": 0.00029647268799802394,
|
|
"predicted_m": [
|
|
0.16781864041926398,
|
|
-0.17206208689095145,
|
|
-0.027262285914736742
|
|
],
|
|
"observed_m": [
|
|
0.1677936381139535,
|
|
-0.1718839082311063,
|
|
-0.027497919750663846
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 53,
|
|
"link": "Board",
|
|
"error_m": [
|
|
4.311484450875147e-05,
|
|
0.0001219033354848964,
|
|
-5.0934578651556234e-05
|
|
],
|
|
"error_norm_m": 0.00013897353820698595,
|
|
"predicted_m": [
|
|
0.48625883193515085,
|
|
0.212266030756954,
|
|
-0.027347799323216238
|
|
],
|
|
"observed_m": [
|
|
0.4862157170906421,
|
|
0.2121441274214691,
|
|
-0.02729686474456468
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 54,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-9.817805455741846e-05,
|
|
2.771757417896481e-05,
|
|
-0.0001554387379465623
|
|
],
|
|
"error_norm_m": 0.00018592577973338155,
|
|
"predicted_m": [
|
|
0.3422926690235092,
|
|
-0.33056763884343365,
|
|
-0.02732818617259379
|
|
],
|
|
"observed_m": [
|
|
0.3423908470780666,
|
|
-0.3305953564176126,
|
|
-0.02717274743464723
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 55,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-4.646309691153094e-05,
|
|
0.00011461791271893951,
|
|
-2.911029746227589e-05
|
|
],
|
|
"error_norm_m": 0.00012705705296833756,
|
|
"predicted_m": [
|
|
0.2837409396205222,
|
|
-0.26255913157837046,
|
|
-0.027305306110488176
|
|
],
|
|
"observed_m": [
|
|
0.28378740271743375,
|
|
-0.2626737494910894,
|
|
-0.0272761958130259
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 56,
|
|
"link": "Board",
|
|
"error_m": [
|
|
7.157107208066726e-05,
|
|
-4.343440578741253e-05,
|
|
-6.002492171629584e-05
|
|
],
|
|
"error_norm_m": 0.00010301435430040382,
|
|
"predicted_m": [
|
|
0.4986899412422986,
|
|
0.16869634770863443,
|
|
-0.027354160354534435
|
|
],
|
|
"observed_m": [
|
|
0.49861837017021793,
|
|
0.16873978211442184,
|
|
-0.02729413543281814
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 58,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.000117785210174505,
|
|
-7.506518709762822e-05,
|
|
0.00010565440482662378
|
|
],
|
|
"error_norm_m": 0.00017513135444323597,
|
|
"predicted_m": [
|
|
0.0501098195612705,
|
|
-0.2180950876100421,
|
|
-0.027225720671569812
|
|
],
|
|
"observed_m": [
|
|
0.049992034351096,
|
|
-0.21802002242294446,
|
|
-0.027331375076396436
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 60,
|
|
"link": "Board",
|
|
"error_m": [
|
|
4.6091127460679004e-05,
|
|
0.00012296576925469038,
|
|
-9.63688719735449e-05
|
|
],
|
|
"error_norm_m": 0.0001628862545595785,
|
|
"predicted_m": [
|
|
0.4343670114708244,
|
|
0.28383470780030956,
|
|
-0.027326938786685143
|
|
],
|
|
"observed_m": [
|
|
0.4343209203433637,
|
|
0.28371174203105487,
|
|
-0.027230569914711598
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 61,
|
|
"link": "Board",
|
|
"error_m": [
|
|
3.826282862401387e-05,
|
|
-0.0003516359981929895,
|
|
0.0002587877214122111
|
|
],
|
|
"error_norm_m": 0.0004382727507308833,
|
|
"predicted_m": [
|
|
-0.02241428864890438,
|
|
0.3358430629660432,
|
|
-0.02717314059011313
|
|
],
|
|
"observed_m": [
|
|
-0.022452551477528393,
|
|
0.3361946989642362,
|
|
-0.02743192831152534
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 62,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-2.6262416238764796e-05,
|
|
-7.185559078998205e-05,
|
|
0.00010104090012797926
|
|
],
|
|
"error_norm_m": 0.00012673675052307347,
|
|
"predicted_m": [
|
|
0.4047187043163543,
|
|
-0.17507604756543904,
|
|
-0.02734081366254396
|
|
],
|
|
"observed_m": [
|
|
0.4047449667325931,
|
|
-0.17500419197464906,
|
|
-0.02744185456267194
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 63,
|
|
"link": "Board",
|
|
"error_m": [
|
|
7.293811865860533e-05,
|
|
0.00010826098859434419,
|
|
0.00016598891563280802
|
|
],
|
|
"error_norm_m": 0.00021116991006731278,
|
|
"predicted_m": [
|
|
0.7774202391131195,
|
|
-0.23611654617787844,
|
|
-0.02746726238912407
|
|
],
|
|
"observed_m": [
|
|
0.7773473009944609,
|
|
-0.2362248071664728,
|
|
-0.027633251304756877
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 64,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.00015111634821513356,
|
|
4.722372440330025e-05,
|
|
-8.129817707427933e-05
|
|
],
|
|
"error_norm_m": 0.0001779764715910427,
|
|
"predicted_m": [
|
|
-0.021250937734886084,
|
|
-0.1882169068486999,
|
|
-0.027200570888286636
|
|
],
|
|
"observed_m": [
|
|
-0.021402054083101217,
|
|
-0.1882641305731032,
|
|
-0.027119272711212356
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 66,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.00014556683966213124,
|
|
0.00013175477727478402,
|
|
5.248050415927047e-05
|
|
],
|
|
"error_norm_m": 0.00020323195974245725,
|
|
"predicted_m": [
|
|
0.20977350785648521,
|
|
-0.3632110171378375,
|
|
-0.02728603030960838
|
|
],
|
|
"observed_m": [
|
|
0.20991907469614735,
|
|
-0.3633427719151123,
|
|
-0.02733851081376765
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 68,
|
|
"link": "Board",
|
|
"error_m": [
|
|
1.329565083085793e-05,
|
|
0.0001496115239607021,
|
|
-2.9227526593091774e-05
|
|
],
|
|
"error_norm_m": 0.00015301840001650038,
|
|
"predicted_m": [
|
|
0.5737398869232279,
|
|
0.17066826096414772,
|
|
-0.027378886905260726
|
|
],
|
|
"observed_m": [
|
|
0.573726591272397,
|
|
0.17051864944018702,
|
|
-0.027349659378667634
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 69,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.00013931102659766204,
|
|
-0.00023685278975271729,
|
|
-0.00028937407540049337
|
|
],
|
|
"error_norm_m": 0.0003990540836268059,
|
|
"predicted_m": [
|
|
0.007631429438237455,
|
|
-0.2811961704533154,
|
|
-0.027214924294788004
|
|
],
|
|
"observed_m": [
|
|
0.007492118411639793,
|
|
-0.2809593176635627,
|
|
-0.02692555021938751
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 72,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.00011278626593902441,
|
|
0.00018193020076326394,
|
|
-0.00024717087184187095
|
|
],
|
|
"error_norm_m": 0.00032697519725707094,
|
|
"predicted_m": [
|
|
0.4409992909573329,
|
|
0.1943448769679565,
|
|
-0.027333751251278442
|
|
],
|
|
"observed_m": [
|
|
0.4408865046913939,
|
|
0.19416294676719323,
|
|
-0.02708658037943657
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 75,
|
|
"link": "Board",
|
|
"error_m": [
|
|
8.497735512607088e-05,
|
|
0.00020440251288081357,
|
|
-5.75926108101199e-06
|
|
],
|
|
"error_norm_m": 0.0002214378180086066,
|
|
"predicted_m": [
|
|
-0.025690689976676957,
|
|
0.19459297958260158,
|
|
-0.02717934624432427
|
|
],
|
|
"observed_m": [
|
|
-0.025775667331803028,
|
|
0.19438857706972076,
|
|
-0.027173586983243257
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 79,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.00016311977369909414,
|
|
-0.0004925545248772312,
|
|
0.0002513309295392556
|
|
],
|
|
"error_norm_m": 0.00057652862608178,
|
|
"predicted_m": [
|
|
0.31231830204067745,
|
|
-0.15908840315636516,
|
|
-0.02730942031779327
|
|
],
|
|
"observed_m": [
|
|
0.31248142181437655,
|
|
-0.15859584863148793,
|
|
-0.027560751247332524
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 83,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-3.6114812799852014e-05,
|
|
-7.152473442950669e-05,
|
|
0.00010185016936970284
|
|
],
|
|
"error_norm_m": 0.0001295898311574522,
|
|
"predicted_m": [
|
|
0.04416562132228359,
|
|
0.33923476029246413,
|
|
-0.027194991779000102
|
|
],
|
|
"observed_m": [
|
|
0.04420173613508344,
|
|
0.33930628502689364,
|
|
-0.027296841948369805
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 84,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.00018840001710418441,
|
|
6.316300073511139e-05,
|
|
-0.00012546955124030298
|
|
],
|
|
"error_norm_m": 0.00023500370081163335,
|
|
"predicted_m": [
|
|
0.40749765978677,
|
|
0.2584440228421935,
|
|
-0.027319360112983547
|
|
],
|
|
"observed_m": [
|
|
0.4073092597696658,
|
|
0.25838085984145837,
|
|
-0.027193890561743244
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 85,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.00021940403520182006,
|
|
-0.00010608720313082243,
|
|
0.00011294370432046036
|
|
],
|
|
"error_norm_m": 0.00026860548333306497,
|
|
"predicted_m": [
|
|
0.5046022055961901,
|
|
-0.3127235010844192,
|
|
-0.027380961156030784
|
|
],
|
|
"observed_m": [
|
|
0.5043828015609882,
|
|
-0.3126174138812884,
|
|
-0.027493904860351245
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 86,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.00047058945989419954,
|
|
-0.0003360655813351432,
|
|
8.013435935129778e-05
|
|
],
|
|
"error_norm_m": 0.0005837945103118777,
|
|
"predicted_m": [
|
|
0.36289680650142736,
|
|
0.29203288579332376,
|
|
-0.02730287164660969
|
|
],
|
|
"observed_m": [
|
|
0.36336739596132156,
|
|
0.2923689513746589,
|
|
-0.027383006005960987
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 92,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.00020266729198603617,
|
|
0.000305431232893949,
|
|
-0.00025165142263110923
|
|
],
|
|
"error_norm_m": 0.00044462423211104015,
|
|
"predicted_m": [
|
|
0.6451089392203692,
|
|
-0.18480991925779974,
|
|
-0.027420842840283944
|
|
],
|
|
"observed_m": [
|
|
0.6453116065123552,
|
|
-0.1851153504906937,
|
|
-0.027169191417652835
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 95,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.00015200367720094587,
|
|
0.00013220845193662178,
|
|
7.894740213724993e-06
|
|
],
|
|
"error_norm_m": 0.00020160982012077088,
|
|
"predicted_m": [
|
|
0.1860612377172705,
|
|
-0.2740516217274548,
|
|
-0.02727358442872227
|
|
],
|
|
"observed_m": [
|
|
0.18590923404006957,
|
|
-0.2741838301793914,
|
|
-0.027281479168935995
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 96,
|
|
"link": "Board",
|
|
"error_m": [
|
|
2.272196202024457e-06,
|
|
1.8525600383234586e-05,
|
|
-4.328326801212104e-05
|
|
],
|
|
"error_norm_m": 4.713599510935243e-05,
|
|
"predicted_m": [
|
|
0.36978899641131513,
|
|
-0.186466938021308,
|
|
-0.027329845935668205
|
|
],
|
|
"observed_m": [
|
|
0.3697867242151131,
|
|
-0.18648546362169124,
|
|
-0.027286562667656084
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 97,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.00018156628147059095,
|
|
0.00010132708738785912,
|
|
-0.00017441529452839194
|
|
],
|
|
"error_norm_m": 0.00027139305107351297,
|
|
"predicted_m": [
|
|
0.30437341195433554,
|
|
-0.35964860549443073,
|
|
-0.02731714237229305
|
|
],
|
|
"observed_m": [
|
|
0.30419184567286495,
|
|
-0.3597499325818186,
|
|
-0.027142727077764658
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 102,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.0001337222936853566,
|
|
-0.00017176958878606374,
|
|
0.0003727718196989589
|
|
],
|
|
"error_norm_m": 0.0004316772787880772,
|
|
"predicted_m": [
|
|
0.6497099111331173,
|
|
-0.2229698019262238,
|
|
-0.027424334288588693
|
|
],
|
|
"observed_m": [
|
|
0.6498436334268026,
|
|
-0.22279803233743772,
|
|
-0.02779710610828765
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 103,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.00024461240522352656,
|
|
-1.3660640967222415e-05,
|
|
0.0001832169914290742
|
|
],
|
|
"error_norm_m": 0.00030592533051252156,
|
|
"predicted_m": [
|
|
0.10572904202773449,
|
|
-0.1876936697329793,
|
|
-0.027242551898373216
|
|
],
|
|
"observed_m": [
|
|
0.10597365443295802,
|
|
-0.18768000909201207,
|
|
-0.02742576888980229
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 105,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.0002086134292065278,
|
|
0.00025686280929770877,
|
|
-0.0003005269755976016
|
|
],
|
|
"error_norm_m": 0.0004470061841937531,
|
|
"predicted_m": [
|
|
0.5248610198447461,
|
|
-0.26622298467080807,
|
|
-0.027385263479919743
|
|
],
|
|
"observed_m": [
|
|
0.5246524064155396,
|
|
-0.2664798474801058,
|
|
-0.02708473650432214
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 198,
|
|
"link": "Arm1",
|
|
"error_m": [
|
|
0.0002091854677865601,
|
|
0.0024387112604260866,
|
|
0.011298616645354281
|
|
],
|
|
"error_norm_m": 0.011560701071749018,
|
|
"predicted_m": [
|
|
0.17009597012774877,
|
|
-0.05064210823197354,
|
|
0.10171375881199295
|
|
],
|
|
"observed_m": [
|
|
0.1698867846599622,
|
|
-0.05308081949239963,
|
|
0.09041514216663867
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 205,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-4.235671266172858e-05,
|
|
1.224300529410749e-05,
|
|
-0.00022510469191217974
|
|
],
|
|
"error_norm_m": 0.0002293820058483602,
|
|
"predicted_m": [
|
|
0.7500256480364245,
|
|
-0.08996866929891865,
|
|
0.00014934427268465446
|
|
],
|
|
"observed_m": [
|
|
0.7500680047490862,
|
|
-0.08998091230421276,
|
|
0.0003744489645968342
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 206,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.00016362638483158332,
|
|
-0.0002411824815486928,
|
|
-3.867689095405727e-05
|
|
],
|
|
"error_norm_m": 0.000294004226352124,
|
|
"predicted_m": [
|
|
0.6500236154573182,
|
|
-0.009971218743609081,
|
|
0.00018655580564254162
|
|
],
|
|
"observed_m": [
|
|
0.6498599890724867,
|
|
-0.009730036262060388,
|
|
0.00022523269659659889
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 207,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.0006257862857207419,
|
|
-0.00040162321572383315,
|
|
0.00046249918392821706
|
|
],
|
|
"error_norm_m": 0.000875679837576943,
|
|
"predicted_m": [
|
|
0.7500236099526444,
|
|
-0.009968669431448071,
|
|
0.00015347354829645877
|
|
],
|
|
"observed_m": [
|
|
0.7506493962383651,
|
|
-0.009567046215724238,
|
|
-0.00030902563563175826
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 208,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.000250411140637119,
|
|
-0.00012099942338547609,
|
|
0.00020120955593573236
|
|
],
|
|
"error_norm_m": 0.00034326649299728525,
|
|
"predicted_m": [
|
|
0.35002567005511986,
|
|
-0.0899788665475627,
|
|
0.0002816733020689859
|
|
],
|
|
"observed_m": [
|
|
0.350276081195757,
|
|
-0.08985786712417722,
|
|
8.046374613325354e-05
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 210,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-2.488253005104163e-05,
|
|
0.00030323665402359756,
|
|
-4.706239938880063e-05
|
|
],
|
|
"error_norm_m": 0.00030787412700874844,
|
|
"predicted_m": [
|
|
0.020023904897235986,
|
|
-0.019987279393657263,
|
|
0.0003944578674713881
|
|
],
|
|
"observed_m": [
|
|
0.020048787427287027,
|
|
-0.02029051604768086,
|
|
0.0004415202668601887
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 211,
|
|
"link": "Board",
|
|
"error_m": [
|
|
4.897894727723395e-05,
|
|
0.0003719092326030897,
|
|
4.969175870566116e-06
|
|
],
|
|
"error_norm_m": 0.0003751534449803677,
|
|
"predicted_m": [
|
|
0.25002363747601364,
|
|
-0.009981415992253117,
|
|
0.000318884835026873
|
|
],
|
|
"observed_m": [
|
|
0.2499746585287364,
|
|
-0.010353325224856207,
|
|
0.0003139156591563069
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 214,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.0001505229522955065,
|
|
0.00031186268781910505,
|
|
-0.0003766180798008118
|
|
],
|
|
"error_norm_m": 0.0005116216114027656,
|
|
"predicted_m": [
|
|
0.35002363197133984,
|
|
-0.009978866680092107,
|
|
0.0002858025776807902
|
|
],
|
|
"observed_m": [
|
|
0.34987310901904434,
|
|
-0.010290729367911212,
|
|
0.000662420657481602
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 217,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-8.319746691320962e-05,
|
|
-0.0002733581906032706,
|
|
3.58526855521005e-05
|
|
],
|
|
"error_norm_m": 0.0002879790512033235,
|
|
"predicted_m": [
|
|
0.6500256535410983,
|
|
-0.08997121861107966,
|
|
0.0001824265300307373
|
|
],
|
|
"observed_m": [
|
|
0.6501088510080115,
|
|
-0.0896978604204764,
|
|
0.0001465738444786368
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 229,
|
|
"link": "Arm1",
|
|
"error_m": [
|
|
-0.00010596151586425573,
|
|
0.002472978032885903,
|
|
0.01763200470258193
|
|
],
|
|
"error_norm_m": 0.017804899270309052,
|
|
"predicted_m": [
|
|
0.17009932086310622,
|
|
-0.14058529046733978,
|
|
0.10491125129020834
|
|
],
|
|
"observed_m": [
|
|
0.17020528237897048,
|
|
-0.14305826850022568,
|
|
0.08727924658762641
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 243,
|
|
"link": "Arm1",
|
|
"error_m": [
|
|
-8.700929245814004e-05,
|
|
0.00034412655378859847,
|
|
0.020487548377778643
|
|
],
|
|
"error_norm_m": 0.020490623031860618,
|
|
"predicted_m": [
|
|
0.17008908414648774,
|
|
-0.1768066643297,
|
|
0.07117681827685006
|
|
],
|
|
"observed_m": [
|
|
0.17017609343894588,
|
|
-0.1771507908834886,
|
|
0.05068926989907142
|
|
]
|
|
}
|
|
],
|
|
"stage_idx": 0,
|
|
"num_active_links": 3
|
|
},
|
|
{
|
|
"method": "deterministic_geometric_prefix",
|
|
"active_links": [
|
|
"Board",
|
|
"Base",
|
|
"Arm1",
|
|
"Ellbow"
|
|
],
|
|
"active_observations": 45,
|
|
"joint_updates": [
|
|
{
|
|
"pass": 0,
|
|
"updates": [
|
|
{
|
|
"link": "Base",
|
|
"joint_variable": "x",
|
|
"joint_type": "linear",
|
|
"old": 0.06003775677043583,
|
|
"new": 0.05997663332269708,
|
|
"info": {
|
|
"reason": "weighted_projection",
|
|
"used_markers": 7,
|
|
"axis_world": [
|
|
0.9999999449522614,
|
|
2.549312161006467e-05,
|
|
-0.00033082257346049777
|
|
],
|
|
"per_marker": [
|
|
{
|
|
"marker_id": 198,
|
|
"q_i": 0.059832246981116805,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 229,
|
|
"q_i": 0.060149488301588325,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 243,
|
|
"q_i": 0.06013153502860237,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 244,
|
|
"q_i": 0.060319402473584305,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 245,
|
|
"q_i": 0.05981759751295834,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 248,
|
|
"q_i": 0.060057979442251344,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 232,
|
|
"q_i": 0.059528183518778074,
|
|
"weight": 1.0
|
|
}
|
|
]
|
|
}
|
|
},
|
|
{
|
|
"link": "Arm1",
|
|
"joint_variable": "y",
|
|
"joint_type": "revolute",
|
|
"old": 0.03558679028775913,
|
|
"new": -0.016401997541838576,
|
|
"info": {
|
|
"reason": "2d_alignment+normal_tiebreak",
|
|
"used_markers": 7,
|
|
"axis_world": [
|
|
-0.9999999449522614,
|
|
-2.549312161006467e-05,
|
|
0.00033082257346049777
|
|
],
|
|
"axis_id": 0,
|
|
"theta_rad": -0.01640199754183871,
|
|
"theta_alt_rad": 3.1251906560479545,
|
|
"score_theta": 0.007311887735359932,
|
|
"score_theta_alt": 1.9678416452840728,
|
|
"best_score": 0.007311887735359932,
|
|
"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.6337426600428957,
|
|
"info": {
|
|
"reason": "2d_alignment+normal_tiebreak",
|
|
"used_markers": 3,
|
|
"axis_world": [
|
|
-0.9999999449522614,
|
|
-2.549312161006467e-05,
|
|
0.00033082257346049777
|
|
],
|
|
"axis_id": 0,
|
|
"theta_rad": -1.5078499935468974,
|
|
"theta_alt_rad": 1.6337426600428957,
|
|
"score_theta": 0.19435694358467945,
|
|
"score_theta_alt": 0.12107812808993719,
|
|
"best_score": 0.12107812808993719,
|
|
"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.05997663332269708,
|
|
"new": 0.0599766333228056,
|
|
"info": {
|
|
"reason": "weighted_projection",
|
|
"used_markers": 7,
|
|
"axis_world": [
|
|
0.9999999449522614,
|
|
2.549312161006467e-05,
|
|
-0.00033082257346049777
|
|
],
|
|
"per_marker": [
|
|
{
|
|
"marker_id": 198,
|
|
"q_i": 0.059832246981116805,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 229,
|
|
"q_i": 0.06014948830158833,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 243,
|
|
"q_i": 0.06013153502860238,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 244,
|
|
"q_i": 0.060319402473849884,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 245,
|
|
"q_i": 0.0598175975131496,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 248,
|
|
"q_i": 0.06005797944236288,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 232,
|
|
"q_i": 0.05952818351896931,
|
|
"weight": 1.0
|
|
}
|
|
]
|
|
}
|
|
},
|
|
{
|
|
"link": "Arm1",
|
|
"joint_variable": "y",
|
|
"joint_type": "revolute",
|
|
"old": -0.016401997541838576,
|
|
"new": 0.03511567816650496,
|
|
"info": {
|
|
"reason": "2d_alignment+normal_tiebreak",
|
|
"used_markers": 7,
|
|
"axis_world": [
|
|
-0.9999999449522614,
|
|
-2.549312161006467e-05,
|
|
0.00033082257346049777
|
|
],
|
|
"axis_id": 0,
|
|
"theta_rad": 0.035115678166504766,
|
|
"theta_alt_rad": -3.1064769754232877,
|
|
"score_theta": 0.0024005395238096776,
|
|
"score_theta_alt": 2.093622237447361,
|
|
"best_score": 0.0024005395238096776,
|
|
"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.6337426600428957,
|
|
"new": -1.1847017752245022,
|
|
"info": {
|
|
"reason": "2d_alignment+normal_tiebreak",
|
|
"used_markers": 3,
|
|
"axis_world": [
|
|
-0.9999999449522614,
|
|
-2.549312161006467e-05,
|
|
0.00033082257346049777
|
|
],
|
|
"axis_id": 0,
|
|
"theta_rad": -1.1847017752245022,
|
|
"theta_alt_rad": 1.9568908783652912,
|
|
"score_theta": 0.14272179723876574,
|
|
"score_theta_alt": 0.17618239406565278,
|
|
"best_score": 0.14272179723876574,
|
|
"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,
|
|
214,
|
|
208,
|
|
206,
|
|
205,
|
|
207,
|
|
217,
|
|
46,
|
|
47,
|
|
51,
|
|
53,
|
|
54,
|
|
55,
|
|
56,
|
|
58,
|
|
60,
|
|
61,
|
|
62,
|
|
63,
|
|
64,
|
|
66,
|
|
68,
|
|
69,
|
|
72,
|
|
75,
|
|
79,
|
|
83,
|
|
84,
|
|
85,
|
|
86,
|
|
92,
|
|
95,
|
|
96,
|
|
97,
|
|
102,
|
|
103,
|
|
105
|
|
]
|
|
},
|
|
"marker_stats": {
|
|
"num_markers_used": 45,
|
|
"mean_error_m": 0.006515383803657211,
|
|
"rms_error_m": 0.0192382418507412,
|
|
"median_error_m": 0.00029647268799802394,
|
|
"worst_error_m": 0.08014251257613057
|
|
},
|
|
"marker_reports": [
|
|
{
|
|
"marker_id": 46,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.0002349615114914938,
|
|
0.00015668342864044726,
|
|
-0.0001259912279549802
|
|
],
|
|
"error_norm_m": 0.00030924165019365887,
|
|
"predicted_m": [
|
|
0.5367195119155588,
|
|
0.1854673171842678,
|
|
-0.027365875937603024
|
|
],
|
|
"observed_m": [
|
|
0.5364845504040673,
|
|
0.18531063375562734,
|
|
-0.027239884709648044
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 47,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.00012732899483491877,
|
|
-5.799329427630395e-05,
|
|
1.924752446606781e-05
|
|
],
|
|
"error_norm_m": 0.0001412315910296299,
|
|
"predicted_m": [
|
|
0.3442515466957362,
|
|
-0.2865175889498893,
|
|
-0.027326560902454024
|
|
],
|
|
"observed_m": [
|
|
0.3441242177009013,
|
|
-0.286459595655613,
|
|
-0.027345808426920092
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 51,
|
|
"link": "Board",
|
|
"error_m": [
|
|
2.5002305310467543e-05,
|
|
-0.0001781786598451518,
|
|
0.0002356338359271043
|
|
],
|
|
"error_norm_m": 0.00029647268799802394,
|
|
"predicted_m": [
|
|
0.16781864041926398,
|
|
-0.17206208689095145,
|
|
-0.027262285914736742
|
|
],
|
|
"observed_m": [
|
|
0.1677936381139535,
|
|
-0.1718839082311063,
|
|
-0.027497919750663846
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 53,
|
|
"link": "Board",
|
|
"error_m": [
|
|
4.311484450875147e-05,
|
|
0.0001219033354848964,
|
|
-5.0934578651556234e-05
|
|
],
|
|
"error_norm_m": 0.00013897353820698595,
|
|
"predicted_m": [
|
|
0.48625883193515085,
|
|
0.212266030756954,
|
|
-0.027347799323216238
|
|
],
|
|
"observed_m": [
|
|
0.4862157170906421,
|
|
0.2121441274214691,
|
|
-0.02729686474456468
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 54,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-9.817805455741846e-05,
|
|
2.771757417896481e-05,
|
|
-0.0001554387379465623
|
|
],
|
|
"error_norm_m": 0.00018592577973338155,
|
|
"predicted_m": [
|
|
0.3422926690235092,
|
|
-0.33056763884343365,
|
|
-0.02732818617259379
|
|
],
|
|
"observed_m": [
|
|
0.3423908470780666,
|
|
-0.3305953564176126,
|
|
-0.02717274743464723
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 55,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-4.646309691153094e-05,
|
|
0.00011461791271893951,
|
|
-2.911029746227589e-05
|
|
],
|
|
"error_norm_m": 0.00012705705296833756,
|
|
"predicted_m": [
|
|
0.2837409396205222,
|
|
-0.26255913157837046,
|
|
-0.027305306110488176
|
|
],
|
|
"observed_m": [
|
|
0.28378740271743375,
|
|
-0.2626737494910894,
|
|
-0.0272761958130259
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 56,
|
|
"link": "Board",
|
|
"error_m": [
|
|
7.157107208066726e-05,
|
|
-4.343440578741253e-05,
|
|
-6.002492171629584e-05
|
|
],
|
|
"error_norm_m": 0.00010301435430040382,
|
|
"predicted_m": [
|
|
0.4986899412422986,
|
|
0.16869634770863443,
|
|
-0.027354160354534435
|
|
],
|
|
"observed_m": [
|
|
0.49861837017021793,
|
|
0.16873978211442184,
|
|
-0.02729413543281814
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 58,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.000117785210174505,
|
|
-7.506518709762822e-05,
|
|
0.00010565440482662378
|
|
],
|
|
"error_norm_m": 0.00017513135444323597,
|
|
"predicted_m": [
|
|
0.0501098195612705,
|
|
-0.2180950876100421,
|
|
-0.027225720671569812
|
|
],
|
|
"observed_m": [
|
|
0.049992034351096,
|
|
-0.21802002242294446,
|
|
-0.027331375076396436
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 60,
|
|
"link": "Board",
|
|
"error_m": [
|
|
4.6091127460679004e-05,
|
|
0.00012296576925469038,
|
|
-9.63688719735449e-05
|
|
],
|
|
"error_norm_m": 0.0001628862545595785,
|
|
"predicted_m": [
|
|
0.4343670114708244,
|
|
0.28383470780030956,
|
|
-0.027326938786685143
|
|
],
|
|
"observed_m": [
|
|
0.4343209203433637,
|
|
0.28371174203105487,
|
|
-0.027230569914711598
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 61,
|
|
"link": "Board",
|
|
"error_m": [
|
|
3.826282862401387e-05,
|
|
-0.0003516359981929895,
|
|
0.0002587877214122111
|
|
],
|
|
"error_norm_m": 0.0004382727507308833,
|
|
"predicted_m": [
|
|
-0.02241428864890438,
|
|
0.3358430629660432,
|
|
-0.02717314059011313
|
|
],
|
|
"observed_m": [
|
|
-0.022452551477528393,
|
|
0.3361946989642362,
|
|
-0.02743192831152534
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 62,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-2.6262416238764796e-05,
|
|
-7.185559078998205e-05,
|
|
0.00010104090012797926
|
|
],
|
|
"error_norm_m": 0.00012673675052307347,
|
|
"predicted_m": [
|
|
0.4047187043163543,
|
|
-0.17507604756543904,
|
|
-0.02734081366254396
|
|
],
|
|
"observed_m": [
|
|
0.4047449667325931,
|
|
-0.17500419197464906,
|
|
-0.02744185456267194
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 63,
|
|
"link": "Board",
|
|
"error_m": [
|
|
7.293811865860533e-05,
|
|
0.00010826098859434419,
|
|
0.00016598891563280802
|
|
],
|
|
"error_norm_m": 0.00021116991006731278,
|
|
"predicted_m": [
|
|
0.7774202391131195,
|
|
-0.23611654617787844,
|
|
-0.02746726238912407
|
|
],
|
|
"observed_m": [
|
|
0.7773473009944609,
|
|
-0.2362248071664728,
|
|
-0.027633251304756877
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 64,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.00015111634821513356,
|
|
4.722372440330025e-05,
|
|
-8.129817707427933e-05
|
|
],
|
|
"error_norm_m": 0.0001779764715910427,
|
|
"predicted_m": [
|
|
-0.021250937734886084,
|
|
-0.1882169068486999,
|
|
-0.027200570888286636
|
|
],
|
|
"observed_m": [
|
|
-0.021402054083101217,
|
|
-0.1882641305731032,
|
|
-0.027119272711212356
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 66,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.00014556683966213124,
|
|
0.00013175477727478402,
|
|
5.248050415927047e-05
|
|
],
|
|
"error_norm_m": 0.00020323195974245725,
|
|
"predicted_m": [
|
|
0.20977350785648521,
|
|
-0.3632110171378375,
|
|
-0.02728603030960838
|
|
],
|
|
"observed_m": [
|
|
0.20991907469614735,
|
|
-0.3633427719151123,
|
|
-0.02733851081376765
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 68,
|
|
"link": "Board",
|
|
"error_m": [
|
|
1.329565083085793e-05,
|
|
0.0001496115239607021,
|
|
-2.9227526593091774e-05
|
|
],
|
|
"error_norm_m": 0.00015301840001650038,
|
|
"predicted_m": [
|
|
0.5737398869232279,
|
|
0.17066826096414772,
|
|
-0.027378886905260726
|
|
],
|
|
"observed_m": [
|
|
0.573726591272397,
|
|
0.17051864944018702,
|
|
-0.027349659378667634
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 69,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.00013931102659766204,
|
|
-0.00023685278975271729,
|
|
-0.00028937407540049337
|
|
],
|
|
"error_norm_m": 0.0003990540836268059,
|
|
"predicted_m": [
|
|
0.007631429438237455,
|
|
-0.2811961704533154,
|
|
-0.027214924294788004
|
|
],
|
|
"observed_m": [
|
|
0.007492118411639793,
|
|
-0.2809593176635627,
|
|
-0.02692555021938751
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 72,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.00011278626593902441,
|
|
0.00018193020076326394,
|
|
-0.00024717087184187095
|
|
],
|
|
"error_norm_m": 0.00032697519725707094,
|
|
"predicted_m": [
|
|
0.4409992909573329,
|
|
0.1943448769679565,
|
|
-0.027333751251278442
|
|
],
|
|
"observed_m": [
|
|
0.4408865046913939,
|
|
0.19416294676719323,
|
|
-0.02708658037943657
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 75,
|
|
"link": "Board",
|
|
"error_m": [
|
|
8.497735512607088e-05,
|
|
0.00020440251288081357,
|
|
-5.75926108101199e-06
|
|
],
|
|
"error_norm_m": 0.0002214378180086066,
|
|
"predicted_m": [
|
|
-0.025690689976676957,
|
|
0.19459297958260158,
|
|
-0.02717934624432427
|
|
],
|
|
"observed_m": [
|
|
-0.025775667331803028,
|
|
0.19438857706972076,
|
|
-0.027173586983243257
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 79,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.00016311977369909414,
|
|
-0.0004925545248772312,
|
|
0.0002513309295392556
|
|
],
|
|
"error_norm_m": 0.00057652862608178,
|
|
"predicted_m": [
|
|
0.31231830204067745,
|
|
-0.15908840315636516,
|
|
-0.02730942031779327
|
|
],
|
|
"observed_m": [
|
|
0.31248142181437655,
|
|
-0.15859584863148793,
|
|
-0.027560751247332524
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 83,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-3.6114812799852014e-05,
|
|
-7.152473442950669e-05,
|
|
0.00010185016936970284
|
|
],
|
|
"error_norm_m": 0.0001295898311574522,
|
|
"predicted_m": [
|
|
0.04416562132228359,
|
|
0.33923476029246413,
|
|
-0.027194991779000102
|
|
],
|
|
"observed_m": [
|
|
0.04420173613508344,
|
|
0.33930628502689364,
|
|
-0.027296841948369805
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 84,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.00018840001710418441,
|
|
6.316300073511139e-05,
|
|
-0.00012546955124030298
|
|
],
|
|
"error_norm_m": 0.00023500370081163335,
|
|
"predicted_m": [
|
|
0.40749765978677,
|
|
0.2584440228421935,
|
|
-0.027319360112983547
|
|
],
|
|
"observed_m": [
|
|
0.4073092597696658,
|
|
0.25838085984145837,
|
|
-0.027193890561743244
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 85,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.00021940403520182006,
|
|
-0.00010608720313082243,
|
|
0.00011294370432046036
|
|
],
|
|
"error_norm_m": 0.00026860548333306497,
|
|
"predicted_m": [
|
|
0.5046022055961901,
|
|
-0.3127235010844192,
|
|
-0.027380961156030784
|
|
],
|
|
"observed_m": [
|
|
0.5043828015609882,
|
|
-0.3126174138812884,
|
|
-0.027493904860351245
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 86,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.00047058945989419954,
|
|
-0.0003360655813351432,
|
|
8.013435935129778e-05
|
|
],
|
|
"error_norm_m": 0.0005837945103118777,
|
|
"predicted_m": [
|
|
0.36289680650142736,
|
|
0.29203288579332376,
|
|
-0.02730287164660969
|
|
],
|
|
"observed_m": [
|
|
0.36336739596132156,
|
|
0.2923689513746589,
|
|
-0.027383006005960987
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 92,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.00020266729198603617,
|
|
0.000305431232893949,
|
|
-0.00025165142263110923
|
|
],
|
|
"error_norm_m": 0.00044462423211104015,
|
|
"predicted_m": [
|
|
0.6451089392203692,
|
|
-0.18480991925779974,
|
|
-0.027420842840283944
|
|
],
|
|
"observed_m": [
|
|
0.6453116065123552,
|
|
-0.1851153504906937,
|
|
-0.027169191417652835
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 95,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.00015200367720094587,
|
|
0.00013220845193662178,
|
|
7.894740213724993e-06
|
|
],
|
|
"error_norm_m": 0.00020160982012077088,
|
|
"predicted_m": [
|
|
0.1860612377172705,
|
|
-0.2740516217274548,
|
|
-0.02727358442872227
|
|
],
|
|
"observed_m": [
|
|
0.18590923404006957,
|
|
-0.2741838301793914,
|
|
-0.027281479168935995
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 96,
|
|
"link": "Board",
|
|
"error_m": [
|
|
2.272196202024457e-06,
|
|
1.8525600383234586e-05,
|
|
-4.328326801212104e-05
|
|
],
|
|
"error_norm_m": 4.713599510935243e-05,
|
|
"predicted_m": [
|
|
0.36978899641131513,
|
|
-0.186466938021308,
|
|
-0.027329845935668205
|
|
],
|
|
"observed_m": [
|
|
0.3697867242151131,
|
|
-0.18648546362169124,
|
|
-0.027286562667656084
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 97,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.00018156628147059095,
|
|
0.00010132708738785912,
|
|
-0.00017441529452839194
|
|
],
|
|
"error_norm_m": 0.00027139305107351297,
|
|
"predicted_m": [
|
|
0.30437341195433554,
|
|
-0.35964860549443073,
|
|
-0.02731714237229305
|
|
],
|
|
"observed_m": [
|
|
0.30419184567286495,
|
|
-0.3597499325818186,
|
|
-0.027142727077764658
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 102,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.0001337222936853566,
|
|
-0.00017176958878606374,
|
|
0.0003727718196989589
|
|
],
|
|
"error_norm_m": 0.0004316772787880772,
|
|
"predicted_m": [
|
|
0.6497099111331173,
|
|
-0.2229698019262238,
|
|
-0.027424334288588693
|
|
],
|
|
"observed_m": [
|
|
0.6498436334268026,
|
|
-0.22279803233743772,
|
|
-0.02779710610828765
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 103,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.00024461240522352656,
|
|
-1.3660640967222415e-05,
|
|
0.0001832169914290742
|
|
],
|
|
"error_norm_m": 0.00030592533051252156,
|
|
"predicted_m": [
|
|
0.10572904202773449,
|
|
-0.1876936697329793,
|
|
-0.027242551898373216
|
|
],
|
|
"observed_m": [
|
|
0.10597365443295802,
|
|
-0.18768000909201207,
|
|
-0.02742576888980229
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 105,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.0002086134292065278,
|
|
0.00025686280929770877,
|
|
-0.0003005269755976016
|
|
],
|
|
"error_norm_m": 0.0004470061841937531,
|
|
"predicted_m": [
|
|
0.5248610198447461,
|
|
-0.26622298467080807,
|
|
-0.027385263479919743
|
|
],
|
|
"observed_m": [
|
|
0.5246524064155396,
|
|
-0.2664798474801058,
|
|
-0.02708473650432214
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 198,
|
|
"link": "Arm1",
|
|
"error_m": [
|
|
0.00014803778275898627,
|
|
0.002419570789628532,
|
|
0.011223887821567913
|
|
],
|
|
"error_norm_m": 0.01148267807709893,
|
|
"predicted_m": [
|
|
0.1700348224427212,
|
|
-0.0506612487027711,
|
|
0.10163902998820658
|
|
],
|
|
"observed_m": [
|
|
0.1698867846599622,
|
|
-0.05308081949239963,
|
|
0.09041514216663867
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 205,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-4.235671266172858e-05,
|
|
1.224300529410749e-05,
|
|
-0.00022510469191217974
|
|
],
|
|
"error_norm_m": 0.0002293820058483602,
|
|
"predicted_m": [
|
|
0.7500256480364245,
|
|
-0.08996866929891865,
|
|
0.00014934427268465446
|
|
],
|
|
"observed_m": [
|
|
0.7500680047490862,
|
|
-0.08998091230421276,
|
|
0.0003744489645968342
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 206,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.00016362638483158332,
|
|
-0.0002411824815486928,
|
|
-3.867689095405727e-05
|
|
],
|
|
"error_norm_m": 0.000294004226352124,
|
|
"predicted_m": [
|
|
0.6500236154573182,
|
|
-0.009971218743609081,
|
|
0.00018655580564254162
|
|
],
|
|
"observed_m": [
|
|
0.6498599890724867,
|
|
-0.009730036262060388,
|
|
0.00022523269659659889
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 207,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.0006257862857207419,
|
|
-0.00040162321572383315,
|
|
0.00046249918392821706
|
|
],
|
|
"error_norm_m": 0.000875679837576943,
|
|
"predicted_m": [
|
|
0.7500236099526444,
|
|
-0.009968669431448071,
|
|
0.00015347354829645877
|
|
],
|
|
"observed_m": [
|
|
0.7506493962383651,
|
|
-0.009567046215724238,
|
|
-0.00030902563563175826
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 208,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.000250411140637119,
|
|
-0.00012099942338547609,
|
|
0.00020120955593573236
|
|
],
|
|
"error_norm_m": 0.00034326649299728525,
|
|
"predicted_m": [
|
|
0.35002567005511986,
|
|
-0.0899788665475627,
|
|
0.0002816733020689859
|
|
],
|
|
"observed_m": [
|
|
0.350276081195757,
|
|
-0.08985786712417722,
|
|
8.046374613325354e-05
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 210,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-2.488253005104163e-05,
|
|
0.00030323665402359756,
|
|
-4.706239938880063e-05
|
|
],
|
|
"error_norm_m": 0.00030787412700874844,
|
|
"predicted_m": [
|
|
0.020023904897235986,
|
|
-0.019987279393657263,
|
|
0.0003944578674713881
|
|
],
|
|
"observed_m": [
|
|
0.020048787427287027,
|
|
-0.02029051604768086,
|
|
0.0004415202668601887
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 211,
|
|
"link": "Board",
|
|
"error_m": [
|
|
4.897894727723395e-05,
|
|
0.0003719092326030897,
|
|
4.969175870566116e-06
|
|
],
|
|
"error_norm_m": 0.0003751534449803677,
|
|
"predicted_m": [
|
|
0.25002363747601364,
|
|
-0.009981415992253117,
|
|
0.000318884835026873
|
|
],
|
|
"observed_m": [
|
|
0.2499746585287364,
|
|
-0.010353325224856207,
|
|
0.0003139156591563069
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 214,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.0001505229522955065,
|
|
0.00031186268781910505,
|
|
-0.0003766180798008118
|
|
],
|
|
"error_norm_m": 0.0005116216114027656,
|
|
"predicted_m": [
|
|
0.35002363197133984,
|
|
-0.009978866680092107,
|
|
0.0002858025776807902
|
|
],
|
|
"observed_m": [
|
|
0.34987310901904434,
|
|
-0.010290729367911212,
|
|
0.000662420657481602
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 217,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-8.319746691320962e-05,
|
|
-0.0002733581906032706,
|
|
3.58526855521005e-05
|
|
],
|
|
"error_norm_m": 0.0002879790512033235,
|
|
"predicted_m": [
|
|
0.6500256535410983,
|
|
-0.08997121861107966,
|
|
0.0001824265300307373
|
|
],
|
|
"observed_m": [
|
|
0.6501088510080115,
|
|
-0.0896978604204764,
|
|
0.0001465738444786368
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 229,
|
|
"link": "Arm1",
|
|
"error_m": [
|
|
-0.00016712318091280376,
|
|
0.0024523411655336114,
|
|
0.017514902204443725
|
|
],
|
|
"error_norm_m": 0.01768654026600445,
|
|
"predicted_m": [
|
|
0.17003815919805768,
|
|
-0.14060592733469207,
|
|
0.10479414879207014
|
|
],
|
|
"observed_m": [
|
|
0.17020528237897048,
|
|
-0.14305826850022568,
|
|
0.08727924658762641
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 232,
|
|
"link": "Ellbow",
|
|
"error_m": [
|
|
0.0004649231841746815,
|
|
0.058909646496287216,
|
|
0.05433470086538196
|
|
],
|
|
"error_norm_m": 0.08014251257613057,
|
|
"predicted_m": [
|
|
0.26002990511079876,
|
|
-0.10912513268250515,
|
|
0.08225488523987194
|
|
],
|
|
"observed_m": [
|
|
0.2595649819266241,
|
|
-0.16803477917879237,
|
|
0.027920184374489978
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 243,
|
|
"link": "Arm1",
|
|
"error_m": [
|
|
-0.00014817700678995682,
|
|
0.00033938640647110385,
|
|
0.020353385296680716
|
|
],
|
|
"error_norm_m": 0.020356753979782174,
|
|
"predicted_m": [
|
|
0.17002791643215592,
|
|
-0.1768114044770175,
|
|
0.07104265519575213
|
|
],
|
|
"observed_m": [
|
|
0.17017609343894588,
|
|
-0.1771507908834886,
|
|
0.05068926989907142
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 244,
|
|
"link": "Ellbow",
|
|
"error_m": [
|
|
-0.00033683408326834474,
|
|
3.266999775047852e-05,
|
|
0.017942908569406855
|
|
],
|
|
"error_norm_m": 0.01794609964472777,
|
|
"predicted_m": [
|
|
0.2950266119240823,
|
|
-0.14182973170218025,
|
|
0.06977431172812265
|
|
],
|
|
"observed_m": [
|
|
0.29536344600735065,
|
|
-0.14186240169993072,
|
|
0.051831403158715796
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 245,
|
|
"link": "Ellbow",
|
|
"error_m": [
|
|
0.00015790586755654035,
|
|
0.06736782947783587,
|
|
0.0017757721681875699
|
|
],
|
|
"error_norm_m": 0.06739141450964722,
|
|
"predicted_m": [
|
|
0.26002106594182534,
|
|
-0.10988906791887226,
|
|
0.055477257921110204
|
|
],
|
|
"observed_m": [
|
|
0.2598631600742688,
|
|
-0.17725689739670814,
|
|
0.053701485752922634
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 248,
|
|
"link": "Ellbow",
|
|
"error_m": [
|
|
-8.239373790630555e-05,
|
|
0.06709065692143885,
|
|
0.002003299016982721
|
|
],
|
|
"error_norm_m": 0.06712060966521163,
|
|
"predicted_m": [
|
|
0.22252106800612484,
|
|
-0.10989002391093265,
|
|
0.055489663767614966
|
|
],
|
|
"observed_m": [
|
|
0.22260346174403114,
|
|
-0.1769806808323715,
|
|
0.053486364750632245
|
|
]
|
|
}
|
|
],
|
|
"stage_idx": 1,
|
|
"num_active_links": 4
|
|
},
|
|
{
|
|
"method": "deterministic_geometric_prefix",
|
|
"active_links": [
|
|
"Board",
|
|
"Base",
|
|
"Arm1",
|
|
"Ellbow",
|
|
"Arm2"
|
|
],
|
|
"active_observations": 47,
|
|
"joint_updates": [
|
|
{
|
|
"pass": 0,
|
|
"updates": [
|
|
{
|
|
"link": "Base",
|
|
"joint_variable": "x",
|
|
"joint_type": "linear",
|
|
"old": 0.0599766333228056,
|
|
"new": 0.06880917229572707,
|
|
"info": {
|
|
"reason": "weighted_projection",
|
|
"used_markers": 9,
|
|
"axis_world": [
|
|
0.9999999449522614,
|
|
2.549312161006467e-05,
|
|
-0.00033082257346049777
|
|
],
|
|
"per_marker": [
|
|
{
|
|
"marker_id": 198,
|
|
"q_i": 0.05983224698111681,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 229,
|
|
"q_i": 0.060149488301588346,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 243,
|
|
"q_i": 0.060131535028602384,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 244,
|
|
"q_i": 0.060319402473740166,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 245,
|
|
"q_i": 0.05981759751307056,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 248,
|
|
"q_i": 0.0600579794423168,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 232,
|
|
"q_i": 0.05952818351889029,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 113,
|
|
"q_i": 0.07038461553144953,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 124,
|
|
"q_i": 0.12906150187076873,
|
|
"weight": 1.0
|
|
}
|
|
]
|
|
}
|
|
},
|
|
{
|
|
"link": "Arm1",
|
|
"joint_variable": "y",
|
|
"joint_type": "revolute",
|
|
"old": 0.03511567816650496,
|
|
"new": -0.3744387704876142,
|
|
"info": {
|
|
"reason": "2d_alignment+normal_tiebreak",
|
|
"used_markers": 9,
|
|
"axis_world": [
|
|
-0.9999999449522614,
|
|
-2.549312161006467e-05,
|
|
0.00033082257346049777
|
|
],
|
|
"axis_id": 0,
|
|
"theta_rad": -0.37443877048761415,
|
|
"theta_alt_rad": 2.7671538831021785,
|
|
"score_theta": 0.5431120854715981,
|
|
"score_theta_alt": 2.3570435127897382,
|
|
"best_score": 0.5431120854715981,
|
|
"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": 113,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 124,
|
|
"weight": 1.0
|
|
}
|
|
]
|
|
}
|
|
},
|
|
{
|
|
"link": "Ellbow",
|
|
"joint_variable": "z",
|
|
"joint_type": "revolute",
|
|
"old": -1.1847017752245022,
|
|
"new": 1.2394900761886802,
|
|
"info": {
|
|
"reason": "2d_alignment+normal_tiebreak",
|
|
"used_markers": 5,
|
|
"axis_world": [
|
|
-0.9999999449522614,
|
|
-2.549312161006467e-05,
|
|
0.00033082257346049777
|
|
],
|
|
"axis_id": 0,
|
|
"theta_rad": -1.9021025774011124,
|
|
"theta_alt_rad": 1.2394900761886802,
|
|
"score_theta": 0.7321616537230382,
|
|
"score_theta_alt": 0.13541892935450817,
|
|
"best_score": 0.13541892935450817,
|
|
"per_marker": [
|
|
{
|
|
"marker_id": 245,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 248,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 232,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 113,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 124,
|
|
"weight": 1.0
|
|
}
|
|
]
|
|
}
|
|
},
|
|
{
|
|
"link": "Arm2",
|
|
"joint_variable": "a",
|
|
"joint_type": "revolute",
|
|
"old": 0.0,
|
|
"new": -1.2743270091484749,
|
|
"info": {
|
|
"reason": "2d_alignment+normal_tiebreak",
|
|
"used_markers": 2,
|
|
"axis_world": [
|
|
0.0002683232953818801,
|
|
-0.6486403451837208,
|
|
0.7610950207435025
|
|
],
|
|
"axis_id": 2,
|
|
"theta_rad": -1.2743270091484749,
|
|
"theta_alt_rad": 1.8672656444413178,
|
|
"score_theta": 0.09032245495069346,
|
|
"score_theta_alt": 0.14009093807178746,
|
|
"best_score": 0.09032245495069346,
|
|
"per_marker": [
|
|
{
|
|
"marker_id": 113,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 124,
|
|
"weight": 1.0
|
|
}
|
|
]
|
|
}
|
|
}
|
|
]
|
|
},
|
|
{
|
|
"pass": 1,
|
|
"updates": [
|
|
{
|
|
"link": "Base",
|
|
"joint_variable": "x",
|
|
"joint_type": "linear",
|
|
"old": 0.06880917229572707,
|
|
"new": 0.06286849126885194,
|
|
"info": {
|
|
"reason": "weighted_projection",
|
|
"used_markers": 9,
|
|
"axis_world": [
|
|
0.9999999449522614,
|
|
2.549312161006467e-05,
|
|
-0.00033082257346049777
|
|
],
|
|
"per_marker": [
|
|
{
|
|
"marker_id": 198,
|
|
"q_i": 0.059832246981116805,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 229,
|
|
"q_i": 0.06014948830158834,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 243,
|
|
"q_i": 0.060131535028602384,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 244,
|
|
"q_i": 0.06031940247377012,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 245,
|
|
"q_i": 0.05981759751309215,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 248,
|
|
"q_i": 0.06005797944232942,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 232,
|
|
"q_i": 0.05952818351891188,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 113,
|
|
"q_i": 0.04169339791761409,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 124,
|
|
"q_i": 0.10428659024264225,
|
|
"weight": 1.0
|
|
}
|
|
]
|
|
}
|
|
},
|
|
{
|
|
"link": "Arm1",
|
|
"joint_variable": "y",
|
|
"joint_type": "revolute",
|
|
"old": -0.3744387704876142,
|
|
"new": -0.014603164874364527,
|
|
"info": {
|
|
"reason": "2d_alignment+normal_tiebreak",
|
|
"used_markers": 9,
|
|
"axis_world": [
|
|
-0.9999999449522614,
|
|
-2.549312161006467e-05,
|
|
0.00033082257346049777
|
|
],
|
|
"axis_id": 0,
|
|
"theta_rad": -0.014603164874364574,
|
|
"theta_alt_rad": 3.126989488715429,
|
|
"score_theta": 0.00809672144191679,
|
|
"score_theta_alt": 2.979081020794384,
|
|
"best_score": 0.00809672144191679,
|
|
"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": 113,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 124,
|
|
"weight": 1.0
|
|
}
|
|
]
|
|
}
|
|
},
|
|
{
|
|
"link": "Ellbow",
|
|
"joint_variable": "z",
|
|
"joint_type": "revolute",
|
|
"old": 1.2394900761886802,
|
|
"new": 1.6464393488237805,
|
|
"info": {
|
|
"reason": "2d_alignment+normal_tiebreak",
|
|
"used_markers": 5,
|
|
"axis_world": [
|
|
-0.9999999449522614,
|
|
-2.549312161006467e-05,
|
|
0.00033082257346049777
|
|
],
|
|
"axis_id": 0,
|
|
"theta_rad": -1.4951533047660128,
|
|
"theta_alt_rad": 1.6464393488237805,
|
|
"score_theta": 0.5125470679475529,
|
|
"score_theta_alt": 0.12741638802285726,
|
|
"best_score": 0.12741638802285726,
|
|
"per_marker": [
|
|
{
|
|
"marker_id": 245,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 248,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 232,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 113,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 124,
|
|
"weight": 1.0
|
|
}
|
|
]
|
|
}
|
|
},
|
|
{
|
|
"link": "Arm2",
|
|
"joint_variable": "a",
|
|
"joint_type": "revolute",
|
|
"old": -1.2743270091484749,
|
|
"new": -2.8679380500321456,
|
|
"info": {
|
|
"reason": "2d_alignment+normal_tiebreak",
|
|
"used_markers": 2,
|
|
"axis_world": [
|
|
0.00032865368884834006,
|
|
0.060950448342018196,
|
|
0.9981407389900784
|
|
],
|
|
"axis_id": 2,
|
|
"theta_rad": -2.8679380500321456,
|
|
"theta_alt_rad": 0.2736546035576475,
|
|
"score_theta": 0.04713758417053556,
|
|
"score_theta_alt": 0.061238558503953315,
|
|
"best_score": 0.04713758417053556,
|
|
"per_marker": [
|
|
{
|
|
"marker_id": 113,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 124,
|
|
"weight": 1.0
|
|
}
|
|
]
|
|
}
|
|
}
|
|
]
|
|
}
|
|
],
|
|
"root_link": "Board",
|
|
"root_pose": {
|
|
"reason": "kabsch",
|
|
"used_markers": [
|
|
210,
|
|
211,
|
|
214,
|
|
208,
|
|
206,
|
|
205,
|
|
207,
|
|
217,
|
|
46,
|
|
47,
|
|
51,
|
|
53,
|
|
54,
|
|
55,
|
|
56,
|
|
58,
|
|
60,
|
|
61,
|
|
62,
|
|
63,
|
|
64,
|
|
66,
|
|
68,
|
|
69,
|
|
72,
|
|
75,
|
|
79,
|
|
83,
|
|
84,
|
|
85,
|
|
86,
|
|
92,
|
|
95,
|
|
96,
|
|
97,
|
|
102,
|
|
103,
|
|
105
|
|
]
|
|
},
|
|
"marker_stats": {
|
|
"num_markers_used": 47,
|
|
"mean_error_m": 0.0014066302158572623,
|
|
"rms_error_m": 0.0027115947654789913,
|
|
"median_error_m": 0.00030592533051252156,
|
|
"worst_error_m": 0.007081393783771279
|
|
},
|
|
"marker_reports": [
|
|
{
|
|
"marker_id": 46,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.0002349615114914938,
|
|
0.00015668342864044726,
|
|
-0.0001259912279549802
|
|
],
|
|
"error_norm_m": 0.00030924165019365887,
|
|
"predicted_m": [
|
|
0.5367195119155588,
|
|
0.1854673171842678,
|
|
-0.027365875937603024
|
|
],
|
|
"observed_m": [
|
|
0.5364845504040673,
|
|
0.18531063375562734,
|
|
-0.027239884709648044
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 47,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.00012732899483491877,
|
|
-5.799329427630395e-05,
|
|
1.924752446606781e-05
|
|
],
|
|
"error_norm_m": 0.0001412315910296299,
|
|
"predicted_m": [
|
|
0.3442515466957362,
|
|
-0.2865175889498893,
|
|
-0.027326560902454024
|
|
],
|
|
"observed_m": [
|
|
0.3441242177009013,
|
|
-0.286459595655613,
|
|
-0.027345808426920092
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 51,
|
|
"link": "Board",
|
|
"error_m": [
|
|
2.5002305310467543e-05,
|
|
-0.0001781786598451518,
|
|
0.0002356338359271043
|
|
],
|
|
"error_norm_m": 0.00029647268799802394,
|
|
"predicted_m": [
|
|
0.16781864041926398,
|
|
-0.17206208689095145,
|
|
-0.027262285914736742
|
|
],
|
|
"observed_m": [
|
|
0.1677936381139535,
|
|
-0.1718839082311063,
|
|
-0.027497919750663846
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 53,
|
|
"link": "Board",
|
|
"error_m": [
|
|
4.311484450875147e-05,
|
|
0.0001219033354848964,
|
|
-5.0934578651556234e-05
|
|
],
|
|
"error_norm_m": 0.00013897353820698595,
|
|
"predicted_m": [
|
|
0.48625883193515085,
|
|
0.212266030756954,
|
|
-0.027347799323216238
|
|
],
|
|
"observed_m": [
|
|
0.4862157170906421,
|
|
0.2121441274214691,
|
|
-0.02729686474456468
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 54,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-9.817805455741846e-05,
|
|
2.771757417896481e-05,
|
|
-0.0001554387379465623
|
|
],
|
|
"error_norm_m": 0.00018592577973338155,
|
|
"predicted_m": [
|
|
0.3422926690235092,
|
|
-0.33056763884343365,
|
|
-0.02732818617259379
|
|
],
|
|
"observed_m": [
|
|
0.3423908470780666,
|
|
-0.3305953564176126,
|
|
-0.02717274743464723
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 55,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-4.646309691153094e-05,
|
|
0.00011461791271893951,
|
|
-2.911029746227589e-05
|
|
],
|
|
"error_norm_m": 0.00012705705296833756,
|
|
"predicted_m": [
|
|
0.2837409396205222,
|
|
-0.26255913157837046,
|
|
-0.027305306110488176
|
|
],
|
|
"observed_m": [
|
|
0.28378740271743375,
|
|
-0.2626737494910894,
|
|
-0.0272761958130259
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 56,
|
|
"link": "Board",
|
|
"error_m": [
|
|
7.157107208066726e-05,
|
|
-4.343440578741253e-05,
|
|
-6.002492171629584e-05
|
|
],
|
|
"error_norm_m": 0.00010301435430040382,
|
|
"predicted_m": [
|
|
0.4986899412422986,
|
|
0.16869634770863443,
|
|
-0.027354160354534435
|
|
],
|
|
"observed_m": [
|
|
0.49861837017021793,
|
|
0.16873978211442184,
|
|
-0.02729413543281814
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 58,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.000117785210174505,
|
|
-7.506518709762822e-05,
|
|
0.00010565440482662378
|
|
],
|
|
"error_norm_m": 0.00017513135444323597,
|
|
"predicted_m": [
|
|
0.0501098195612705,
|
|
-0.2180950876100421,
|
|
-0.027225720671569812
|
|
],
|
|
"observed_m": [
|
|
0.049992034351096,
|
|
-0.21802002242294446,
|
|
-0.027331375076396436
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 60,
|
|
"link": "Board",
|
|
"error_m": [
|
|
4.6091127460679004e-05,
|
|
0.00012296576925469038,
|
|
-9.63688719735449e-05
|
|
],
|
|
"error_norm_m": 0.0001628862545595785,
|
|
"predicted_m": [
|
|
0.4343670114708244,
|
|
0.28383470780030956,
|
|
-0.027326938786685143
|
|
],
|
|
"observed_m": [
|
|
0.4343209203433637,
|
|
0.28371174203105487,
|
|
-0.027230569914711598
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 61,
|
|
"link": "Board",
|
|
"error_m": [
|
|
3.826282862401387e-05,
|
|
-0.0003516359981929895,
|
|
0.0002587877214122111
|
|
],
|
|
"error_norm_m": 0.0004382727507308833,
|
|
"predicted_m": [
|
|
-0.02241428864890438,
|
|
0.3358430629660432,
|
|
-0.02717314059011313
|
|
],
|
|
"observed_m": [
|
|
-0.022452551477528393,
|
|
0.3361946989642362,
|
|
-0.02743192831152534
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 62,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-2.6262416238764796e-05,
|
|
-7.185559078998205e-05,
|
|
0.00010104090012797926
|
|
],
|
|
"error_norm_m": 0.00012673675052307347,
|
|
"predicted_m": [
|
|
0.4047187043163543,
|
|
-0.17507604756543904,
|
|
-0.02734081366254396
|
|
],
|
|
"observed_m": [
|
|
0.4047449667325931,
|
|
-0.17500419197464906,
|
|
-0.02744185456267194
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 63,
|
|
"link": "Board",
|
|
"error_m": [
|
|
7.293811865860533e-05,
|
|
0.00010826098859434419,
|
|
0.00016598891563280802
|
|
],
|
|
"error_norm_m": 0.00021116991006731278,
|
|
"predicted_m": [
|
|
0.7774202391131195,
|
|
-0.23611654617787844,
|
|
-0.02746726238912407
|
|
],
|
|
"observed_m": [
|
|
0.7773473009944609,
|
|
-0.2362248071664728,
|
|
-0.027633251304756877
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 64,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.00015111634821513356,
|
|
4.722372440330025e-05,
|
|
-8.129817707427933e-05
|
|
],
|
|
"error_norm_m": 0.0001779764715910427,
|
|
"predicted_m": [
|
|
-0.021250937734886084,
|
|
-0.1882169068486999,
|
|
-0.027200570888286636
|
|
],
|
|
"observed_m": [
|
|
-0.021402054083101217,
|
|
-0.1882641305731032,
|
|
-0.027119272711212356
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 66,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.00014556683966213124,
|
|
0.00013175477727478402,
|
|
5.248050415927047e-05
|
|
],
|
|
"error_norm_m": 0.00020323195974245725,
|
|
"predicted_m": [
|
|
0.20977350785648521,
|
|
-0.3632110171378375,
|
|
-0.02728603030960838
|
|
],
|
|
"observed_m": [
|
|
0.20991907469614735,
|
|
-0.3633427719151123,
|
|
-0.02733851081376765
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 68,
|
|
"link": "Board",
|
|
"error_m": [
|
|
1.329565083085793e-05,
|
|
0.0001496115239607021,
|
|
-2.9227526593091774e-05
|
|
],
|
|
"error_norm_m": 0.00015301840001650038,
|
|
"predicted_m": [
|
|
0.5737398869232279,
|
|
0.17066826096414772,
|
|
-0.027378886905260726
|
|
],
|
|
"observed_m": [
|
|
0.573726591272397,
|
|
0.17051864944018702,
|
|
-0.027349659378667634
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 69,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.00013931102659766204,
|
|
-0.00023685278975271729,
|
|
-0.00028937407540049337
|
|
],
|
|
"error_norm_m": 0.0003990540836268059,
|
|
"predicted_m": [
|
|
0.007631429438237455,
|
|
-0.2811961704533154,
|
|
-0.027214924294788004
|
|
],
|
|
"observed_m": [
|
|
0.007492118411639793,
|
|
-0.2809593176635627,
|
|
-0.02692555021938751
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 72,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.00011278626593902441,
|
|
0.00018193020076326394,
|
|
-0.00024717087184187095
|
|
],
|
|
"error_norm_m": 0.00032697519725707094,
|
|
"predicted_m": [
|
|
0.4409992909573329,
|
|
0.1943448769679565,
|
|
-0.027333751251278442
|
|
],
|
|
"observed_m": [
|
|
0.4408865046913939,
|
|
0.19416294676719323,
|
|
-0.02708658037943657
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 75,
|
|
"link": "Board",
|
|
"error_m": [
|
|
8.497735512607088e-05,
|
|
0.00020440251288081357,
|
|
-5.75926108101199e-06
|
|
],
|
|
"error_norm_m": 0.0002214378180086066,
|
|
"predicted_m": [
|
|
-0.025690689976676957,
|
|
0.19459297958260158,
|
|
-0.02717934624432427
|
|
],
|
|
"observed_m": [
|
|
-0.025775667331803028,
|
|
0.19438857706972076,
|
|
-0.027173586983243257
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 79,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.00016311977369909414,
|
|
-0.0004925545248772312,
|
|
0.0002513309295392556
|
|
],
|
|
"error_norm_m": 0.00057652862608178,
|
|
"predicted_m": [
|
|
0.31231830204067745,
|
|
-0.15908840315636516,
|
|
-0.02730942031779327
|
|
],
|
|
"observed_m": [
|
|
0.31248142181437655,
|
|
-0.15859584863148793,
|
|
-0.027560751247332524
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 83,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-3.6114812799852014e-05,
|
|
-7.152473442950669e-05,
|
|
0.00010185016936970284
|
|
],
|
|
"error_norm_m": 0.0001295898311574522,
|
|
"predicted_m": [
|
|
0.04416562132228359,
|
|
0.33923476029246413,
|
|
-0.027194991779000102
|
|
],
|
|
"observed_m": [
|
|
0.04420173613508344,
|
|
0.33930628502689364,
|
|
-0.027296841948369805
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 84,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.00018840001710418441,
|
|
6.316300073511139e-05,
|
|
-0.00012546955124030298
|
|
],
|
|
"error_norm_m": 0.00023500370081163335,
|
|
"predicted_m": [
|
|
0.40749765978677,
|
|
0.2584440228421935,
|
|
-0.027319360112983547
|
|
],
|
|
"observed_m": [
|
|
0.4073092597696658,
|
|
0.25838085984145837,
|
|
-0.027193890561743244
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 85,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.00021940403520182006,
|
|
-0.00010608720313082243,
|
|
0.00011294370432046036
|
|
],
|
|
"error_norm_m": 0.00026860548333306497,
|
|
"predicted_m": [
|
|
0.5046022055961901,
|
|
-0.3127235010844192,
|
|
-0.027380961156030784
|
|
],
|
|
"observed_m": [
|
|
0.5043828015609882,
|
|
-0.3126174138812884,
|
|
-0.027493904860351245
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 86,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.00047058945989419954,
|
|
-0.0003360655813351432,
|
|
8.013435935129778e-05
|
|
],
|
|
"error_norm_m": 0.0005837945103118777,
|
|
"predicted_m": [
|
|
0.36289680650142736,
|
|
0.29203288579332376,
|
|
-0.02730287164660969
|
|
],
|
|
"observed_m": [
|
|
0.36336739596132156,
|
|
0.2923689513746589,
|
|
-0.027383006005960987
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 92,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.00020266729198603617,
|
|
0.000305431232893949,
|
|
-0.00025165142263110923
|
|
],
|
|
"error_norm_m": 0.00044462423211104015,
|
|
"predicted_m": [
|
|
0.6451089392203692,
|
|
-0.18480991925779974,
|
|
-0.027420842840283944
|
|
],
|
|
"observed_m": [
|
|
0.6453116065123552,
|
|
-0.1851153504906937,
|
|
-0.027169191417652835
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 95,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.00015200367720094587,
|
|
0.00013220845193662178,
|
|
7.894740213724993e-06
|
|
],
|
|
"error_norm_m": 0.00020160982012077088,
|
|
"predicted_m": [
|
|
0.1860612377172705,
|
|
-0.2740516217274548,
|
|
-0.02727358442872227
|
|
],
|
|
"observed_m": [
|
|
0.18590923404006957,
|
|
-0.2741838301793914,
|
|
-0.027281479168935995
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 96,
|
|
"link": "Board",
|
|
"error_m": [
|
|
2.272196202024457e-06,
|
|
1.8525600383234586e-05,
|
|
-4.328326801212104e-05
|
|
],
|
|
"error_norm_m": 4.713599510935243e-05,
|
|
"predicted_m": [
|
|
0.36978899641131513,
|
|
-0.186466938021308,
|
|
-0.027329845935668205
|
|
],
|
|
"observed_m": [
|
|
0.3697867242151131,
|
|
-0.18648546362169124,
|
|
-0.027286562667656084
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 97,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.00018156628147059095,
|
|
0.00010132708738785912,
|
|
-0.00017441529452839194
|
|
],
|
|
"error_norm_m": 0.00027139305107351297,
|
|
"predicted_m": [
|
|
0.30437341195433554,
|
|
-0.35964860549443073,
|
|
-0.02731714237229305
|
|
],
|
|
"observed_m": [
|
|
0.30419184567286495,
|
|
-0.3597499325818186,
|
|
-0.027142727077764658
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 102,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.0001337222936853566,
|
|
-0.00017176958878606374,
|
|
0.0003727718196989589
|
|
],
|
|
"error_norm_m": 0.0004316772787880772,
|
|
"predicted_m": [
|
|
0.6497099111331173,
|
|
-0.2229698019262238,
|
|
-0.027424334288588693
|
|
],
|
|
"observed_m": [
|
|
0.6498436334268026,
|
|
-0.22279803233743772,
|
|
-0.02779710610828765
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 103,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.00024461240522352656,
|
|
-1.3660640967222415e-05,
|
|
0.0001832169914290742
|
|
],
|
|
"error_norm_m": 0.00030592533051252156,
|
|
"predicted_m": [
|
|
0.10572904202773449,
|
|
-0.1876936697329793,
|
|
-0.027242551898373216
|
|
],
|
|
"observed_m": [
|
|
0.10597365443295802,
|
|
-0.18768000909201207,
|
|
-0.02742576888980229
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 105,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.0002086134292065278,
|
|
0.00025686280929770877,
|
|
-0.0003005269755976016
|
|
],
|
|
"error_norm_m": 0.0004470061841937531,
|
|
"predicted_m": [
|
|
0.5248610198447461,
|
|
-0.26622298467080807,
|
|
-0.027385263479919743
|
|
],
|
|
"observed_m": [
|
|
0.5246524064155396,
|
|
-0.2664798474801058,
|
|
-0.02708473650432214
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 113,
|
|
"link": "Arm2",
|
|
"error_m": [
|
|
0.0005932556079115137,
|
|
0.001192480089037884,
|
|
0.005606611693660585
|
|
],
|
|
"error_norm_m": 0.005762643114280275,
|
|
"predicted_m": [
|
|
0.2710830508197565,
|
|
-0.159694176703475,
|
|
0.24077655690362668
|
|
],
|
|
"observed_m": [
|
|
0.27048979521184496,
|
|
-0.16088665679251288,
|
|
0.2351699452099661
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 124,
|
|
"link": "Arm2",
|
|
"error_m": [
|
|
0.00250635947942629,
|
|
0.00031014855236401184,
|
|
0.005258358658762063
|
|
],
|
|
"error_norm_m": 0.0058333837306336605,
|
|
"predicted_m": [
|
|
0.29668354363705024,
|
|
-0.11916713977747247,
|
|
0.27536230607131995
|
|
],
|
|
"observed_m": [
|
|
0.29417718415762395,
|
|
-0.11947728832983648,
|
|
0.2701039474125579
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 198,
|
|
"link": "Arm1",
|
|
"error_m": [
|
|
0.0030373165775789968,
|
|
0.000598586464000718,
|
|
0.0032869057221442816
|
|
],
|
|
"error_norm_m": 0.004515234985422785,
|
|
"predicted_m": [
|
|
0.1729241012375412,
|
|
-0.05248223302839891,
|
|
0.09370204788878295
|
|
],
|
|
"observed_m": [
|
|
0.1698867846599622,
|
|
-0.05308081949239963,
|
|
0.09041514216663867
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 205,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-4.235671266172858e-05,
|
|
1.224300529410749e-05,
|
|
-0.00022510469191217974
|
|
],
|
|
"error_norm_m": 0.0002293820058483602,
|
|
"predicted_m": [
|
|
0.7500256480364245,
|
|
-0.08996866929891865,
|
|
0.00014934427268465446
|
|
],
|
|
"observed_m": [
|
|
0.7500680047490862,
|
|
-0.08998091230421276,
|
|
0.0003744489645968342
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 206,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.00016362638483158332,
|
|
-0.0002411824815486928,
|
|
-3.867689095405727e-05
|
|
],
|
|
"error_norm_m": 0.000294004226352124,
|
|
"predicted_m": [
|
|
0.6500236154573182,
|
|
-0.009971218743609081,
|
|
0.00018655580564254162
|
|
],
|
|
"observed_m": [
|
|
0.6498599890724867,
|
|
-0.009730036262060388,
|
|
0.00022523269659659889
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 207,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.0006257862857207419,
|
|
-0.00040162321572383315,
|
|
0.00046249918392821706
|
|
],
|
|
"error_norm_m": 0.000875679837576943,
|
|
"predicted_m": [
|
|
0.7500236099526444,
|
|
-0.009968669431448071,
|
|
0.00015347354829645877
|
|
],
|
|
"observed_m": [
|
|
0.7506493962383651,
|
|
-0.009567046215724238,
|
|
-0.00030902563563175826
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 208,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.000250411140637119,
|
|
-0.00012099942338547609,
|
|
0.00020120955593573236
|
|
],
|
|
"error_norm_m": 0.00034326649299728525,
|
|
"predicted_m": [
|
|
0.35002567005511986,
|
|
-0.0899788665475627,
|
|
0.0002816733020689859
|
|
],
|
|
"observed_m": [
|
|
0.350276081195757,
|
|
-0.08985786712417722,
|
|
8.046374613325354e-05
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 210,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-2.488253005104163e-05,
|
|
0.00030323665402359756,
|
|
-4.706239938880063e-05
|
|
],
|
|
"error_norm_m": 0.00030787412700874844,
|
|
"predicted_m": [
|
|
0.020023904897235986,
|
|
-0.019987279393657263,
|
|
0.0003944578674713881
|
|
],
|
|
"observed_m": [
|
|
0.020048787427287027,
|
|
-0.02029051604768086,
|
|
0.0004415202668601887
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 211,
|
|
"link": "Board",
|
|
"error_m": [
|
|
4.897894727723395e-05,
|
|
0.0003719092326030897,
|
|
4.969175870566116e-06
|
|
],
|
|
"error_norm_m": 0.0003751534449803677,
|
|
"predicted_m": [
|
|
0.25002363747601364,
|
|
-0.009981415992253117,
|
|
0.000318884835026873
|
|
],
|
|
"observed_m": [
|
|
0.2499746585287364,
|
|
-0.010353325224856207,
|
|
0.0003139156591563069
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 214,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.0001505229522955065,
|
|
0.00031186268781910505,
|
|
-0.0003766180798008118
|
|
],
|
|
"error_norm_m": 0.0005116216114027656,
|
|
"predicted_m": [
|
|
0.35002363197133984,
|
|
-0.009978866680092107,
|
|
0.0002858025776807902
|
|
],
|
|
"observed_m": [
|
|
0.34987310901904434,
|
|
-0.010290729367911212,
|
|
0.000662420657481602
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 217,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-8.319746691320962e-05,
|
|
-0.0002733581906032706,
|
|
3.58526855521005e-05
|
|
],
|
|
"error_norm_m": 0.0002879790512033235,
|
|
"predicted_m": [
|
|
0.6500256535410983,
|
|
-0.08997121861107966,
|
|
0.0001824265300307373
|
|
],
|
|
"observed_m": [
|
|
0.6501088510080115,
|
|
-0.0896978604204764,
|
|
0.0001465738444786368
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 229,
|
|
"link": "Arm1",
|
|
"error_m": [
|
|
0.0027206766769824475,
|
|
0.0005856996340289633,
|
|
0.005103918308292876
|
|
],
|
|
"error_norm_m": 0.005813355979097197,
|
|
"predicted_m": [
|
|
0.17292595905595293,
|
|
-0.14247256886619672,
|
|
0.09238316489591929
|
|
],
|
|
"observed_m": [
|
|
0.17020528237897048,
|
|
-0.14305826850022568,
|
|
0.08727924658762641
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 232,
|
|
"link": "Ellbow",
|
|
"error_m": [
|
|
0.003342376209297726,
|
|
-0.00013510484960377322,
|
|
0.006241506699184791
|
|
],
|
|
"error_norm_m": 0.007081393783771279,
|
|
"predicted_m": [
|
|
0.2629073581359218,
|
|
-0.16816988402839614,
|
|
0.03416169107367477
|
|
],
|
|
"observed_m": [
|
|
0.2595649819266241,
|
|
-0.16803477917879237,
|
|
0.027920184374489978
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 243,
|
|
"link": "Arm1",
|
|
"error_m": [
|
|
0.002738997479804328,
|
|
0.00019487897701411794,
|
|
0.006184756248490089
|
|
],
|
|
"error_norm_m": 0.006766926544842476,
|
|
"predicted_m": [
|
|
0.1729150909187502,
|
|
-0.17695591190647447,
|
|
0.056874026147561506
|
|
],
|
|
"observed_m": [
|
|
0.17017609343894588,
|
|
-0.1771507908834886,
|
|
0.05068926989907142
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 244,
|
|
"link": "Ellbow",
|
|
"error_m": [
|
|
0.0025509155453504184,
|
|
-9.408185164327953e-05,
|
|
0.005514169108832394
|
|
],
|
|
"error_norm_m": 0.0060763543737277605,
|
|
"predicted_m": [
|
|
0.29791436155270107,
|
|
-0.141956483551574,
|
|
0.05734557226754819
|
|
],
|
|
"observed_m": [
|
|
0.29536344600735065,
|
|
-0.14186240169993072,
|
|
0.051831403158715796
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 245,
|
|
"link": "Ellbow",
|
|
"error_m": [
|
|
0.003052799737903067,
|
|
0.0003645938388665282,
|
|
0.005788930585993696
|
|
],
|
|
"error_norm_m": 0.0065547106905288945,
|
|
"predicted_m": [
|
|
0.26291595981217186,
|
|
-0.1768923035578416,
|
|
0.05949041633891633
|
|
],
|
|
"observed_m": [
|
|
0.2598631600742688,
|
|
-0.17725689739670814,
|
|
0.053701485752922634
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 248,
|
|
"link": "Ellbow",
|
|
"error_m": [
|
|
0.002812500132474055,
|
|
8.742128246952419e-05,
|
|
0.00601645743478884
|
|
],
|
|
"error_norm_m": 0.00664195449701525,
|
|
"predicted_m": [
|
|
0.2254159618765052,
|
|
-0.17689325954990198,
|
|
0.059502822185421085
|
|
],
|
|
"observed_m": [
|
|
0.22260346174403114,
|
|
-0.1769806808323715,
|
|
0.053486364750632245
|
|
]
|
|
}
|
|
],
|
|
"stage_idx": 2,
|
|
"num_active_links": 5
|
|
}
|
|
],
|
|
"markers": [
|
|
{
|
|
"marker_id": 41,
|
|
"link": "FingerA",
|
|
"observed_position_m": [
|
|
0.24508135157391928,
|
|
-0.11232591112608636,
|
|
0.34342667804678023
|
|
],
|
|
"predicted_position_m": [
|
|
0.2646871079847728,
|
|
-0.15072977665079518,
|
|
0.3456272194997116
|
|
],
|
|
"error_m": [
|
|
0.01960575641085352,
|
|
-0.03840386552470881,
|
|
0.0022005414529313594
|
|
],
|
|
"error_norm_m": 0.043175050137408195
|
|
},
|
|
{
|
|
"marker_id": 42,
|
|
"link": "FingerA",
|
|
"observed_position_m": [
|
|
0.21430931576090076,
|
|
-0.07616312526071134,
|
|
0.33980171378590585
|
|
],
|
|
"predicted_position_m": [
|
|
0.24578746251411407,
|
|
-0.12697743359839486,
|
|
0.38205344083253534
|
|
],
|
|
"error_m": [
|
|
0.03147814675321331,
|
|
-0.05081430833768352,
|
|
0.042251727046629495
|
|
],
|
|
"error_norm_m": 0.07319956347736568
|
|
},
|
|
{
|
|
"marker_id": 43,
|
|
"link": "FingerB",
|
|
"observed_position_m": [
|
|
0.2696634932018715,
|
|
-0.07571485589188987,
|
|
0.33939216884622103
|
|
],
|
|
"predicted_position_m": [
|
|
0.28304241129090946,
|
|
-0.13524028027745755,
|
|
0.3665159327830492
|
|
],
|
|
"error_m": [
|
|
0.013378918089037961,
|
|
-0.05952542438556768,
|
|
0.027123763936828194
|
|
],
|
|
"error_norm_m": 0.06676803252766929
|
|
},
|
|
{
|
|
"marker_id": 46,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.5364845504040673,
|
|
0.18531063375562734,
|
|
-0.027239884709648044
|
|
],
|
|
"predicted_position_m": [
|
|
0.5367195119155588,
|
|
0.1854673171842678,
|
|
-0.027365875937603024
|
|
],
|
|
"error_m": [
|
|
0.0002349615114914938,
|
|
0.00015668342864044726,
|
|
-0.0001259912279549802
|
|
],
|
|
"error_norm_m": 0.00030924165019365887
|
|
},
|
|
{
|
|
"marker_id": 47,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.3441242177009013,
|
|
-0.286459595655613,
|
|
-0.027345808426920092
|
|
],
|
|
"predicted_position_m": [
|
|
0.3442515466957362,
|
|
-0.2865175889498893,
|
|
-0.027326560902454024
|
|
],
|
|
"error_m": [
|
|
0.00012732899483491877,
|
|
-5.799329427630395e-05,
|
|
1.924752446606781e-05
|
|
],
|
|
"error_norm_m": 0.0001412315910296299
|
|
},
|
|
{
|
|
"marker_id": 51,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.1677936381139535,
|
|
-0.1718839082311063,
|
|
-0.027497919750663846
|
|
],
|
|
"predicted_position_m": [
|
|
0.16781864041926398,
|
|
-0.17206208689095145,
|
|
-0.027262285914736742
|
|
],
|
|
"error_m": [
|
|
2.5002305310467543e-05,
|
|
-0.0001781786598451518,
|
|
0.0002356338359271043
|
|
],
|
|
"error_norm_m": 0.00029647268799802394
|
|
},
|
|
{
|
|
"marker_id": 53,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.4862157170906421,
|
|
0.2121441274214691,
|
|
-0.02729686474456468
|
|
],
|
|
"predicted_position_m": [
|
|
0.48625883193515085,
|
|
0.212266030756954,
|
|
-0.027347799323216238
|
|
],
|
|
"error_m": [
|
|
4.311484450875147e-05,
|
|
0.0001219033354848964,
|
|
-5.0934578651556234e-05
|
|
],
|
|
"error_norm_m": 0.00013897353820698595
|
|
},
|
|
{
|
|
"marker_id": 54,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.3423908470780666,
|
|
-0.3305953564176126,
|
|
-0.02717274743464723
|
|
],
|
|
"predicted_position_m": [
|
|
0.3422926690235092,
|
|
-0.33056763884343365,
|
|
-0.02732818617259379
|
|
],
|
|
"error_m": [
|
|
-9.817805455741846e-05,
|
|
2.771757417896481e-05,
|
|
-0.0001554387379465623
|
|
],
|
|
"error_norm_m": 0.00018592577973338155
|
|
},
|
|
{
|
|
"marker_id": 55,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.28378740271743375,
|
|
-0.2626737494910894,
|
|
-0.0272761958130259
|
|
],
|
|
"predicted_position_m": [
|
|
0.2837409396205222,
|
|
-0.26255913157837046,
|
|
-0.027305306110488176
|
|
],
|
|
"error_m": [
|
|
-4.646309691153094e-05,
|
|
0.00011461791271893951,
|
|
-2.911029746227589e-05
|
|
],
|
|
"error_norm_m": 0.00012705705296833756
|
|
},
|
|
{
|
|
"marker_id": 56,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.49861837017021793,
|
|
0.16873978211442184,
|
|
-0.02729413543281814
|
|
],
|
|
"predicted_position_m": [
|
|
0.4986899412422986,
|
|
0.16869634770863443,
|
|
-0.027354160354534435
|
|
],
|
|
"error_m": [
|
|
7.157107208066726e-05,
|
|
-4.343440578741253e-05,
|
|
-6.002492171629584e-05
|
|
],
|
|
"error_norm_m": 0.00010301435430040382
|
|
},
|
|
{
|
|
"marker_id": 58,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.049992034351096,
|
|
-0.21802002242294446,
|
|
-0.027331375076396436
|
|
],
|
|
"predicted_position_m": [
|
|
0.0501098195612705,
|
|
-0.2180950876100421,
|
|
-0.027225720671569812
|
|
],
|
|
"error_m": [
|
|
0.000117785210174505,
|
|
-7.506518709762822e-05,
|
|
0.00010565440482662378
|
|
],
|
|
"error_norm_m": 0.00017513135444323597
|
|
},
|
|
{
|
|
"marker_id": 60,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.4343209203433637,
|
|
0.28371174203105487,
|
|
-0.027230569914711598
|
|
],
|
|
"predicted_position_m": [
|
|
0.4343670114708244,
|
|
0.28383470780030956,
|
|
-0.027326938786685143
|
|
],
|
|
"error_m": [
|
|
4.6091127460679004e-05,
|
|
0.00012296576925469038,
|
|
-9.63688719735449e-05
|
|
],
|
|
"error_norm_m": 0.0001628862545595785
|
|
},
|
|
{
|
|
"marker_id": 61,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
-0.022452551477528393,
|
|
0.3361946989642362,
|
|
-0.02743192831152534
|
|
],
|
|
"predicted_position_m": [
|
|
-0.02241428864890438,
|
|
0.3358430629660432,
|
|
-0.02717314059011313
|
|
],
|
|
"error_m": [
|
|
3.826282862401387e-05,
|
|
-0.0003516359981929895,
|
|
0.0002587877214122111
|
|
],
|
|
"error_norm_m": 0.0004382727507308833
|
|
},
|
|
{
|
|
"marker_id": 62,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.4047449667325931,
|
|
-0.17500419197464906,
|
|
-0.02744185456267194
|
|
],
|
|
"predicted_position_m": [
|
|
0.4047187043163543,
|
|
-0.17507604756543904,
|
|
-0.02734081366254396
|
|
],
|
|
"error_m": [
|
|
-2.6262416238764796e-05,
|
|
-7.185559078998205e-05,
|
|
0.00010104090012797926
|
|
],
|
|
"error_norm_m": 0.00012673675052307347
|
|
},
|
|
{
|
|
"marker_id": 63,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.7773473009944609,
|
|
-0.2362248071664728,
|
|
-0.027633251304756877
|
|
],
|
|
"predicted_position_m": [
|
|
0.7774202391131195,
|
|
-0.23611654617787844,
|
|
-0.02746726238912407
|
|
],
|
|
"error_m": [
|
|
7.293811865860533e-05,
|
|
0.00010826098859434419,
|
|
0.00016598891563280802
|
|
],
|
|
"error_norm_m": 0.00021116991006731278
|
|
},
|
|
{
|
|
"marker_id": 64,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
-0.021402054083101217,
|
|
-0.1882641305731032,
|
|
-0.027119272711212356
|
|
],
|
|
"predicted_position_m": [
|
|
-0.021250937734886084,
|
|
-0.1882169068486999,
|
|
-0.027200570888286636
|
|
],
|
|
"error_m": [
|
|
0.00015111634821513356,
|
|
4.722372440330025e-05,
|
|
-8.129817707427933e-05
|
|
],
|
|
"error_norm_m": 0.0001779764715910427
|
|
},
|
|
{
|
|
"marker_id": 66,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.20991907469614735,
|
|
-0.3633427719151123,
|
|
-0.02733851081376765
|
|
],
|
|
"predicted_position_m": [
|
|
0.20977350785648521,
|
|
-0.3632110171378375,
|
|
-0.02728603030960838
|
|
],
|
|
"error_m": [
|
|
-0.00014556683966213124,
|
|
0.00013175477727478402,
|
|
5.248050415927047e-05
|
|
],
|
|
"error_norm_m": 0.00020323195974245725
|
|
},
|
|
{
|
|
"marker_id": 68,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.573726591272397,
|
|
0.17051864944018702,
|
|
-0.027349659378667634
|
|
],
|
|
"predicted_position_m": [
|
|
0.5737398869232279,
|
|
0.17066826096414772,
|
|
-0.027378886905260726
|
|
],
|
|
"error_m": [
|
|
1.329565083085793e-05,
|
|
0.0001496115239607021,
|
|
-2.9227526593091774e-05
|
|
],
|
|
"error_norm_m": 0.00015301840001650038
|
|
},
|
|
{
|
|
"marker_id": 69,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.007492118411639793,
|
|
-0.2809593176635627,
|
|
-0.02692555021938751
|
|
],
|
|
"predicted_position_m": [
|
|
0.007631429438237455,
|
|
-0.2811961704533154,
|
|
-0.027214924294788004
|
|
],
|
|
"error_m": [
|
|
0.00013931102659766204,
|
|
-0.00023685278975271729,
|
|
-0.00028937407540049337
|
|
],
|
|
"error_norm_m": 0.0003990540836268059
|
|
},
|
|
{
|
|
"marker_id": 72,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.4408865046913939,
|
|
0.19416294676719323,
|
|
-0.02708658037943657
|
|
],
|
|
"predicted_position_m": [
|
|
0.4409992909573329,
|
|
0.1943448769679565,
|
|
-0.027333751251278442
|
|
],
|
|
"error_m": [
|
|
0.00011278626593902441,
|
|
0.00018193020076326394,
|
|
-0.00024717087184187095
|
|
],
|
|
"error_norm_m": 0.00032697519725707094
|
|
},
|
|
{
|
|
"marker_id": 75,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
-0.025775667331803028,
|
|
0.19438857706972076,
|
|
-0.027173586983243257
|
|
],
|
|
"predicted_position_m": [
|
|
-0.025690689976676957,
|
|
0.19459297958260158,
|
|
-0.02717934624432427
|
|
],
|
|
"error_m": [
|
|
8.497735512607088e-05,
|
|
0.00020440251288081357,
|
|
-5.75926108101199e-06
|
|
],
|
|
"error_norm_m": 0.0002214378180086066
|
|
},
|
|
{
|
|
"marker_id": 79,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.31248142181437655,
|
|
-0.15859584863148793,
|
|
-0.027560751247332524
|
|
],
|
|
"predicted_position_m": [
|
|
0.31231830204067745,
|
|
-0.15908840315636516,
|
|
-0.02730942031779327
|
|
],
|
|
"error_m": [
|
|
-0.00016311977369909414,
|
|
-0.0004925545248772312,
|
|
0.0002513309295392556
|
|
],
|
|
"error_norm_m": 0.00057652862608178
|
|
},
|
|
{
|
|
"marker_id": 83,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.04420173613508344,
|
|
0.33930628502689364,
|
|
-0.027296841948369805
|
|
],
|
|
"predicted_position_m": [
|
|
0.04416562132228359,
|
|
0.33923476029246413,
|
|
-0.027194991779000102
|
|
],
|
|
"error_m": [
|
|
-3.6114812799852014e-05,
|
|
-7.152473442950669e-05,
|
|
0.00010185016936970284
|
|
],
|
|
"error_norm_m": 0.0001295898311574522
|
|
},
|
|
{
|
|
"marker_id": 84,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.4073092597696658,
|
|
0.25838085984145837,
|
|
-0.027193890561743244
|
|
],
|
|
"predicted_position_m": [
|
|
0.40749765978677,
|
|
0.2584440228421935,
|
|
-0.027319360112983547
|
|
],
|
|
"error_m": [
|
|
0.00018840001710418441,
|
|
6.316300073511139e-05,
|
|
-0.00012546955124030298
|
|
],
|
|
"error_norm_m": 0.00023500370081163335
|
|
},
|
|
{
|
|
"marker_id": 85,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.5043828015609882,
|
|
-0.3126174138812884,
|
|
-0.027493904860351245
|
|
],
|
|
"predicted_position_m": [
|
|
0.5046022055961901,
|
|
-0.3127235010844192,
|
|
-0.027380961156030784
|
|
],
|
|
"error_m": [
|
|
0.00021940403520182006,
|
|
-0.00010608720313082243,
|
|
0.00011294370432046036
|
|
],
|
|
"error_norm_m": 0.00026860548333306497
|
|
},
|
|
{
|
|
"marker_id": 86,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.36336739596132156,
|
|
0.2923689513746589,
|
|
-0.027383006005960987
|
|
],
|
|
"predicted_position_m": [
|
|
0.36289680650142736,
|
|
0.29203288579332376,
|
|
-0.02730287164660969
|
|
],
|
|
"error_m": [
|
|
-0.00047058945989419954,
|
|
-0.0003360655813351432,
|
|
8.013435935129778e-05
|
|
],
|
|
"error_norm_m": 0.0005837945103118777
|
|
},
|
|
{
|
|
"marker_id": 92,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.6453116065123552,
|
|
-0.1851153504906937,
|
|
-0.027169191417652835
|
|
],
|
|
"predicted_position_m": [
|
|
0.6451089392203692,
|
|
-0.18480991925779974,
|
|
-0.027420842840283944
|
|
],
|
|
"error_m": [
|
|
-0.00020266729198603617,
|
|
0.000305431232893949,
|
|
-0.00025165142263110923
|
|
],
|
|
"error_norm_m": 0.00044462423211104015
|
|
},
|
|
{
|
|
"marker_id": 95,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.18590923404006957,
|
|
-0.2741838301793914,
|
|
-0.027281479168935995
|
|
],
|
|
"predicted_position_m": [
|
|
0.1860612377172705,
|
|
-0.2740516217274548,
|
|
-0.02727358442872227
|
|
],
|
|
"error_m": [
|
|
0.00015200367720094587,
|
|
0.00013220845193662178,
|
|
7.894740213724993e-06
|
|
],
|
|
"error_norm_m": 0.00020160982012077088
|
|
},
|
|
{
|
|
"marker_id": 96,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.3697867242151131,
|
|
-0.18648546362169124,
|
|
-0.027286562667656084
|
|
],
|
|
"predicted_position_m": [
|
|
0.36978899641131513,
|
|
-0.186466938021308,
|
|
-0.027329845935668205
|
|
],
|
|
"error_m": [
|
|
2.272196202024457e-06,
|
|
1.8525600383234586e-05,
|
|
-4.328326801212104e-05
|
|
],
|
|
"error_norm_m": 4.713599510935243e-05
|
|
},
|
|
{
|
|
"marker_id": 97,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.30419184567286495,
|
|
-0.3597499325818186,
|
|
-0.027142727077764658
|
|
],
|
|
"predicted_position_m": [
|
|
0.30437341195433554,
|
|
-0.35964860549443073,
|
|
-0.02731714237229305
|
|
],
|
|
"error_m": [
|
|
0.00018156628147059095,
|
|
0.00010132708738785912,
|
|
-0.00017441529452839194
|
|
],
|
|
"error_norm_m": 0.00027139305107351297
|
|
},
|
|
{
|
|
"marker_id": 102,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.6498436334268026,
|
|
-0.22279803233743772,
|
|
-0.02779710610828765
|
|
],
|
|
"predicted_position_m": [
|
|
0.6497099111331173,
|
|
-0.2229698019262238,
|
|
-0.027424334288588693
|
|
],
|
|
"error_m": [
|
|
-0.0001337222936853566,
|
|
-0.00017176958878606374,
|
|
0.0003727718196989589
|
|
],
|
|
"error_norm_m": 0.0004316772787880772
|
|
},
|
|
{
|
|
"marker_id": 103,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.10597365443295802,
|
|
-0.18768000909201207,
|
|
-0.02742576888980229
|
|
],
|
|
"predicted_position_m": [
|
|
0.10572904202773449,
|
|
-0.1876936697329793,
|
|
-0.027242551898373216
|
|
],
|
|
"error_m": [
|
|
-0.00024461240522352656,
|
|
-1.3660640967222415e-05,
|
|
0.0001832169914290742
|
|
],
|
|
"error_norm_m": 0.00030592533051252156
|
|
},
|
|
{
|
|
"marker_id": 105,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.5246524064155396,
|
|
-0.2664798474801058,
|
|
-0.02708473650432214
|
|
],
|
|
"predicted_position_m": [
|
|
0.5248610198447461,
|
|
-0.26622298467080807,
|
|
-0.027385263479919743
|
|
],
|
|
"error_m": [
|
|
0.0002086134292065278,
|
|
0.00025686280929770877,
|
|
-0.0003005269755976016
|
|
],
|
|
"error_norm_m": 0.0004470061841937531
|
|
},
|
|
{
|
|
"marker_id": 113,
|
|
"link": "Arm2",
|
|
"observed_position_m": [
|
|
0.27048979521184496,
|
|
-0.16088665679251288,
|
|
0.2351699452099661
|
|
],
|
|
"predicted_position_m": [
|
|
0.2710830508197565,
|
|
-0.159694176703475,
|
|
0.24077655690362668
|
|
],
|
|
"error_m": [
|
|
0.0005932556079115137,
|
|
0.001192480089037884,
|
|
0.005606611693660585
|
|
],
|
|
"error_norm_m": 0.005762643114280275
|
|
},
|
|
{
|
|
"marker_id": 124,
|
|
"link": "Arm2",
|
|
"observed_position_m": [
|
|
0.29417718415762395,
|
|
-0.11947728832983648,
|
|
0.2701039474125579
|
|
],
|
|
"predicted_position_m": [
|
|
0.29668354363705024,
|
|
-0.11916713977747247,
|
|
0.27536230607131995
|
|
],
|
|
"error_m": [
|
|
0.00250635947942629,
|
|
0.00031014855236401184,
|
|
0.005258358658762063
|
|
],
|
|
"error_norm_m": 0.0058333837306336605
|
|
},
|
|
{
|
|
"marker_id": 198,
|
|
"link": "Arm1",
|
|
"observed_position_m": [
|
|
0.1698867846599622,
|
|
-0.05308081949239963,
|
|
0.09041514216663867
|
|
],
|
|
"predicted_position_m": [
|
|
0.1729241012375412,
|
|
-0.05248223302839891,
|
|
0.09370204788878295
|
|
],
|
|
"error_m": [
|
|
0.0030373165775789968,
|
|
0.000598586464000718,
|
|
0.0032869057221442816
|
|
],
|
|
"error_norm_m": 0.004515234985422785
|
|
},
|
|
{
|
|
"marker_id": 205,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.7500680047490862,
|
|
-0.08998091230421276,
|
|
0.0003744489645968342
|
|
],
|
|
"predicted_position_m": [
|
|
0.7500256480364245,
|
|
-0.08996866929891865,
|
|
0.00014934427268465446
|
|
],
|
|
"error_m": [
|
|
-4.235671266172858e-05,
|
|
1.224300529410749e-05,
|
|
-0.00022510469191217974
|
|
],
|
|
"error_norm_m": 0.0002293820058483602
|
|
},
|
|
{
|
|
"marker_id": 206,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.6498599890724867,
|
|
-0.009730036262060388,
|
|
0.00022523269659659889
|
|
],
|
|
"predicted_position_m": [
|
|
0.6500236154573182,
|
|
-0.009971218743609081,
|
|
0.00018655580564254162
|
|
],
|
|
"error_m": [
|
|
0.00016362638483158332,
|
|
-0.0002411824815486928,
|
|
-3.867689095405727e-05
|
|
],
|
|
"error_norm_m": 0.000294004226352124
|
|
},
|
|
{
|
|
"marker_id": 207,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.7506493962383651,
|
|
-0.009567046215724238,
|
|
-0.00030902563563175826
|
|
],
|
|
"predicted_position_m": [
|
|
0.7500236099526444,
|
|
-0.009968669431448071,
|
|
0.00015347354829645877
|
|
],
|
|
"error_m": [
|
|
-0.0006257862857207419,
|
|
-0.00040162321572383315,
|
|
0.00046249918392821706
|
|
],
|
|
"error_norm_m": 0.000875679837576943
|
|
},
|
|
{
|
|
"marker_id": 208,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.350276081195757,
|
|
-0.08985786712417722,
|
|
8.046374613325354e-05
|
|
],
|
|
"predicted_position_m": [
|
|
0.35002567005511986,
|
|
-0.0899788665475627,
|
|
0.0002816733020689859
|
|
],
|
|
"error_m": [
|
|
-0.000250411140637119,
|
|
-0.00012099942338547609,
|
|
0.00020120955593573236
|
|
],
|
|
"error_norm_m": 0.00034326649299728525
|
|
},
|
|
{
|
|
"marker_id": 210,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.020048787427287027,
|
|
-0.02029051604768086,
|
|
0.0004415202668601887
|
|
],
|
|
"predicted_position_m": [
|
|
0.020023904897235986,
|
|
-0.019987279393657263,
|
|
0.0003944578674713881
|
|
],
|
|
"error_m": [
|
|
-2.488253005104163e-05,
|
|
0.00030323665402359756,
|
|
-4.706239938880063e-05
|
|
],
|
|
"error_norm_m": 0.00030787412700874844
|
|
},
|
|
{
|
|
"marker_id": 211,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.2499746585287364,
|
|
-0.010353325224856207,
|
|
0.0003139156591563069
|
|
],
|
|
"predicted_position_m": [
|
|
0.25002363747601364,
|
|
-0.009981415992253117,
|
|
0.000318884835026873
|
|
],
|
|
"error_m": [
|
|
4.897894727723395e-05,
|
|
0.0003719092326030897,
|
|
4.969175870566116e-06
|
|
],
|
|
"error_norm_m": 0.0003751534449803677
|
|
},
|
|
{
|
|
"marker_id": 214,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.34987310901904434,
|
|
-0.010290729367911212,
|
|
0.000662420657481602
|
|
],
|
|
"predicted_position_m": [
|
|
0.35002363197133984,
|
|
-0.009978866680092107,
|
|
0.0002858025776807902
|
|
],
|
|
"error_m": [
|
|
0.0001505229522955065,
|
|
0.00031186268781910505,
|
|
-0.0003766180798008118
|
|
],
|
|
"error_norm_m": 0.0005116216114027656
|
|
},
|
|
{
|
|
"marker_id": 217,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.6501088510080115,
|
|
-0.0896978604204764,
|
|
0.0001465738444786368
|
|
],
|
|
"predicted_position_m": [
|
|
0.6500256535410983,
|
|
-0.08997121861107966,
|
|
0.0001824265300307373
|
|
],
|
|
"error_m": [
|
|
-8.319746691320962e-05,
|
|
-0.0002733581906032706,
|
|
3.58526855521005e-05
|
|
],
|
|
"error_norm_m": 0.0002879790512033235
|
|
},
|
|
{
|
|
"marker_id": 229,
|
|
"link": "Arm1",
|
|
"observed_position_m": [
|
|
0.17020528237897048,
|
|
-0.14305826850022568,
|
|
0.08727924658762641
|
|
],
|
|
"predicted_position_m": [
|
|
0.17292595905595293,
|
|
-0.14247256886619672,
|
|
0.09238316489591929
|
|
],
|
|
"error_m": [
|
|
0.0027206766769824475,
|
|
0.0005856996340289633,
|
|
0.005103918308292876
|
|
],
|
|
"error_norm_m": 0.005813355979097197
|
|
},
|
|
{
|
|
"marker_id": 232,
|
|
"link": "Ellbow",
|
|
"observed_position_m": [
|
|
0.2595649819266241,
|
|
-0.16803477917879237,
|
|
0.027920184374489978
|
|
],
|
|
"predicted_position_m": [
|
|
0.2629073581359218,
|
|
-0.16816988402839614,
|
|
0.03416169107367477
|
|
],
|
|
"error_m": [
|
|
0.003342376209297726,
|
|
-0.00013510484960377322,
|
|
0.006241506699184791
|
|
],
|
|
"error_norm_m": 0.007081393783771279
|
|
},
|
|
{
|
|
"marker_id": 243,
|
|
"link": "Arm1",
|
|
"observed_position_m": [
|
|
0.17017609343894588,
|
|
-0.1771507908834886,
|
|
0.05068926989907142
|
|
],
|
|
"predicted_position_m": [
|
|
0.1729150909187502,
|
|
-0.17695591190647447,
|
|
0.056874026147561506
|
|
],
|
|
"error_m": [
|
|
0.002738997479804328,
|
|
0.00019487897701411794,
|
|
0.006184756248490089
|
|
],
|
|
"error_norm_m": 0.006766926544842476
|
|
},
|
|
{
|
|
"marker_id": 244,
|
|
"link": "Ellbow",
|
|
"observed_position_m": [
|
|
0.29536344600735065,
|
|
-0.14186240169993072,
|
|
0.051831403158715796
|
|
],
|
|
"predicted_position_m": [
|
|
0.29791436155270107,
|
|
-0.141956483551574,
|
|
0.05734557226754819
|
|
],
|
|
"error_m": [
|
|
0.0025509155453504184,
|
|
-9.408185164327953e-05,
|
|
0.005514169108832394
|
|
],
|
|
"error_norm_m": 0.0060763543737277605
|
|
},
|
|
{
|
|
"marker_id": 245,
|
|
"link": "Ellbow",
|
|
"observed_position_m": [
|
|
0.2598631600742688,
|
|
-0.17725689739670814,
|
|
0.053701485752922634
|
|
],
|
|
"predicted_position_m": [
|
|
0.26291595981217186,
|
|
-0.1768923035578416,
|
|
0.05949041633891633
|
|
],
|
|
"error_m": [
|
|
0.003052799737903067,
|
|
0.0003645938388665282,
|
|
0.005788930585993696
|
|
],
|
|
"error_norm_m": 0.0065547106905288945
|
|
},
|
|
{
|
|
"marker_id": 248,
|
|
"link": "Ellbow",
|
|
"observed_position_m": [
|
|
0.22260346174403114,
|
|
-0.1769806808323715,
|
|
0.053486364750632245
|
|
],
|
|
"predicted_position_m": [
|
|
0.2254159618765052,
|
|
-0.17689325954990198,
|
|
0.059502822185421085
|
|
],
|
|
"error_m": [
|
|
0.002812500132474055,
|
|
8.742128246952419e-05,
|
|
0.00601645743478884
|
|
],
|
|
"error_norm_m": 0.00664195449701525
|
|
}
|
|
]
|
|
} |