4838 lines
124 KiB
JSON
4838 lines
124 KiB
JSON
{
|
|
"schema_version": "1.0",
|
|
"method": "deterministic_geometric_sequential_prefix",
|
|
"created_utc": "2026-05-31T08:47:48Z",
|
|
"root_pose": {
|
|
"translation_m": [
|
|
0.0014892389835960973,
|
|
0.0036902958660568475,
|
|
-0.004599013006759942
|
|
],
|
|
"rotation_matrix": [
|
|
[
|
|
0.9999658268304668,
|
|
0.006368640863178671,
|
|
-0.005271203355618567
|
|
],
|
|
[
|
|
-0.006305214173496513,
|
|
0.9999085603487908,
|
|
0.01196307717253042
|
|
],
|
|
[
|
|
0.005346909900752585,
|
|
-0.01192943229015687,
|
|
0.9999145459486768
|
|
]
|
|
],
|
|
"euler_xyz_deg": [
|
|
-0.6835321064670821,
|
|
-0.3063568305236461,
|
|
-0.3612697191726321
|
|
]
|
|
},
|
|
"movements": {
|
|
"x": {
|
|
"value_m": 0.05676870395702915,
|
|
"value_mm": 56.768703957029146,
|
|
"joint_type": "linear",
|
|
"link": "Base"
|
|
},
|
|
"y": {
|
|
"value_rad": 2.2025331885734767,
|
|
"value_deg": 126.19585594275209,
|
|
"joint_type": "revolute",
|
|
"link": "Arm1"
|
|
},
|
|
"z": {
|
|
"value_rad": -1.0146056468008098,
|
|
"value_deg": -58.132621431827474,
|
|
"joint_type": "revolute",
|
|
"link": "Ellbow"
|
|
},
|
|
"a": {
|
|
"value_rad": -0.9415837130435447,
|
|
"value_deg": -53.94877281565231,
|
|
"joint_type": "revolute",
|
|
"link": "Arm2"
|
|
},
|
|
"b": {
|
|
"value_rad": 0.0,
|
|
"value_deg": 0.0,
|
|
"joint_type": "revolute",
|
|
"link": "Hand"
|
|
},
|
|
"c": {
|
|
"value_rad": 0.0,
|
|
"value_deg": 0.0,
|
|
"joint_type": "revolute",
|
|
"link": "Palm"
|
|
},
|
|
"e": {
|
|
"value_m": 0.0,
|
|
"value_mm": 0.0,
|
|
"joint_type": "linear",
|
|
"link": "FingerB"
|
|
}
|
|
},
|
|
"link_poses": {
|
|
"Board": {
|
|
"translation_m": [
|
|
0.0014892389835960973,
|
|
0.0036902958660568475,
|
|
-0.004599013006759942
|
|
],
|
|
"rotation_matrix": [
|
|
[
|
|
0.9999658268304668,
|
|
0.006368640863178671,
|
|
-0.005271203355618567
|
|
],
|
|
[
|
|
-0.006305214173496513,
|
|
0.9999085603487908,
|
|
0.01196307717253042
|
|
],
|
|
[
|
|
0.005346909900752585,
|
|
-0.01192943229015687,
|
|
0.9999145459486768
|
|
]
|
|
]
|
|
},
|
|
"Base": {
|
|
"translation_m": [
|
|
0.058171663720334076,
|
|
0.0035237662640168043,
|
|
0.011703156873659316
|
|
],
|
|
"rotation_matrix": [
|
|
[
|
|
0.9999658268304668,
|
|
0.006368640863178671,
|
|
-0.005271203355618567
|
|
],
|
|
[
|
|
-0.006305214173496513,
|
|
0.9999085603487908,
|
|
0.01196307717253042
|
|
],
|
|
[
|
|
0.005346909900752585,
|
|
-0.01192943229015687,
|
|
0.9999145459486768
|
|
]
|
|
]
|
|
},
|
|
"Arm1": {
|
|
"translation_m": [
|
|
0.16861851373390588,
|
|
0.11135865569536546,
|
|
0.055999092843095614
|
|
],
|
|
"rotation_matrix": [
|
|
[
|
|
0.9999658268272859,
|
|
0.0004928933932052256,
|
|
0.008252407367749076
|
|
],
|
|
[
|
|
-0.006305214173476456,
|
|
-0.6001475407505242,
|
|
0.7998644720226188
|
|
],
|
|
[
|
|
0.005346909900735576,
|
|
-0.7998891713143135,
|
|
-0.6001239240084604
|
|
]
|
|
]
|
|
},
|
|
"Ellbow": {
|
|
"translation_m": [
|
|
0.16849529038560457,
|
|
0.26139554088299655,
|
|
0.255971385671674
|
|
],
|
|
"rotation_matrix": [
|
|
[
|
|
0.9999658268263417,
|
|
0.00726876742736344,
|
|
0.003938298026704718
|
|
],
|
|
[
|
|
-0.0063052141734705035,
|
|
0.3624520071243725,
|
|
0.931981108608429
|
|
],
|
|
[
|
|
0.005346909900730528,
|
|
-0.9319740916725403,
|
|
0.3624854521258923
|
|
]
|
|
]
|
|
},
|
|
"Arm2": {
|
|
"translation_m": [
|
|
0.2584922147999753,
|
|
0.2608280716073842,
|
|
0.25645260756273974
|
|
],
|
|
"rotation_matrix": [
|
|
[
|
|
0.5853041553632301,
|
|
0.007268767427357459,
|
|
0.8107812348131059
|
|
],
|
|
[
|
|
-0.7572091422303219,
|
|
0.3624520071240742,
|
|
0.543380950577451
|
|
],
|
|
[
|
|
-0.2899195761437936,
|
|
-0.9319740916717734,
|
|
0.21764864303925793
|
|
]
|
|
]
|
|
},
|
|
"Hand": {
|
|
"translation_m": [
|
|
0.25667502294313593,
|
|
0.17021506982636564,
|
|
0.4894461304806831
|
|
],
|
|
"rotation_matrix": [
|
|
[
|
|
0.5853041553632301,
|
|
0.007268767427357459,
|
|
0.8107812348131059
|
|
],
|
|
[
|
|
-0.7572091422303219,
|
|
0.3624520071240742,
|
|
0.543380950577451
|
|
],
|
|
[
|
|
-0.2899195761437936,
|
|
-0.9319740916717734,
|
|
0.21764864303925793
|
|
]
|
|
]
|
|
},
|
|
"Palm": {
|
|
"translation_m": [
|
|
0.25667502294313593,
|
|
0.17021506982636564,
|
|
0.4894461304806831
|
|
],
|
|
"rotation_matrix": [
|
|
[
|
|
0.5853041553632301,
|
|
0.007268767427357459,
|
|
0.8107812348131059
|
|
],
|
|
[
|
|
-0.7572091422303219,
|
|
0.3624520071240742,
|
|
0.543380950577451
|
|
],
|
|
[
|
|
-0.2899195761437936,
|
|
-0.9319740916717734,
|
|
0.21764864303925793
|
|
]
|
|
]
|
|
},
|
|
"FingerA": {
|
|
"translation_m": [
|
|
0.2587618327046313,
|
|
0.15450041300810174,
|
|
0.52090554538462
|
|
],
|
|
"rotation_matrix": [
|
|
[
|
|
0.5853041553632301,
|
|
0.007268767427357459,
|
|
0.8107812348131059
|
|
],
|
|
[
|
|
-0.7572091422303219,
|
|
0.3624520071240742,
|
|
0.543380950577451
|
|
],
|
|
[
|
|
-0.2899195761437936,
|
|
-0.9319740916717734,
|
|
0.21764864303925793
|
|
]
|
|
]
|
|
},
|
|
"FingerB": {
|
|
"translation_m": [
|
|
0.2540793994617255,
|
|
0.16055808614594433,
|
|
0.5232249019937704
|
|
],
|
|
"rotation_matrix": [
|
|
[
|
|
0.5853041553632301,
|
|
0.007268767427357459,
|
|
0.8107812348131059
|
|
],
|
|
[
|
|
-0.7572091422303219,
|
|
0.3624520071240742,
|
|
0.543380950577451
|
|
],
|
|
[
|
|
-0.2899195761437936,
|
|
-0.9319740916717734,
|
|
0.21764864303925793
|
|
]
|
|
]
|
|
}
|
|
},
|
|
"stage_reports": [
|
|
{
|
|
"method": "deterministic_geometric_prefix",
|
|
"active_links": [
|
|
"Board",
|
|
"Base",
|
|
"Arm1"
|
|
],
|
|
"active_observations": 40,
|
|
"joint_updates": [
|
|
{
|
|
"pass": 0,
|
|
"updates": [
|
|
{
|
|
"link": "Base",
|
|
"joint_variable": "x",
|
|
"joint_type": "linear",
|
|
"old": 0.0,
|
|
"new": 0.05576233817620622,
|
|
"info": {
|
|
"reason": "weighted_projection",
|
|
"used_markers": 1,
|
|
"axis_world": [
|
|
0.9999658268294671,
|
|
-0.00630521417349021,
|
|
0.00534690990074724
|
|
],
|
|
"per_marker": [
|
|
{
|
|
"marker_id": 243,
|
|
"q_i": 0.05576233817620622,
|
|
"weight": 1.0
|
|
}
|
|
]
|
|
}
|
|
},
|
|
{
|
|
"link": "Arm1",
|
|
"joint_variable": "y",
|
|
"joint_type": "revolute",
|
|
"old": 0.0,
|
|
"new": 2.247421613248596,
|
|
"info": {
|
|
"reason": "2d_alignment+normal_tiebreak",
|
|
"used_markers": 1,
|
|
"axis_world": [
|
|
-0.9999658268294671,
|
|
0.00630521417349021,
|
|
-0.00534690990074724
|
|
],
|
|
"axis_id": 0,
|
|
"theta_rad": -0.8941710403411969,
|
|
"theta_alt_rad": 2.247421613248596,
|
|
"score_theta": 0.25838862135863827,
|
|
"score_theta_alt": 0.16886719436329134,
|
|
"best_score": 0.16886719436329134,
|
|
"per_marker": [
|
|
{
|
|
"marker_id": 243,
|
|
"weight": 1.0
|
|
}
|
|
]
|
|
}
|
|
}
|
|
]
|
|
},
|
|
{
|
|
"pass": 1,
|
|
"updates": [
|
|
{
|
|
"link": "Base",
|
|
"joint_variable": "x",
|
|
"joint_type": "linear",
|
|
"old": 0.05576233817620622,
|
|
"new": 0.055762338176205996,
|
|
"info": {
|
|
"reason": "weighted_projection",
|
|
"used_markers": 1,
|
|
"axis_world": [
|
|
0.9999658268294671,
|
|
-0.00630521417349021,
|
|
0.00534690990074724
|
|
],
|
|
"per_marker": [
|
|
{
|
|
"marker_id": 243,
|
|
"q_i": 0.055762338176205996,
|
|
"weight": 1.0
|
|
}
|
|
]
|
|
}
|
|
},
|
|
{
|
|
"link": "Arm1",
|
|
"joint_variable": "y",
|
|
"joint_type": "revolute",
|
|
"old": 2.247421613248596,
|
|
"new": 2.247421613248596,
|
|
"info": {
|
|
"reason": "2d_alignment+normal_tiebreak",
|
|
"used_markers": 1,
|
|
"axis_world": [
|
|
-0.9999658268294671,
|
|
0.00630521417349021,
|
|
-0.00534690990074724
|
|
],
|
|
"axis_id": 0,
|
|
"theta_rad": -0.8941710403411969,
|
|
"theta_alt_rad": 2.247421613248596,
|
|
"score_theta": 0.25838862135863827,
|
|
"score_theta_alt": 0.16886719436329134,
|
|
"best_score": 0.16886719436329134,
|
|
"per_marker": [
|
|
{
|
|
"marker_id": 243,
|
|
"weight": 1.0
|
|
}
|
|
]
|
|
}
|
|
}
|
|
]
|
|
}
|
|
],
|
|
"root_link": "Board",
|
|
"root_pose": {
|
|
"reason": "kabsch",
|
|
"used_markers": [
|
|
210,
|
|
211,
|
|
215,
|
|
214,
|
|
208,
|
|
206,
|
|
205,
|
|
207,
|
|
217,
|
|
46,
|
|
47,
|
|
51,
|
|
53,
|
|
55,
|
|
56,
|
|
58,
|
|
61,
|
|
62,
|
|
63,
|
|
64,
|
|
66,
|
|
68,
|
|
69,
|
|
72,
|
|
73,
|
|
75,
|
|
79,
|
|
82,
|
|
83,
|
|
84,
|
|
85,
|
|
86,
|
|
92,
|
|
95,
|
|
96,
|
|
97,
|
|
102,
|
|
103,
|
|
105
|
|
]
|
|
},
|
|
"marker_stats": {
|
|
"num_markers_used": 40,
|
|
"mean_error_m": 0.018260071055228123,
|
|
"rms_error_m": 0.0658377918925389,
|
|
"median_error_m": 0.005953105148694126,
|
|
"worst_error_m": 0.41093453780777706
|
|
},
|
|
"marker_reports": [
|
|
{
|
|
"marker_id": 46,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.012685824952448077,
|
|
-0.009649285475931024,
|
|
0.013323395661109926
|
|
],
|
|
"error_norm_m": 0.020773823356875123,
|
|
"predicted_m": [
|
|
0.5395058025150521,
|
|
0.1854026757912692,
|
|
-0.031239134022212588
|
|
],
|
|
"observed_m": [
|
|
0.5521916274675002,
|
|
0.19505196126720023,
|
|
-0.04456252968332251
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 47,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.0014997958733345418,
|
|
0.003055467265318912,
|
|
0.0021079601686610737
|
|
],
|
|
"error_norm_m": 0.004003593878475735,
|
|
"predicted_m": [
|
|
0.3440265090521209,
|
|
-0.28532053889803843,
|
|
-0.026637853787601206
|
|
],
|
|
"observed_m": [
|
|
0.34252671317878636,
|
|
-0.28837600616335735,
|
|
-0.02874581395626228
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 51,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.00026502809332140664,
|
|
0.001168205409359413,
|
|
0.001015800525628361
|
|
],
|
|
"error_norm_m": 0.0015706032206044367,
|
|
"predicted_m": [
|
|
0.16833149285762106,
|
|
-0.1697585761438859,
|
|
-0.02894665192132234
|
|
],
|
|
"observed_m": [
|
|
0.16859652095094246,
|
|
-0.1709267815532453,
|
|
-0.029962452446950703
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 53,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.0007678858513761044,
|
|
0.0004644961936310088,
|
|
-0.0033898841612772547
|
|
],
|
|
"error_norm_m": 0.003506667937161957,
|
|
"predicted_m": [
|
|
0.48921820646832004,
|
|
0.21251838631581146,
|
|
-0.03182864788118077
|
|
],
|
|
"observed_m": [
|
|
0.48845032061694393,
|
|
0.21205389012218046,
|
|
-0.028438763719903514
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 55,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.0006390076116649657,
|
|
0.0010172761897459526,
|
|
0.0010893034975956103
|
|
],
|
|
"error_norm_m": 0.0016216546129998943,
|
|
"predicted_m": [
|
|
0.2836711695056911,
|
|
-0.2609812012824432,
|
|
-0.027247224503367903
|
|
],
|
|
"observed_m": [
|
|
0.28303216189402614,
|
|
-0.26199847747218913,
|
|
-0.028336528000963514
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 56,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.012227744641920446,
|
|
-0.01125009231546012,
|
|
0.017219838969664836
|
|
],
|
|
"error_norm_m": 0.023929169861814613,
|
|
"predicted_m": [
|
|
0.501370300013414,
|
|
0.16887399652923807,
|
|
-0.03124242042623228
|
|
],
|
|
"observed_m": [
|
|
0.5135980446553344,
|
|
0.1801240888446982,
|
|
-0.048462259395897114
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 58,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.00010200428773012721,
|
|
0.0007143951371397228,
|
|
0.0008366871229240555
|
|
],
|
|
"error_norm_m": 0.0011049029949960075,
|
|
"predicted_m": [
|
|
0.05033236684247467,
|
|
-0.21504218041637846,
|
|
-0.029026924917424007
|
|
],
|
|
"observed_m": [
|
|
0.05023036255474454,
|
|
-0.21575657555351818,
|
|
-0.029863612040348063
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 61,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.008035233032862025,
|
|
-0.022841936137153296,
|
|
0.022813009358264184
|
|
],
|
|
"error_norm_m": 0.033267888606980094,
|
|
"predicted_m": [
|
|
-0.01864731034125329,
|
|
0.33930435858295105,
|
|
-0.03602281907713707
|
|
],
|
|
"observed_m": [
|
|
-0.010612077308391265,
|
|
0.36214629472010434,
|
|
-0.058835828435401256
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 62,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.0008765545330541302,
|
|
0.005792750641072625,
|
|
0.0010183034070573825
|
|
],
|
|
"error_norm_m": 0.005946532575197896,
|
|
"predicted_m": [
|
|
0.4052041639383518,
|
|
-0.17427200523384054,
|
|
-0.027643942080317778
|
|
],
|
|
"observed_m": [
|
|
0.40432760940529766,
|
|
-0.18006475587491316,
|
|
-0.02866224548737516
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 63,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.015866484772870892,
|
|
0.007385919787924855,
|
|
0.018405415867788058
|
|
],
|
|
"error_norm_m": 0.025397962190451977,
|
|
"predicted_m": [
|
|
0.7775026220733696,
|
|
-0.23766637616559638,
|
|
-0.024922856918993215
|
|
],
|
|
"observed_m": [
|
|
0.7933691068462405,
|
|
-0.24505229595352124,
|
|
-0.04332827278678127
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 64,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.0004754752120111304,
|
|
0.001776790098072356,
|
|
-0.0031453833947510286
|
|
],
|
|
"error_norm_m": 0.0036436926914629486,
|
|
"predicted_m": [
|
|
-0.020834899571155665,
|
|
-0.18471497254973585,
|
|
-0.029764931844771598
|
|
],
|
|
"observed_m": [
|
|
-0.021310374783166795,
|
|
-0.1864917626478082,
|
|
-0.02661954845002057
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 66,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.0012731108183965945,
|
|
0.0006876176784452737,
|
|
-0.00044442338918422586
|
|
],
|
|
"error_norm_m": 0.0015136516694678826,
|
|
"predicted_m": [
|
|
0.20906269359216248,
|
|
-0.3611556011891355,
|
|
-0.026442038068722286
|
|
],
|
|
"observed_m": [
|
|
0.21033580441055907,
|
|
-0.36184321886758075,
|
|
-0.02599761467953806
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 68,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.005999286726092401,
|
|
-0.0002343850347767129,
|
|
-0.011976844580479873
|
|
],
|
|
"error_norm_m": 0.0133974319804717,
|
|
"predicted_m": [
|
|
0.5764302815395409,
|
|
0.17037061006940427,
|
|
-0.030864635819792405
|
|
],
|
|
"observed_m": [
|
|
0.5704309948134485,
|
|
0.17060499510418098,
|
|
-0.018887791239312533
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 69,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.0064527243033683365,
|
|
0.004026989242448709,
|
|
-0.008238690505665277
|
|
],
|
|
"error_norm_m": 0.011212952980469383,
|
|
"predicted_m": [
|
|
0.007451957280249863,
|
|
-0.277868565076297,
|
|
-0.028501314472499078
|
|
],
|
|
"observed_m": [
|
|
0.0139046815836182,
|
|
-0.2818955543187457,
|
|
-0.0202626239668338
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 72,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.002320191052193332,
|
|
-0.005075666293755082,
|
|
0.0012102579833339552
|
|
],
|
|
"error_norm_m": 0.005710551569722755,
|
|
"predicted_m": [
|
|
0.4438456271017049,
|
|
0.19488539890785356,
|
|
-0.03185687359664922
|
|
],
|
|
"observed_m": [
|
|
0.44152543604951155,
|
|
0.19996106520160864,
|
|
-0.03306713157998317
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 73,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.007409800631797803,
|
|
-0.006184057295090251,
|
|
-0.00213737086075539
|
|
],
|
|
"error_norm_m": 0.009885143611923719,
|
|
"predicted_m": [
|
|
0.22547702357625732,
|
|
0.3350451892583431,
|
|
-0.034684922969039106
|
|
],
|
|
"observed_m": [
|
|
0.21806722294445952,
|
|
0.34122924655343334,
|
|
-0.032547552108283716
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 75,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.004076281668749196,
|
|
0.0007523988483592314,
|
|
0.00040251454901708145
|
|
],
|
|
"error_norm_m": 0.004164636146431457,
|
|
"predicted_m": [
|
|
-0.022826768775181208,
|
|
0.19808795553617334,
|
|
-0.034355324630626884
|
|
],
|
|
"observed_m": [
|
|
-0.026903050443930404,
|
|
0.1973355566878141,
|
|
-0.034757839179643965
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 79,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.0008208092470192718,
|
|
0.0014626614911158742,
|
|
0.0020261612549668136
|
|
],
|
|
"error_norm_m": 0.0026302919778447317,
|
|
"predicted_m": [
|
|
0.31290915610661896,
|
|
-0.15770086556423232,
|
|
-0.028328748177466927
|
|
],
|
|
"observed_m": [
|
|
0.3120883468595997,
|
|
-0.1591635270553482,
|
|
-0.03035490943243374
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 82,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.004620758816891002,
|
|
-0.006660642371294712,
|
|
0.004753340368137474
|
|
],
|
|
"error_norm_m": 0.009397330126026629,
|
|
"predicted_m": [
|
|
0.22267866825354082,
|
|
0.2991946735990578,
|
|
-0.03427075579123611
|
|
],
|
|
"observed_m": [
|
|
0.21805790943664982,
|
|
0.30585531597035254,
|
|
-0.039024096159373585
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 83,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.005418482748924862,
|
|
0.004927118208021497,
|
|
-0.008572161024609653
|
|
],
|
|
"error_norm_m": 0.011274679319965165,
|
|
"predicted_m": [
|
|
0.047952004101645365,
|
|
0.342274247442862,
|
|
-0.0357072625914086
|
|
],
|
|
"observed_m": [
|
|
0.0425335213527205,
|
|
0.3373471292348405,
|
|
-0.027135101566798946
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 84,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.0042035394232649015,
|
|
-0.004062165066029411,
|
|
-0.001160529984860395
|
|
],
|
|
"error_norm_m": 0.005959677722190355,
|
|
"predicted_m": [
|
|
0.410755001782214,
|
|
0.2591907623010232,
|
|
-0.032800671688123485
|
|
],
|
|
"observed_m": [
|
|
0.4065514623589491,
|
|
0.26325292736705264,
|
|
-0.03164014170326309
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 85,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.00025609833219297773,
|
|
0.0015252105778676972,
|
|
0.004000367524038789
|
|
],
|
|
"error_norm_m": 0.004288915246303635,
|
|
"predicted_m": [
|
|
0.5042041073073622,
|
|
-0.31253918335750047,
|
|
-0.025467806364690516
|
|
],
|
|
"observed_m": [
|
|
0.5039480089751692,
|
|
-0.31406439393536817,
|
|
-0.029468173888729306
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 86,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.005073142385576934,
|
|
-0.002882827650883657,
|
|
-0.00277504259692744
|
|
],
|
|
"error_norm_m": 0.006461294788492351,
|
|
"predicted_m": [
|
|
0.3663704485521694,
|
|
0.293058903395277,
|
|
-0.03343985350032342
|
|
],
|
|
"observed_m": [
|
|
0.36129730616659245,
|
|
0.29594173104616067,
|
|
-0.03066481090339598
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 92,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.0022231448409536503,
|
|
0.002027638456878089,
|
|
0.0009436235838031978
|
|
],
|
|
"error_norm_m": 0.003153429270425988,
|
|
"predicted_m": [
|
|
0.6455239184881204,
|
|
-0.1855268250468046,
|
|
-0.026242405738769736
|
|
],
|
|
"observed_m": [
|
|
0.6477470633290741,
|
|
-0.18755446350368268,
|
|
-0.027186029322572934
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 95,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.0008970886199909656,
|
|
0.001369673710777508,
|
|
0.002558847672888321
|
|
],
|
|
"error_norm_m": 0.0030378405947577795,
|
|
"predicted_m": [
|
|
0.1859213318573731,
|
|
-0.27185425732038365,
|
|
-0.027632441485459517
|
|
],
|
|
"observed_m": [
|
|
0.18502424323738215,
|
|
-0.27322393103116116,
|
|
-0.030191289158347838
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 96,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.0016048708315765103,
|
|
0.003033724580266406,
|
|
0.002550677091032117
|
|
],
|
|
"error_norm_m": 0.0042761020611853644,
|
|
"predicted_m": [
|
|
0.370202818787732,
|
|
-0.18544072260513306,
|
|
-0.027694833409366182
|
|
],
|
|
"observed_m": [
|
|
0.36859794795615547,
|
|
-0.18847444718539946,
|
|
-0.0302455105003983
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 97,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.0007633652578301064,
|
|
-0.006294814223912815,
|
|
0.0025212819624152658
|
|
],
|
|
"error_norm_m": 0.006823802119378733,
|
|
"predicted_m": [
|
|
0.3036821331717976,
|
|
-0.3581923999751065,
|
|
-0.025978689171064048
|
|
],
|
|
"observed_m": [
|
|
0.3044454984296277,
|
|
-0.3518975857511937,
|
|
-0.028499971133479313
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 102,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.004217172044255979,
|
|
0.0012818222005649416,
|
|
0.007364179515894815
|
|
],
|
|
"error_norm_m": 0.008582467485929678,
|
|
"predicted_m": [
|
|
0.6498807339562016,
|
|
-0.22371233969491253,
|
|
-0.025762582817033888
|
|
],
|
|
"observed_m": [
|
|
0.6540979060004576,
|
|
-0.22499416189547747,
|
|
-0.0331267623329287
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 103,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.0005248079291564622,
|
|
0.0020058196713332588,
|
|
-0.0015791934782283593
|
|
],
|
|
"error_norm_m": 0.002606259380432412,
|
|
"predicted_m": [
|
|
0.10614407281302585,
|
|
-0.18499565619410507,
|
|
-0.029092184530364915
|
|
],
|
|
"observed_m": [
|
|
0.10666888074218231,
|
|
-0.18700147586543833,
|
|
-0.027512991052136556
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 105,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.0016530819970690391,
|
|
0.00242105838692408,
|
|
0.0029719622723411374
|
|
],
|
|
"error_norm_m": 0.00417453752530125,
|
|
"predicted_m": [
|
|
0.5247595567590854,
|
|
-0.2661711789404367,
|
|
-0.025914196571593565
|
|
],
|
|
"observed_m": [
|
|
0.5264126387561544,
|
|
-0.26859223732736076,
|
|
-0.028886158843934702
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 205,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.001425331050775469,
|
|
0.003360710169565073,
|
|
-0.011089866759590186
|
|
],
|
|
"error_norm_m": 0.011675233881750983,
|
|
"predicted_m": [
|
|
0.7508888500677534,
|
|
-0.09102679627230495,
|
|
0.0007847926887032176
|
|
],
|
|
"observed_m": [
|
|
0.7494635190169779,
|
|
-0.09438750644187002,
|
|
0.011874659448293403
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 206,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.004417582605729442,
|
|
0.0034371783095402033,
|
|
-0.007928626745045336
|
|
],
|
|
"error_norm_m": 0.00970527448721906,
|
|
"predicted_m": [
|
|
0.651401758653761,
|
|
-0.010403590027052035,
|
|
-0.0007042528845845903
|
|
],
|
|
"observed_m": [
|
|
0.6469841760480316,
|
|
-0.013840768336592238,
|
|
0.007224373860460745
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 207,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.004538146533493492,
|
|
0.003396137731705844,
|
|
-0.012334950443628177
|
|
],
|
|
"error_norm_m": 0.013574959591060965,
|
|
"predicted_m": [
|
|
0.7513983413368077,
|
|
-0.011034111444401688,
|
|
-0.00016956189450933155
|
|
],
|
|
"observed_m": [
|
|
0.7468601948033142,
|
|
-0.014430249176107532,
|
|
0.012165388549118845
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 208,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.0024300150463291703,
|
|
0.003007354145040428,
|
|
-0.0035371785130940453
|
|
],
|
|
"error_norm_m": 0.005240303799644845,
|
|
"predicted_m": [
|
|
0.35090251933556676,
|
|
-0.08850471060290635,
|
|
-0.001353971271597816
|
|
],
|
|
"observed_m": [
|
|
0.3484725042892376,
|
|
-0.09151206474794678,
|
|
0.002183207241496229
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 210,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.00311325211669285,
|
|
0.0013000795136633124,
|
|
-0.004188782755158783
|
|
],
|
|
"error_norm_m": 0.005378517124064509,
|
|
"predicted_m": [
|
|
0.021359601341935174,
|
|
-0.01643039070123714,
|
|
-0.00395351179915715
|
|
],
|
|
"observed_m": [
|
|
0.018246349225242323,
|
|
-0.017730470214900453,
|
|
0.00023527095600163288
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 211,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.0012021663450060838,
|
|
0.0036674520960670483,
|
|
-0.009075339052334019
|
|
],
|
|
"error_norm_m": 0.009861905886431425,
|
|
"predicted_m": [
|
|
0.2514154279215743,
|
|
-0.00788150435765343,
|
|
-0.002843016844885624
|
|
],
|
|
"observed_m": [
|
|
0.2502132615765682,
|
|
-0.011548956453720479,
|
|
0.0062323222074483955
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 214,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.0012373542216077005,
|
|
0.0031460461405335635,
|
|
-0.00901503003888733
|
|
],
|
|
"error_norm_m": 0.009628053717659525,
|
|
"predicted_m": [
|
|
0.351412010604621,
|
|
-0.008512025775003082,
|
|
-0.0023083258548103652
|
|
],
|
|
"observed_m": [
|
|
0.3501746563830133,
|
|
-0.011658071915536646,
|
|
0.006706704184076964
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 215,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.00011825939198178981,
|
|
0.0036032087497955695,
|
|
-0.004835824521741555
|
|
],
|
|
"error_norm_m": 0.006031773983122394,
|
|
"predicted_m": [
|
|
0.25090593665252003,
|
|
-0.08787418918555669,
|
|
-0.0018886622616730749
|
|
],
|
|
"observed_m": [
|
|
0.2510241960445018,
|
|
-0.09147739793535226,
|
|
0.0029471622600684808
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 217,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.0008810603033599929,
|
|
0.0033206712331084742,
|
|
-0.003707805550344541
|
|
],
|
|
"error_norm_m": 0.005054794426652457,
|
|
"predicted_m": [
|
|
0.6508922673847067,
|
|
-0.0903962748549553,
|
|
0.00025010169862795884
|
|
],
|
|
"observed_m": [
|
|
0.6500112070813467,
|
|
-0.09371694608806377,
|
|
0.0039579072489725
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 243,
|
|
"link": "Arm1",
|
|
"error_m": [
|
|
0.002911757844801438,
|
|
0.405535143417425,
|
|
-0.06633222054893911
|
|
],
|
|
"error_norm_m": 0.41093453780777706,
|
|
"predicted_m": [
|
|
0.167577388484122,
|
|
0.2924641475994514,
|
|
0.27605756151081007
|
|
],
|
|
"observed_m": [
|
|
0.16466563063932055,
|
|
-0.11307099581797364,
|
|
0.3423897820597492
|
|
]
|
|
}
|
|
],
|
|
"stage_idx": 0,
|
|
"num_active_links": 3
|
|
},
|
|
{
|
|
"method": "deterministic_geometric_prefix",
|
|
"active_links": [
|
|
"Board",
|
|
"Base",
|
|
"Arm1",
|
|
"Ellbow"
|
|
],
|
|
"active_observations": 42,
|
|
"joint_updates": [
|
|
{
|
|
"pass": 0,
|
|
"updates": [
|
|
{
|
|
"link": "Base",
|
|
"joint_variable": "x",
|
|
"joint_type": "linear",
|
|
"old": 0.055762338176205996,
|
|
"new": 0.042466531765584625,
|
|
"info": {
|
|
"reason": "weighted_projection",
|
|
"used_markers": 3,
|
|
"axis_world": [
|
|
0.9999658268294671,
|
|
-0.00630521417349021,
|
|
0.00534690990074724
|
|
],
|
|
"per_marker": [
|
|
{
|
|
"marker_id": 243,
|
|
"q_i": 0.055762338176205996,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 246,
|
|
"q_i": 0.03265784607785855,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 247,
|
|
"q_i": 0.03897941104268933,
|
|
"weight": 1.0
|
|
}
|
|
]
|
|
}
|
|
},
|
|
{
|
|
"link": "Arm1",
|
|
"joint_variable": "y",
|
|
"joint_type": "revolute",
|
|
"old": 2.247421613248596,
|
|
"new": 2.341735144272061,
|
|
"info": {
|
|
"reason": "2d_alignment+normal_tiebreak",
|
|
"used_markers": 3,
|
|
"axis_world": [
|
|
-0.9999658268294671,
|
|
0.00630521417349021,
|
|
-0.00534690990074724
|
|
],
|
|
"axis_id": 0,
|
|
"theta_rad": -0.7998575093177328,
|
|
"theta_alt_rad": 2.341735144272061,
|
|
"score_theta": 0.6551490665470304,
|
|
"score_theta_alt": 0.6207843717363043,
|
|
"best_score": 0.6207843717363043,
|
|
"per_marker": [
|
|
{
|
|
"marker_id": 243,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 246,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 247,
|
|
"weight": 1.0
|
|
}
|
|
]
|
|
}
|
|
},
|
|
{
|
|
"link": "Ellbow",
|
|
"joint_variable": "z",
|
|
"joint_type": "revolute",
|
|
"old": 0.0,
|
|
"new": -2.6497974675649116,
|
|
"info": {
|
|
"reason": "2d_alignment+normal_tiebreak",
|
|
"used_markers": 2,
|
|
"axis_world": [
|
|
-0.9999658268294671,
|
|
0.00630521417349021,
|
|
-0.00534690990074724
|
|
],
|
|
"axis_id": 0,
|
|
"theta_rad": -2.6497974675649116,
|
|
"theta_alt_rad": 0.4917951860248815,
|
|
"score_theta": 0.3496623915632294,
|
|
"score_theta_alt": 0.6082340513834691,
|
|
"best_score": 0.3496623915632294,
|
|
"per_marker": [
|
|
{
|
|
"marker_id": 246,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 247,
|
|
"weight": 1.0
|
|
}
|
|
]
|
|
}
|
|
}
|
|
]
|
|
},
|
|
{
|
|
"pass": 1,
|
|
"updates": [
|
|
{
|
|
"link": "Base",
|
|
"joint_variable": "x",
|
|
"joint_type": "linear",
|
|
"old": 0.042466531765584625,
|
|
"new": 0.04246653176577006,
|
|
"info": {
|
|
"reason": "weighted_projection",
|
|
"used_markers": 3,
|
|
"axis_world": [
|
|
0.9999658268294671,
|
|
-0.00630521417349021,
|
|
0.00534690990074724
|
|
],
|
|
"per_marker": [
|
|
{
|
|
"marker_id": 243,
|
|
"q_i": 0.05576233817620599,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 246,
|
|
"q_i": 0.032657846078209894,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 247,
|
|
"q_i": 0.038979411042894284,
|
|
"weight": 1.0
|
|
}
|
|
]
|
|
}
|
|
},
|
|
{
|
|
"link": "Arm1",
|
|
"joint_variable": "y",
|
|
"joint_type": "revolute",
|
|
"old": 2.341735144272061,
|
|
"new": 2.1743321918219856,
|
|
"info": {
|
|
"reason": "2d_alignment+normal_tiebreak",
|
|
"used_markers": 3,
|
|
"axis_world": [
|
|
-0.9999658268294671,
|
|
0.00630521417349021,
|
|
-0.00534690990074724
|
|
],
|
|
"axis_id": 0,
|
|
"theta_rad": -0.9672604617678078,
|
|
"theta_alt_rad": 2.1743321918219856,
|
|
"score_theta": 0.874951948731808,
|
|
"score_theta_alt": 0.43403612519303647,
|
|
"best_score": 0.43403612519303647,
|
|
"per_marker": [
|
|
{
|
|
"marker_id": 243,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 246,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 247,
|
|
"weight": 1.0
|
|
}
|
|
]
|
|
}
|
|
},
|
|
{
|
|
"link": "Ellbow",
|
|
"joint_variable": "z",
|
|
"joint_type": "revolute",
|
|
"old": -2.6497974675649116,
|
|
"new": -2.775266504500333,
|
|
"info": {
|
|
"reason": "2d_alignment+normal_tiebreak",
|
|
"used_markers": 2,
|
|
"axis_world": [
|
|
-0.9999658268294671,
|
|
0.00630521417349021,
|
|
-0.005346909900747239
|
|
],
|
|
"axis_id": 0,
|
|
"theta_rad": -2.775266504500333,
|
|
"theta_alt_rad": 0.36632614908946026,
|
|
"score_theta": 0.2915532352384555,
|
|
"score_theta_alt": 0.5402098635546895,
|
|
"best_score": 0.2915532352384555,
|
|
"per_marker": [
|
|
{
|
|
"marker_id": 246,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 247,
|
|
"weight": 1.0
|
|
}
|
|
]
|
|
}
|
|
}
|
|
]
|
|
}
|
|
],
|
|
"root_link": "Board",
|
|
"root_pose": {
|
|
"reason": "kabsch",
|
|
"used_markers": [
|
|
210,
|
|
211,
|
|
215,
|
|
214,
|
|
208,
|
|
206,
|
|
205,
|
|
207,
|
|
217,
|
|
46,
|
|
47,
|
|
51,
|
|
53,
|
|
55,
|
|
56,
|
|
58,
|
|
61,
|
|
62,
|
|
63,
|
|
64,
|
|
66,
|
|
68,
|
|
69,
|
|
72,
|
|
73,
|
|
75,
|
|
79,
|
|
82,
|
|
83,
|
|
84,
|
|
85,
|
|
86,
|
|
92,
|
|
95,
|
|
96,
|
|
97,
|
|
102,
|
|
103,
|
|
105
|
|
]
|
|
},
|
|
"marker_stats": {
|
|
"num_markers_used": 42,
|
|
"mean_error_m": 0.03460339250572968,
|
|
"rms_error_m": 0.10160538456713963,
|
|
"median_error_m": 0.005995725852656375,
|
|
"worst_error_m": 0.3929053484217573
|
|
},
|
|
"marker_reports": [
|
|
{
|
|
"marker_id": 46,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.012685824952448077,
|
|
-0.009649285475931024,
|
|
0.013323395661109926
|
|
],
|
|
"error_norm_m": 0.020773823356875123,
|
|
"predicted_m": [
|
|
0.5395058025150521,
|
|
0.1854026757912692,
|
|
-0.031239134022212588
|
|
],
|
|
"observed_m": [
|
|
0.5521916274675002,
|
|
0.19505196126720023,
|
|
-0.04456252968332251
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 47,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.0014997958733345418,
|
|
0.003055467265318912,
|
|
0.0021079601686610737
|
|
],
|
|
"error_norm_m": 0.004003593878475735,
|
|
"predicted_m": [
|
|
0.3440265090521209,
|
|
-0.28532053889803843,
|
|
-0.026637853787601206
|
|
],
|
|
"observed_m": [
|
|
0.34252671317878636,
|
|
-0.28837600616335735,
|
|
-0.02874581395626228
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 51,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.00026502809332140664,
|
|
0.001168205409359413,
|
|
0.001015800525628361
|
|
],
|
|
"error_norm_m": 0.0015706032206044367,
|
|
"predicted_m": [
|
|
0.16833149285762106,
|
|
-0.1697585761438859,
|
|
-0.02894665192132234
|
|
],
|
|
"observed_m": [
|
|
0.16859652095094246,
|
|
-0.1709267815532453,
|
|
-0.029962452446950703
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 53,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.0007678858513761044,
|
|
0.0004644961936310088,
|
|
-0.0033898841612772547
|
|
],
|
|
"error_norm_m": 0.003506667937161957,
|
|
"predicted_m": [
|
|
0.48921820646832004,
|
|
0.21251838631581146,
|
|
-0.03182864788118077
|
|
],
|
|
"observed_m": [
|
|
0.48845032061694393,
|
|
0.21205389012218046,
|
|
-0.028438763719903514
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 55,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.0006390076116649657,
|
|
0.0010172761897459526,
|
|
0.0010893034975956103
|
|
],
|
|
"error_norm_m": 0.0016216546129998943,
|
|
"predicted_m": [
|
|
0.2836711695056911,
|
|
-0.2609812012824432,
|
|
-0.027247224503367903
|
|
],
|
|
"observed_m": [
|
|
0.28303216189402614,
|
|
-0.26199847747218913,
|
|
-0.028336528000963514
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 56,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.012227744641920446,
|
|
-0.01125009231546012,
|
|
0.017219838969664836
|
|
],
|
|
"error_norm_m": 0.023929169861814613,
|
|
"predicted_m": [
|
|
0.501370300013414,
|
|
0.16887399652923807,
|
|
-0.03124242042623228
|
|
],
|
|
"observed_m": [
|
|
0.5135980446553344,
|
|
0.1801240888446982,
|
|
-0.048462259395897114
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 58,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.00010200428773012721,
|
|
0.0007143951371397228,
|
|
0.0008366871229240555
|
|
],
|
|
"error_norm_m": 0.0011049029949960075,
|
|
"predicted_m": [
|
|
0.05033236684247467,
|
|
-0.21504218041637846,
|
|
-0.029026924917424007
|
|
],
|
|
"observed_m": [
|
|
0.05023036255474454,
|
|
-0.21575657555351818,
|
|
-0.029863612040348063
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 61,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.008035233032862025,
|
|
-0.022841936137153296,
|
|
0.022813009358264184
|
|
],
|
|
"error_norm_m": 0.033267888606980094,
|
|
"predicted_m": [
|
|
-0.01864731034125329,
|
|
0.33930435858295105,
|
|
-0.03602281907713707
|
|
],
|
|
"observed_m": [
|
|
-0.010612077308391265,
|
|
0.36214629472010434,
|
|
-0.058835828435401256
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 62,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.0008765545330541302,
|
|
0.005792750641072625,
|
|
0.0010183034070573825
|
|
],
|
|
"error_norm_m": 0.005946532575197896,
|
|
"predicted_m": [
|
|
0.4052041639383518,
|
|
-0.17427200523384054,
|
|
-0.027643942080317778
|
|
],
|
|
"observed_m": [
|
|
0.40432760940529766,
|
|
-0.18006475587491316,
|
|
-0.02866224548737516
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 63,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.015866484772870892,
|
|
0.007385919787924855,
|
|
0.018405415867788058
|
|
],
|
|
"error_norm_m": 0.025397962190451977,
|
|
"predicted_m": [
|
|
0.7775026220733696,
|
|
-0.23766637616559638,
|
|
-0.024922856918993215
|
|
],
|
|
"observed_m": [
|
|
0.7933691068462405,
|
|
-0.24505229595352124,
|
|
-0.04332827278678127
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 64,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.0004754752120111304,
|
|
0.001776790098072356,
|
|
-0.0031453833947510286
|
|
],
|
|
"error_norm_m": 0.0036436926914629486,
|
|
"predicted_m": [
|
|
-0.020834899571155665,
|
|
-0.18471497254973585,
|
|
-0.029764931844771598
|
|
],
|
|
"observed_m": [
|
|
-0.021310374783166795,
|
|
-0.1864917626478082,
|
|
-0.02661954845002057
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 66,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.0012731108183965945,
|
|
0.0006876176784452737,
|
|
-0.00044442338918422586
|
|
],
|
|
"error_norm_m": 0.0015136516694678826,
|
|
"predicted_m": [
|
|
0.20906269359216248,
|
|
-0.3611556011891355,
|
|
-0.026442038068722286
|
|
],
|
|
"observed_m": [
|
|
0.21033580441055907,
|
|
-0.36184321886758075,
|
|
-0.02599761467953806
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 68,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.005999286726092401,
|
|
-0.0002343850347767129,
|
|
-0.011976844580479873
|
|
],
|
|
"error_norm_m": 0.0133974319804717,
|
|
"predicted_m": [
|
|
0.5764302815395409,
|
|
0.17037061006940427,
|
|
-0.030864635819792405
|
|
],
|
|
"observed_m": [
|
|
0.5704309948134485,
|
|
0.17060499510418098,
|
|
-0.018887791239312533
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 69,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.0064527243033683365,
|
|
0.004026989242448709,
|
|
-0.008238690505665277
|
|
],
|
|
"error_norm_m": 0.011212952980469383,
|
|
"predicted_m": [
|
|
0.007451957280249863,
|
|
-0.277868565076297,
|
|
-0.028501314472499078
|
|
],
|
|
"observed_m": [
|
|
0.0139046815836182,
|
|
-0.2818955543187457,
|
|
-0.0202626239668338
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 72,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.002320191052193332,
|
|
-0.005075666293755082,
|
|
0.0012102579833339552
|
|
],
|
|
"error_norm_m": 0.005710551569722755,
|
|
"predicted_m": [
|
|
0.4438456271017049,
|
|
0.19488539890785356,
|
|
-0.03185687359664922
|
|
],
|
|
"observed_m": [
|
|
0.44152543604951155,
|
|
0.19996106520160864,
|
|
-0.03306713157998317
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 73,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.007409800631797803,
|
|
-0.006184057295090251,
|
|
-0.00213737086075539
|
|
],
|
|
"error_norm_m": 0.009885143611923719,
|
|
"predicted_m": [
|
|
0.22547702357625732,
|
|
0.3350451892583431,
|
|
-0.034684922969039106
|
|
],
|
|
"observed_m": [
|
|
0.21806722294445952,
|
|
0.34122924655343334,
|
|
-0.032547552108283716
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 75,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.004076281668749196,
|
|
0.0007523988483592314,
|
|
0.00040251454901708145
|
|
],
|
|
"error_norm_m": 0.004164636146431457,
|
|
"predicted_m": [
|
|
-0.022826768775181208,
|
|
0.19808795553617334,
|
|
-0.034355324630626884
|
|
],
|
|
"observed_m": [
|
|
-0.026903050443930404,
|
|
0.1973355566878141,
|
|
-0.034757839179643965
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 79,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.0008208092470192718,
|
|
0.0014626614911158742,
|
|
0.0020261612549668136
|
|
],
|
|
"error_norm_m": 0.0026302919778447317,
|
|
"predicted_m": [
|
|
0.31290915610661896,
|
|
-0.15770086556423232,
|
|
-0.028328748177466927
|
|
],
|
|
"observed_m": [
|
|
0.3120883468595997,
|
|
-0.1591635270553482,
|
|
-0.03035490943243374
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 82,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.004620758816891002,
|
|
-0.006660642371294712,
|
|
0.004753340368137474
|
|
],
|
|
"error_norm_m": 0.009397330126026629,
|
|
"predicted_m": [
|
|
0.22267866825354082,
|
|
0.2991946735990578,
|
|
-0.03427075579123611
|
|
],
|
|
"observed_m": [
|
|
0.21805790943664982,
|
|
0.30585531597035254,
|
|
-0.039024096159373585
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 83,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.005418482748924862,
|
|
0.004927118208021497,
|
|
-0.008572161024609653
|
|
],
|
|
"error_norm_m": 0.011274679319965165,
|
|
"predicted_m": [
|
|
0.047952004101645365,
|
|
0.342274247442862,
|
|
-0.0357072625914086
|
|
],
|
|
"observed_m": [
|
|
0.0425335213527205,
|
|
0.3373471292348405,
|
|
-0.027135101566798946
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 84,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.0042035394232649015,
|
|
-0.004062165066029411,
|
|
-0.001160529984860395
|
|
],
|
|
"error_norm_m": 0.005959677722190355,
|
|
"predicted_m": [
|
|
0.410755001782214,
|
|
0.2591907623010232,
|
|
-0.032800671688123485
|
|
],
|
|
"observed_m": [
|
|
0.4065514623589491,
|
|
0.26325292736705264,
|
|
-0.03164014170326309
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 85,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.00025609833219297773,
|
|
0.0015252105778676972,
|
|
0.004000367524038789
|
|
],
|
|
"error_norm_m": 0.004288915246303635,
|
|
"predicted_m": [
|
|
0.5042041073073622,
|
|
-0.31253918335750047,
|
|
-0.025467806364690516
|
|
],
|
|
"observed_m": [
|
|
0.5039480089751692,
|
|
-0.31406439393536817,
|
|
-0.029468173888729306
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 86,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.005073142385576934,
|
|
-0.002882827650883657,
|
|
-0.00277504259692744
|
|
],
|
|
"error_norm_m": 0.006461294788492351,
|
|
"predicted_m": [
|
|
0.3663704485521694,
|
|
0.293058903395277,
|
|
-0.03343985350032342
|
|
],
|
|
"observed_m": [
|
|
0.36129730616659245,
|
|
0.29594173104616067,
|
|
-0.03066481090339598
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 92,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.0022231448409536503,
|
|
0.002027638456878089,
|
|
0.0009436235838031978
|
|
],
|
|
"error_norm_m": 0.003153429270425988,
|
|
"predicted_m": [
|
|
0.6455239184881204,
|
|
-0.1855268250468046,
|
|
-0.026242405738769736
|
|
],
|
|
"observed_m": [
|
|
0.6477470633290741,
|
|
-0.18755446350368268,
|
|
-0.027186029322572934
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 95,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.0008970886199909656,
|
|
0.001369673710777508,
|
|
0.002558847672888321
|
|
],
|
|
"error_norm_m": 0.0030378405947577795,
|
|
"predicted_m": [
|
|
0.1859213318573731,
|
|
-0.27185425732038365,
|
|
-0.027632441485459517
|
|
],
|
|
"observed_m": [
|
|
0.18502424323738215,
|
|
-0.27322393103116116,
|
|
-0.030191289158347838
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 96,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.0016048708315765103,
|
|
0.003033724580266406,
|
|
0.002550677091032117
|
|
],
|
|
"error_norm_m": 0.0042761020611853644,
|
|
"predicted_m": [
|
|
0.370202818787732,
|
|
-0.18544072260513306,
|
|
-0.027694833409366182
|
|
],
|
|
"observed_m": [
|
|
0.36859794795615547,
|
|
-0.18847444718539946,
|
|
-0.0302455105003983
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 97,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.0007633652578301064,
|
|
-0.006294814223912815,
|
|
0.0025212819624152658
|
|
],
|
|
"error_norm_m": 0.006823802119378733,
|
|
"predicted_m": [
|
|
0.3036821331717976,
|
|
-0.3581923999751065,
|
|
-0.025978689171064048
|
|
],
|
|
"observed_m": [
|
|
0.3044454984296277,
|
|
-0.3518975857511937,
|
|
-0.028499971133479313
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 102,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.004217172044255979,
|
|
0.0012818222005649416,
|
|
0.007364179515894815
|
|
],
|
|
"error_norm_m": 0.008582467485929678,
|
|
"predicted_m": [
|
|
0.6498807339562016,
|
|
-0.22371233969491253,
|
|
-0.025762582817033888
|
|
],
|
|
"observed_m": [
|
|
0.6540979060004576,
|
|
-0.22499416189547747,
|
|
-0.0331267623329287
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 103,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.0005248079291564622,
|
|
0.0020058196713332588,
|
|
-0.0015791934782283593
|
|
],
|
|
"error_norm_m": 0.002606259380432412,
|
|
"predicted_m": [
|
|
0.10614407281302585,
|
|
-0.18499565619410507,
|
|
-0.029092184530364915
|
|
],
|
|
"observed_m": [
|
|
0.10666888074218231,
|
|
-0.18700147586543833,
|
|
-0.027512991052136556
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 105,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.0016530819970690391,
|
|
0.00242105838692408,
|
|
0.0029719622723411374
|
|
],
|
|
"error_norm_m": 0.00417453752530125,
|
|
"predicted_m": [
|
|
0.5247595567590854,
|
|
-0.2661711789404367,
|
|
-0.025914196571593565
|
|
],
|
|
"observed_m": [
|
|
0.5264126387561544,
|
|
-0.26859223732736076,
|
|
-0.028886158843934702
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 205,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.001425331050775469,
|
|
0.003360710169565073,
|
|
-0.011089866759590186
|
|
],
|
|
"error_norm_m": 0.011675233881750983,
|
|
"predicted_m": [
|
|
0.7508888500677534,
|
|
-0.09102679627230495,
|
|
0.0007847926887032176
|
|
],
|
|
"observed_m": [
|
|
0.7494635190169779,
|
|
-0.09438750644187002,
|
|
0.011874659448293403
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 206,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.004417582605729442,
|
|
0.0034371783095402033,
|
|
-0.007928626745045336
|
|
],
|
|
"error_norm_m": 0.00970527448721906,
|
|
"predicted_m": [
|
|
0.651401758653761,
|
|
-0.010403590027052035,
|
|
-0.0007042528845845903
|
|
],
|
|
"observed_m": [
|
|
0.6469841760480316,
|
|
-0.013840768336592238,
|
|
0.007224373860460745
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 207,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.004538146533493492,
|
|
0.003396137731705844,
|
|
-0.012334950443628177
|
|
],
|
|
"error_norm_m": 0.013574959591060965,
|
|
"predicted_m": [
|
|
0.7513983413368077,
|
|
-0.011034111444401688,
|
|
-0.00016956189450933155
|
|
],
|
|
"observed_m": [
|
|
0.7468601948033142,
|
|
-0.014430249176107532,
|
|
0.012165388549118845
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 208,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.0024300150463291703,
|
|
0.003007354145040428,
|
|
-0.0035371785130940453
|
|
],
|
|
"error_norm_m": 0.005240303799644845,
|
|
"predicted_m": [
|
|
0.35090251933556676,
|
|
-0.08850471060290635,
|
|
-0.001353971271597816
|
|
],
|
|
"observed_m": [
|
|
0.3484725042892376,
|
|
-0.09151206474794678,
|
|
0.002183207241496229
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 210,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.00311325211669285,
|
|
0.0013000795136633124,
|
|
-0.004188782755158783
|
|
],
|
|
"error_norm_m": 0.005378517124064509,
|
|
"predicted_m": [
|
|
0.021359601341935174,
|
|
-0.01643039070123714,
|
|
-0.00395351179915715
|
|
],
|
|
"observed_m": [
|
|
0.018246349225242323,
|
|
-0.017730470214900453,
|
|
0.00023527095600163288
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 211,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.0012021663450060838,
|
|
0.0036674520960670483,
|
|
-0.009075339052334019
|
|
],
|
|
"error_norm_m": 0.009861905886431425,
|
|
"predicted_m": [
|
|
0.2514154279215743,
|
|
-0.00788150435765343,
|
|
-0.002843016844885624
|
|
],
|
|
"observed_m": [
|
|
0.2502132615765682,
|
|
-0.011548956453720479,
|
|
0.0062323222074483955
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 214,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.0012373542216077005,
|
|
0.0031460461405335635,
|
|
-0.00901503003888733
|
|
],
|
|
"error_norm_m": 0.009628053717659525,
|
|
"predicted_m": [
|
|
0.351412010604621,
|
|
-0.008512025775003082,
|
|
-0.0023083258548103652
|
|
],
|
|
"observed_m": [
|
|
0.3501746563830133,
|
|
-0.011658071915536646,
|
|
0.006706704184076964
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 215,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.00011825939198178981,
|
|
0.0036032087497955695,
|
|
-0.004835824521741555
|
|
],
|
|
"error_norm_m": 0.006031773983122394,
|
|
"predicted_m": [
|
|
0.25090593665252003,
|
|
-0.08787418918555669,
|
|
-0.0018886622616730749
|
|
],
|
|
"observed_m": [
|
|
0.2510241960445018,
|
|
-0.09147739793535226,
|
|
0.0029471622600684808
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 217,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.0008810603033599929,
|
|
0.0033206712331084742,
|
|
-0.003707805550344541
|
|
],
|
|
"error_norm_m": 0.005054794426652457,
|
|
"predicted_m": [
|
|
0.6508922673847067,
|
|
-0.0903962748549553,
|
|
0.00025010169862795884
|
|
],
|
|
"observed_m": [
|
|
0.6500112070813467,
|
|
-0.09371694608806377,
|
|
0.0039579072489725
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 243,
|
|
"link": "Arm1",
|
|
"error_m": [
|
|
-0.010555537258469722,
|
|
0.389065982954994,
|
|
-0.05376666587088946
|
|
],
|
|
"error_norm_m": 0.3929053484217573,
|
|
"predicted_m": [
|
|
0.15411009338085083,
|
|
0.27599498713702036,
|
|
0.2886231161888597
|
|
],
|
|
"observed_m": [
|
|
0.16466563063932055,
|
|
-0.11307099581797364,
|
|
0.3423897820597492
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 246,
|
|
"link": "Ellbow",
|
|
"error_m": [
|
|
0.012555236860652713,
|
|
0.37253563689893276,
|
|
-0.07428685921048511
|
|
],
|
|
"error_norm_m": 0.3800775870577993,
|
|
"predicted_m": [
|
|
0.2438542040097105,
|
|
0.23577779122678744,
|
|
0.2896289639860958
|
|
],
|
|
"observed_m": [
|
|
0.2312989671490578,
|
|
-0.13675784567214536,
|
|
0.3639158231965809
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 247,
|
|
"link": "Ellbow",
|
|
"error_m": [
|
|
0.006062565584941421,
|
|
0.3553752403841762,
|
|
-0.06256336625952014
|
|
],
|
|
"error_norm_m": 0.36089124535974215,
|
|
"predicted_m": [
|
|
0.20635548550383057,
|
|
0.2360142367582919,
|
|
0.28942845486481894
|
|
],
|
|
"observed_m": [
|
|
0.20029291991888915,
|
|
-0.11936100362588432,
|
|
0.3519918211243391
|
|
]
|
|
}
|
|
],
|
|
"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.04246653176577006,
|
|
"new": 0.04476403875746596,
|
|
"info": {
|
|
"reason": "weighted_projection",
|
|
"used_markers": 8,
|
|
"axis_world": [
|
|
0.9999658268294671,
|
|
-0.00630521417349021,
|
|
0.00534690990074724
|
|
],
|
|
"per_marker": [
|
|
{
|
|
"marker_id": 243,
|
|
"q_i": 0.05576233817620601,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 246,
|
|
"q_i": 0.03265784607819604,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 247,
|
|
"q_i": 0.0389794110428862,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 120,
|
|
"q_i": 0.03908465927244201,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 218,
|
|
"q_i": 0.00428711301336939,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 114,
|
|
"q_i": 0.04800460630723797,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 115,
|
|
"q_i": 0.13122631411834135,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 219,
|
|
"q_i": 0.008110022051048715,
|
|
"weight": 1.0
|
|
}
|
|
]
|
|
}
|
|
},
|
|
{
|
|
"link": "Arm1",
|
|
"joint_variable": "y",
|
|
"joint_type": "revolute",
|
|
"old": 2.1743321918219856,
|
|
"new": 2.146047310904782,
|
|
"info": {
|
|
"reason": "2d_alignment+normal_tiebreak",
|
|
"used_markers": 8,
|
|
"axis_world": [
|
|
-0.9999658268294671,
|
|
0.00630521417349021,
|
|
-0.00534690990074724
|
|
],
|
|
"axis_id": 0,
|
|
"theta_rad": -0.9955453426850104,
|
|
"theta_alt_rad": 2.146047310904782,
|
|
"score_theta": 1.9409938165226586,
|
|
"score_theta_alt": 1.0989773370652702,
|
|
"best_score": 1.0989773370652702,
|
|
"per_marker": [
|
|
{
|
|
"marker_id": 243,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 246,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 247,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 120,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 218,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 114,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 115,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 219,
|
|
"weight": 1.0
|
|
}
|
|
]
|
|
}
|
|
},
|
|
{
|
|
"link": "Ellbow",
|
|
"joint_variable": "z",
|
|
"joint_type": "revolute",
|
|
"old": -2.775266504500333,
|
|
"new": -0.9993455149410977,
|
|
"info": {
|
|
"reason": "2d_alignment+normal_tiebreak",
|
|
"used_markers": 7,
|
|
"axis_world": [
|
|
-0.9999658268294671,
|
|
0.00630521417349021,
|
|
-0.00534690990074724
|
|
],
|
|
"axis_id": 0,
|
|
"theta_rad": 2.142247138648695,
|
|
"theta_alt_rad": -0.9993455149410977,
|
|
"score_theta": 2.0589675061728876,
|
|
"score_theta_alt": 1.3205386744867353,
|
|
"best_score": 1.3205386744867353,
|
|
"per_marker": [
|
|
{
|
|
"marker_id": 246,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 247,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 120,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 218,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 114,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 115,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 219,
|
|
"weight": 1.0
|
|
}
|
|
]
|
|
}
|
|
},
|
|
{
|
|
"link": "Arm2",
|
|
"joint_variable": "a",
|
|
"joint_type": "revolute",
|
|
"old": 0.0,
|
|
"new": -0.9168044723458806,
|
|
"info": {
|
|
"reason": "2d_alignment+normal_tiebreak",
|
|
"used_markers": 5,
|
|
"axis_world": [
|
|
-0.007424904728598183,
|
|
-0.40055477978096615,
|
|
0.9162427294022
|
|
],
|
|
"axis_id": 2,
|
|
"theta_rad": -0.9168044723458808,
|
|
"theta_alt_rad": 2.2247881812439125,
|
|
"score_theta": 0.9895740730519235,
|
|
"score_theta_alt": 1.2593388700019863,
|
|
"best_score": 0.9895740730519235,
|
|
"per_marker": [
|
|
{
|
|
"marker_id": 120,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 218,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 114,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 115,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 219,
|
|
"weight": 1.0
|
|
}
|
|
]
|
|
}
|
|
}
|
|
]
|
|
},
|
|
{
|
|
"pass": 1,
|
|
"updates": [
|
|
{
|
|
"link": "Base",
|
|
"joint_variable": "x",
|
|
"joint_type": "linear",
|
|
"old": 0.04476403875746596,
|
|
"new": 0.05676870395702915,
|
|
"info": {
|
|
"reason": "weighted_projection",
|
|
"used_markers": 8,
|
|
"axis_world": [
|
|
0.9999658268294671,
|
|
-0.00630521417349021,
|
|
0.00534690990074724
|
|
],
|
|
"per_marker": [
|
|
{
|
|
"marker_id": 243,
|
|
"q_i": 0.05576233817620601,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 246,
|
|
"q_i": 0.032657846077926406,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 247,
|
|
"q_i": 0.03897941104272891,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 120,
|
|
"q_i": 0.06842088921707805,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 218,
|
|
"q_i": 0.01799453309723278,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 114,
|
|
"q_i": 0.07734083625187398,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 115,
|
|
"q_i": 0.14117633565827495,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 219,
|
|
"q_i": 0.021817442134912064,
|
|
"weight": 1.0
|
|
}
|
|
]
|
|
}
|
|
},
|
|
{
|
|
"link": "Arm1",
|
|
"joint_variable": "y",
|
|
"joint_type": "revolute",
|
|
"old": 2.146047310904782,
|
|
"new": 2.2025331885734767,
|
|
"info": {
|
|
"reason": "2d_alignment+normal_tiebreak",
|
|
"used_markers": 8,
|
|
"axis_world": [
|
|
-0.9999658268294671,
|
|
0.00630521417349021,
|
|
-0.00534690990074724
|
|
],
|
|
"axis_id": 0,
|
|
"theta_rad": -0.9390594650163167,
|
|
"theta_alt_rad": 2.2025331885734767,
|
|
"score_theta": 2.7125355036469765,
|
|
"score_theta_alt": 1.4817960447275145,
|
|
"best_score": 1.4817960447275145,
|
|
"per_marker": [
|
|
{
|
|
"marker_id": 243,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 246,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 247,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 120,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 218,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 114,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 115,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 219,
|
|
"weight": 1.0
|
|
}
|
|
]
|
|
}
|
|
},
|
|
{
|
|
"link": "Ellbow",
|
|
"joint_variable": "z",
|
|
"joint_type": "revolute",
|
|
"old": -0.9993455149410977,
|
|
"new": -1.0146056468008098,
|
|
"info": {
|
|
"reason": "2d_alignment+normal_tiebreak",
|
|
"used_markers": 7,
|
|
"axis_world": [
|
|
-0.9999658268294671,
|
|
0.00630521417349021,
|
|
-0.005346909900747239
|
|
],
|
|
"axis_id": 0,
|
|
"theta_rad": 2.1269870067889833,
|
|
"theta_alt_rad": -1.0146056468008098,
|
|
"score_theta": 2.1639401669822225,
|
|
"score_theta_alt": 1.3745974432028025,
|
|
"best_score": 1.3745974432028025,
|
|
"per_marker": [
|
|
{
|
|
"marker_id": 246,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 247,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 120,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 218,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 114,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 115,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 219,
|
|
"weight": 1.0
|
|
}
|
|
]
|
|
}
|
|
},
|
|
{
|
|
"link": "Arm2",
|
|
"joint_variable": "a",
|
|
"joint_type": "revolute",
|
|
"old": -0.9168044723458806,
|
|
"new": -0.9415837130435447,
|
|
"info": {
|
|
"reason": "2d_alignment+normal_tiebreak",
|
|
"used_markers": 5,
|
|
"axis_world": [
|
|
-0.007268767427366146,
|
|
-0.36245200712450737,
|
|
0.9319740916728871
|
|
],
|
|
"axis_id": 2,
|
|
"theta_rad": -0.9415837130435445,
|
|
"theta_alt_rad": 2.2000089405462484,
|
|
"score_theta": 1.054826916033487,
|
|
"score_theta_alt": 1.3239486124763613,
|
|
"best_score": 1.054826916033487,
|
|
"per_marker": [
|
|
{
|
|
"marker_id": 120,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 218,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 114,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 115,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 219,
|
|
"weight": 1.0
|
|
}
|
|
]
|
|
}
|
|
}
|
|
]
|
|
}
|
|
],
|
|
"root_link": "Board",
|
|
"root_pose": {
|
|
"reason": "kabsch",
|
|
"used_markers": [
|
|
210,
|
|
211,
|
|
215,
|
|
214,
|
|
208,
|
|
206,
|
|
205,
|
|
207,
|
|
217,
|
|
46,
|
|
47,
|
|
51,
|
|
53,
|
|
55,
|
|
56,
|
|
58,
|
|
61,
|
|
62,
|
|
63,
|
|
64,
|
|
66,
|
|
68,
|
|
69,
|
|
72,
|
|
73,
|
|
75,
|
|
79,
|
|
82,
|
|
83,
|
|
84,
|
|
85,
|
|
86,
|
|
92,
|
|
95,
|
|
96,
|
|
97,
|
|
102,
|
|
103,
|
|
105
|
|
]
|
|
},
|
|
"marker_stats": {
|
|
"num_markers_used": 47,
|
|
"mean_error_m": 0.07951549317070679,
|
|
"rms_error_m": 0.17716738948089994,
|
|
"median_error_m": 0.006823802119378733,
|
|
"worst_error_m": 0.48127974586886396
|
|
},
|
|
"marker_reports": [
|
|
{
|
|
"marker_id": 46,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.012685824952448077,
|
|
-0.009649285475931024,
|
|
0.013323395661109926
|
|
],
|
|
"error_norm_m": 0.020773823356875123,
|
|
"predicted_m": [
|
|
0.5395058025150521,
|
|
0.1854026757912692,
|
|
-0.031239134022212588
|
|
],
|
|
"observed_m": [
|
|
0.5521916274675002,
|
|
0.19505196126720023,
|
|
-0.04456252968332251
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 47,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.0014997958733345418,
|
|
0.003055467265318912,
|
|
0.0021079601686610737
|
|
],
|
|
"error_norm_m": 0.004003593878475735,
|
|
"predicted_m": [
|
|
0.3440265090521209,
|
|
-0.28532053889803843,
|
|
-0.026637853787601206
|
|
],
|
|
"observed_m": [
|
|
0.34252671317878636,
|
|
-0.28837600616335735,
|
|
-0.02874581395626228
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 51,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.00026502809332140664,
|
|
0.001168205409359413,
|
|
0.001015800525628361
|
|
],
|
|
"error_norm_m": 0.0015706032206044367,
|
|
"predicted_m": [
|
|
0.16833149285762106,
|
|
-0.1697585761438859,
|
|
-0.02894665192132234
|
|
],
|
|
"observed_m": [
|
|
0.16859652095094246,
|
|
-0.1709267815532453,
|
|
-0.029962452446950703
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 53,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.0007678858513761044,
|
|
0.0004644961936310088,
|
|
-0.0033898841612772547
|
|
],
|
|
"error_norm_m": 0.003506667937161957,
|
|
"predicted_m": [
|
|
0.48921820646832004,
|
|
0.21251838631581146,
|
|
-0.03182864788118077
|
|
],
|
|
"observed_m": [
|
|
0.48845032061694393,
|
|
0.21205389012218046,
|
|
-0.028438763719903514
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 55,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.0006390076116649657,
|
|
0.0010172761897459526,
|
|
0.0010893034975956103
|
|
],
|
|
"error_norm_m": 0.0016216546129998943,
|
|
"predicted_m": [
|
|
0.2836711695056911,
|
|
-0.2609812012824432,
|
|
-0.027247224503367903
|
|
],
|
|
"observed_m": [
|
|
0.28303216189402614,
|
|
-0.26199847747218913,
|
|
-0.028336528000963514
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 56,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.012227744641920446,
|
|
-0.01125009231546012,
|
|
0.017219838969664836
|
|
],
|
|
"error_norm_m": 0.023929169861814613,
|
|
"predicted_m": [
|
|
0.501370300013414,
|
|
0.16887399652923807,
|
|
-0.03124242042623228
|
|
],
|
|
"observed_m": [
|
|
0.5135980446553344,
|
|
0.1801240888446982,
|
|
-0.048462259395897114
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 58,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.00010200428773012721,
|
|
0.0007143951371397228,
|
|
0.0008366871229240555
|
|
],
|
|
"error_norm_m": 0.0011049029949960075,
|
|
"predicted_m": [
|
|
0.05033236684247467,
|
|
-0.21504218041637846,
|
|
-0.029026924917424007
|
|
],
|
|
"observed_m": [
|
|
0.05023036255474454,
|
|
-0.21575657555351818,
|
|
-0.029863612040348063
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 61,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.008035233032862025,
|
|
-0.022841936137153296,
|
|
0.022813009358264184
|
|
],
|
|
"error_norm_m": 0.033267888606980094,
|
|
"predicted_m": [
|
|
-0.01864731034125329,
|
|
0.33930435858295105,
|
|
-0.03602281907713707
|
|
],
|
|
"observed_m": [
|
|
-0.010612077308391265,
|
|
0.36214629472010434,
|
|
-0.058835828435401256
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 62,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.0008765545330541302,
|
|
0.005792750641072625,
|
|
0.0010183034070573825
|
|
],
|
|
"error_norm_m": 0.005946532575197896,
|
|
"predicted_m": [
|
|
0.4052041639383518,
|
|
-0.17427200523384054,
|
|
-0.027643942080317778
|
|
],
|
|
"observed_m": [
|
|
0.40432760940529766,
|
|
-0.18006475587491316,
|
|
-0.02866224548737516
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 63,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.015866484772870892,
|
|
0.007385919787924855,
|
|
0.018405415867788058
|
|
],
|
|
"error_norm_m": 0.025397962190451977,
|
|
"predicted_m": [
|
|
0.7775026220733696,
|
|
-0.23766637616559638,
|
|
-0.024922856918993215
|
|
],
|
|
"observed_m": [
|
|
0.7933691068462405,
|
|
-0.24505229595352124,
|
|
-0.04332827278678127
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 64,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.0004754752120111304,
|
|
0.001776790098072356,
|
|
-0.0031453833947510286
|
|
],
|
|
"error_norm_m": 0.0036436926914629486,
|
|
"predicted_m": [
|
|
-0.020834899571155665,
|
|
-0.18471497254973585,
|
|
-0.029764931844771598
|
|
],
|
|
"observed_m": [
|
|
-0.021310374783166795,
|
|
-0.1864917626478082,
|
|
-0.02661954845002057
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 66,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.0012731108183965945,
|
|
0.0006876176784452737,
|
|
-0.00044442338918422586
|
|
],
|
|
"error_norm_m": 0.0015136516694678826,
|
|
"predicted_m": [
|
|
0.20906269359216248,
|
|
-0.3611556011891355,
|
|
-0.026442038068722286
|
|
],
|
|
"observed_m": [
|
|
0.21033580441055907,
|
|
-0.36184321886758075,
|
|
-0.02599761467953806
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 68,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.005999286726092401,
|
|
-0.0002343850347767129,
|
|
-0.011976844580479873
|
|
],
|
|
"error_norm_m": 0.0133974319804717,
|
|
"predicted_m": [
|
|
0.5764302815395409,
|
|
0.17037061006940427,
|
|
-0.030864635819792405
|
|
],
|
|
"observed_m": [
|
|
0.5704309948134485,
|
|
0.17060499510418098,
|
|
-0.018887791239312533
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 69,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.0064527243033683365,
|
|
0.004026989242448709,
|
|
-0.008238690505665277
|
|
],
|
|
"error_norm_m": 0.011212952980469383,
|
|
"predicted_m": [
|
|
0.007451957280249863,
|
|
-0.277868565076297,
|
|
-0.028501314472499078
|
|
],
|
|
"observed_m": [
|
|
0.0139046815836182,
|
|
-0.2818955543187457,
|
|
-0.0202626239668338
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 72,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.002320191052193332,
|
|
-0.005075666293755082,
|
|
0.0012102579833339552
|
|
],
|
|
"error_norm_m": 0.005710551569722755,
|
|
"predicted_m": [
|
|
0.4438456271017049,
|
|
0.19488539890785356,
|
|
-0.03185687359664922
|
|
],
|
|
"observed_m": [
|
|
0.44152543604951155,
|
|
0.19996106520160864,
|
|
-0.03306713157998317
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 73,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.007409800631797803,
|
|
-0.006184057295090251,
|
|
-0.00213737086075539
|
|
],
|
|
"error_norm_m": 0.009885143611923719,
|
|
"predicted_m": [
|
|
0.22547702357625732,
|
|
0.3350451892583431,
|
|
-0.034684922969039106
|
|
],
|
|
"observed_m": [
|
|
0.21806722294445952,
|
|
0.34122924655343334,
|
|
-0.032547552108283716
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 75,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.004076281668749196,
|
|
0.0007523988483592314,
|
|
0.00040251454901708145
|
|
],
|
|
"error_norm_m": 0.004164636146431457,
|
|
"predicted_m": [
|
|
-0.022826768775181208,
|
|
0.19808795553617334,
|
|
-0.034355324630626884
|
|
],
|
|
"observed_m": [
|
|
-0.026903050443930404,
|
|
0.1973355566878141,
|
|
-0.034757839179643965
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 79,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.0008208092470192718,
|
|
0.0014626614911158742,
|
|
0.0020261612549668136
|
|
],
|
|
"error_norm_m": 0.0026302919778447317,
|
|
"predicted_m": [
|
|
0.31290915610661896,
|
|
-0.15770086556423232,
|
|
-0.028328748177466927
|
|
],
|
|
"observed_m": [
|
|
0.3120883468595997,
|
|
-0.1591635270553482,
|
|
-0.03035490943243374
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 82,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.004620758816891002,
|
|
-0.006660642371294712,
|
|
0.004753340368137474
|
|
],
|
|
"error_norm_m": 0.009397330126026629,
|
|
"predicted_m": [
|
|
0.22267866825354082,
|
|
0.2991946735990578,
|
|
-0.03427075579123611
|
|
],
|
|
"observed_m": [
|
|
0.21805790943664982,
|
|
0.30585531597035254,
|
|
-0.039024096159373585
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 83,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.005418482748924862,
|
|
0.004927118208021497,
|
|
-0.008572161024609653
|
|
],
|
|
"error_norm_m": 0.011274679319965165,
|
|
"predicted_m": [
|
|
0.047952004101645365,
|
|
0.342274247442862,
|
|
-0.0357072625914086
|
|
],
|
|
"observed_m": [
|
|
0.0425335213527205,
|
|
0.3373471292348405,
|
|
-0.027135101566798946
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 84,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.0042035394232649015,
|
|
-0.004062165066029411,
|
|
-0.001160529984860395
|
|
],
|
|
"error_norm_m": 0.005959677722190355,
|
|
"predicted_m": [
|
|
0.410755001782214,
|
|
0.2591907623010232,
|
|
-0.032800671688123485
|
|
],
|
|
"observed_m": [
|
|
0.4065514623589491,
|
|
0.26325292736705264,
|
|
-0.03164014170326309
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 85,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.00025609833219297773,
|
|
0.0015252105778676972,
|
|
0.004000367524038789
|
|
],
|
|
"error_norm_m": 0.004288915246303635,
|
|
"predicted_m": [
|
|
0.5042041073073622,
|
|
-0.31253918335750047,
|
|
-0.025467806364690516
|
|
],
|
|
"observed_m": [
|
|
0.5039480089751692,
|
|
-0.31406439393536817,
|
|
-0.029468173888729306
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 86,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.005073142385576934,
|
|
-0.002882827650883657,
|
|
-0.00277504259692744
|
|
],
|
|
"error_norm_m": 0.006461294788492351,
|
|
"predicted_m": [
|
|
0.3663704485521694,
|
|
0.293058903395277,
|
|
-0.03343985350032342
|
|
],
|
|
"observed_m": [
|
|
0.36129730616659245,
|
|
0.29594173104616067,
|
|
-0.03066481090339598
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 92,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.0022231448409536503,
|
|
0.002027638456878089,
|
|
0.0009436235838031978
|
|
],
|
|
"error_norm_m": 0.003153429270425988,
|
|
"predicted_m": [
|
|
0.6455239184881204,
|
|
-0.1855268250468046,
|
|
-0.026242405738769736
|
|
],
|
|
"observed_m": [
|
|
0.6477470633290741,
|
|
-0.18755446350368268,
|
|
-0.027186029322572934
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 95,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.0008970886199909656,
|
|
0.001369673710777508,
|
|
0.002558847672888321
|
|
],
|
|
"error_norm_m": 0.0030378405947577795,
|
|
"predicted_m": [
|
|
0.1859213318573731,
|
|
-0.27185425732038365,
|
|
-0.027632441485459517
|
|
],
|
|
"observed_m": [
|
|
0.18502424323738215,
|
|
-0.27322393103116116,
|
|
-0.030191289158347838
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 96,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.0016048708315765103,
|
|
0.003033724580266406,
|
|
0.002550677091032117
|
|
],
|
|
"error_norm_m": 0.0042761020611853644,
|
|
"predicted_m": [
|
|
0.370202818787732,
|
|
-0.18544072260513306,
|
|
-0.027694833409366182
|
|
],
|
|
"observed_m": [
|
|
0.36859794795615547,
|
|
-0.18847444718539946,
|
|
-0.0302455105003983
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 97,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.0007633652578301064,
|
|
-0.006294814223912815,
|
|
0.0025212819624152658
|
|
],
|
|
"error_norm_m": 0.006823802119378733,
|
|
"predicted_m": [
|
|
0.3036821331717976,
|
|
-0.3581923999751065,
|
|
-0.025978689171064048
|
|
],
|
|
"observed_m": [
|
|
0.3044454984296277,
|
|
-0.3518975857511937,
|
|
-0.028499971133479313
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 102,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.004217172044255979,
|
|
0.0012818222005649416,
|
|
0.007364179515894815
|
|
],
|
|
"error_norm_m": 0.008582467485929678,
|
|
"predicted_m": [
|
|
0.6498807339562016,
|
|
-0.22371233969491253,
|
|
-0.025762582817033888
|
|
],
|
|
"observed_m": [
|
|
0.6540979060004576,
|
|
-0.22499416189547747,
|
|
-0.0331267623329287
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 103,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.0005248079291564622,
|
|
0.0020058196713332588,
|
|
-0.0015791934782283593
|
|
],
|
|
"error_norm_m": 0.002606259380432412,
|
|
"predicted_m": [
|
|
0.10614407281302585,
|
|
-0.18499565619410507,
|
|
-0.029092184530364915
|
|
],
|
|
"observed_m": [
|
|
0.10666888074218231,
|
|
-0.18700147586543833,
|
|
-0.027512991052136556
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 105,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.0016530819970690391,
|
|
0.00242105838692408,
|
|
0.0029719622723411374
|
|
],
|
|
"error_norm_m": 0.00417453752530125,
|
|
"predicted_m": [
|
|
0.5247595567590854,
|
|
-0.2661711789404367,
|
|
-0.025914196571593565
|
|
],
|
|
"observed_m": [
|
|
0.5264126387561544,
|
|
-0.26859223732736076,
|
|
-0.028886158843934702
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 114,
|
|
"link": "Arm2",
|
|
"error_m": [
|
|
-0.01967945957874967,
|
|
0.40626224724922766,
|
|
0.15146710852498407
|
|
],
|
|
"error_norm_m": 0.43402601262392504,
|
|
"predicted_m": [
|
|
0.2515887414118118,
|
|
0.16267220151381032,
|
|
0.41350957882222195
|
|
],
|
|
"observed_m": [
|
|
0.2712682009905615,
|
|
-0.24359004573541737,
|
|
0.2620424702972379
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 115,
|
|
"link": "Arm2",
|
|
"error_m": [
|
|
-0.08263831836352861,
|
|
0.43026185478832807,
|
|
0.19918794751629437
|
|
],
|
|
"error_norm_m": 0.48127974586886396,
|
|
"predicted_m": [
|
|
0.22261618572133193,
|
|
0.20015405405421124,
|
|
0.42786059784133973
|
|
],
|
|
"observed_m": [
|
|
0.30525450408486055,
|
|
-0.23010780073411682,
|
|
0.22867265032504536
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 120,
|
|
"link": "Arm2",
|
|
"error_m": [
|
|
-0.010468650802462287,
|
|
0.36994895722319115,
|
|
0.054306307323150615
|
|
],
|
|
"error_norm_m": 0.3740601537389767,
|
|
"predicted_m": [
|
|
0.2520975551317268,
|
|
0.1880438420124955,
|
|
0.34827139240519783
|
|
],
|
|
"observed_m": [
|
|
0.2625662059341891,
|
|
-0.18190511521069566,
|
|
0.2939650850820472
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 205,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.001425331050775469,
|
|
0.003360710169565073,
|
|
-0.011089866759590186
|
|
],
|
|
"error_norm_m": 0.011675233881750983,
|
|
"predicted_m": [
|
|
0.7508888500677534,
|
|
-0.09102679627230495,
|
|
0.0007847926887032176
|
|
],
|
|
"observed_m": [
|
|
0.7494635190169779,
|
|
-0.09438750644187002,
|
|
0.011874659448293403
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 206,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.004417582605729442,
|
|
0.0034371783095402033,
|
|
-0.007928626745045336
|
|
],
|
|
"error_norm_m": 0.00970527448721906,
|
|
"predicted_m": [
|
|
0.651401758653761,
|
|
-0.010403590027052035,
|
|
-0.0007042528845845903
|
|
],
|
|
"observed_m": [
|
|
0.6469841760480316,
|
|
-0.013840768336592238,
|
|
0.007224373860460745
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 207,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.004538146533493492,
|
|
0.003396137731705844,
|
|
-0.012334950443628177
|
|
],
|
|
"error_norm_m": 0.013574959591060965,
|
|
"predicted_m": [
|
|
0.7513983413368077,
|
|
-0.011034111444401688,
|
|
-0.00016956189450933155
|
|
],
|
|
"observed_m": [
|
|
0.7468601948033142,
|
|
-0.014430249176107532,
|
|
0.012165388549118845
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 208,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.0024300150463291703,
|
|
0.003007354145040428,
|
|
-0.0035371785130940453
|
|
],
|
|
"error_norm_m": 0.005240303799644845,
|
|
"predicted_m": [
|
|
0.35090251933556676,
|
|
-0.08850471060290635,
|
|
-0.001353971271597816
|
|
],
|
|
"observed_m": [
|
|
0.3484725042892376,
|
|
-0.09151206474794678,
|
|
0.002183207241496229
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 210,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.00311325211669285,
|
|
0.0013000795136633124,
|
|
-0.004188782755158783
|
|
],
|
|
"error_norm_m": 0.005378517124064509,
|
|
"predicted_m": [
|
|
0.021359601341935174,
|
|
-0.01643039070123714,
|
|
-0.00395351179915715
|
|
],
|
|
"observed_m": [
|
|
0.018246349225242323,
|
|
-0.017730470214900453,
|
|
0.00023527095600163288
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 211,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.0012021663450060838,
|
|
0.0036674520960670483,
|
|
-0.009075339052334019
|
|
],
|
|
"error_norm_m": 0.009861905886431425,
|
|
"predicted_m": [
|
|
0.2514154279215743,
|
|
-0.00788150435765343,
|
|
-0.002843016844885624
|
|
],
|
|
"observed_m": [
|
|
0.2502132615765682,
|
|
-0.011548956453720479,
|
|
0.0062323222074483955
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 214,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.0012373542216077005,
|
|
0.0031460461405335635,
|
|
-0.00901503003888733
|
|
],
|
|
"error_norm_m": 0.009628053717659525,
|
|
"predicted_m": [
|
|
0.351412010604621,
|
|
-0.008512025775003082,
|
|
-0.0023083258548103652
|
|
],
|
|
"observed_m": [
|
|
0.3501746563830133,
|
|
-0.011658071915536646,
|
|
0.006706704184076964
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 215,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.00011825939198178981,
|
|
0.0036032087497955695,
|
|
-0.004835824521741555
|
|
],
|
|
"error_norm_m": 0.006031773983122394,
|
|
"predicted_m": [
|
|
0.25090593665252003,
|
|
-0.08787418918555669,
|
|
-0.0018886622616730749
|
|
],
|
|
"observed_m": [
|
|
0.2510241960445018,
|
|
-0.09147739793535226,
|
|
0.0029471622600684808
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 217,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.0008810603033599929,
|
|
0.0033206712331084742,
|
|
-0.003707805550344541
|
|
],
|
|
"error_norm_m": 0.005054794426652457,
|
|
"predicted_m": [
|
|
0.6508922673847067,
|
|
-0.0903962748549553,
|
|
0.00025010169862795884
|
|
],
|
|
"observed_m": [
|
|
0.6500112070813467,
|
|
-0.09371694608806377,
|
|
0.0039579072489725
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 218,
|
|
"link": "Arm2",
|
|
"error_m": [
|
|
0.04023284343235667,
|
|
0.3839854893612175,
|
|
0.050314152934565426
|
|
],
|
|
"error_norm_m": 0.38935209222007405,
|
|
"predicted_m": [
|
|
0.2781637582858243,
|
|
0.1937311268314266,
|
|
0.3506865206649456
|
|
],
|
|
"observed_m": [
|
|
0.23793091485346762,
|
|
-0.19025436252979092,
|
|
0.3003723677303802
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 219,
|
|
"link": "Arm2",
|
|
"error_m": [
|
|
0.035933531300229776,
|
|
0.4322291862527531,
|
|
0.19627565765974186
|
|
],
|
|
"error_norm_m": 0.4760645144412529,
|
|
"predicted_m": [
|
|
0.27738600017109705,
|
|
0.15494876206915068,
|
|
0.45040774847382536
|
|
],
|
|
"observed_m": [
|
|
0.24145246887086727,
|
|
-0.2772804241836024,
|
|
0.2541320908140835
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 243,
|
|
"link": "Arm1",
|
|
"error_m": [
|
|
0.0038124084775218448,
|
|
0.3954717006272385,
|
|
-0.05842227539207423
|
|
],
|
|
"error_norm_m": 0.39978189393391367,
|
|
"predicted_m": [
|
|
0.1684780391168424,
|
|
0.2824007048092649,
|
|
0.28396750666767495
|
|
],
|
|
"observed_m": [
|
|
0.16466563063932055,
|
|
-0.11307099581797364,
|
|
0.3423897820597492
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 246,
|
|
"link": "Ellbow",
|
|
"error_m": [
|
|
0.027331088081852195,
|
|
0.4302052560808246,
|
|
-0.09477622480943493
|
|
],
|
|
"error_norm_m": 0.4413684215306238,
|
|
"predicted_m": [
|
|
0.25863005523091,
|
|
0.2934474104086792,
|
|
0.26913959838714596
|
|
],
|
|
"observed_m": [
|
|
0.2312989671490578,
|
|
-0.13675784567214536,
|
|
0.3639158231965809
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 247,
|
|
"link": "Ellbow",
|
|
"error_m": [
|
|
0.020838416806033017,
|
|
0.4130448595660687,
|
|
-0.08305273185847051
|
|
],
|
|
"error_norm_m": 0.4218270402642419,
|
|
"predicted_m": [
|
|
0.22113133672492216,
|
|
0.29368385594018437,
|
|
0.26893908926586857
|
|
],
|
|
"observed_m": [
|
|
0.20029291991888915,
|
|
-0.11936100362588432,
|
|
0.3519918211243391
|
|
]
|
|
}
|
|
],
|
|
"stage_idx": 2,
|
|
"num_active_links": 5
|
|
}
|
|
],
|
|
"markers": [
|
|
{
|
|
"marker_id": 40,
|
|
"link": "FingerA",
|
|
"observed_position_m": [
|
|
0.26754171267144905,
|
|
-0.36415485234896816,
|
|
0.22944715198027135
|
|
],
|
|
"predicted_position_m": [
|
|
0.25174667303542936,
|
|
0.1274232408754857,
|
|
0.5360720968750458
|
|
],
|
|
"error_m": [
|
|
-0.015795039636019692,
|
|
0.4915780932244539,
|
|
0.30662494489477443
|
|
],
|
|
"error_norm_m": 0.5795837832850543
|
|
},
|
|
{
|
|
"marker_id": 42,
|
|
"link": "FingerA",
|
|
"observed_position_m": [
|
|
0.28744698956709797,
|
|
-0.35168719844503543,
|
|
0.22878287262176375
|
|
],
|
|
"predicted_position_m": [
|
|
0.26660680976708595,
|
|
0.1294771256461373,
|
|
0.5541546269430921
|
|
],
|
|
"error_m": [
|
|
-0.020840179800012015,
|
|
0.4811643240911727,
|
|
0.32537175432132837
|
|
],
|
|
"error_norm_m": 0.5812230194876583
|
|
},
|
|
{
|
|
"marker_id": 44,
|
|
"link": "FingerB",
|
|
"observed_position_m": [
|
|
0.3114364422937876,
|
|
-0.2851633006382941,
|
|
0.21856212483615103
|
|
],
|
|
"predicted_position_m": [
|
|
0.23226729608216232,
|
|
0.1468772769187186,
|
|
0.5200947893692511
|
|
],
|
|
"error_m": [
|
|
-0.07916914621162527,
|
|
0.4320405775570127,
|
|
0.3015326645331001
|
|
],
|
|
"error_norm_m": 0.5327745884969608
|
|
},
|
|
{
|
|
"marker_id": 46,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.5521916274675002,
|
|
0.19505196126720023,
|
|
-0.04456252968332251
|
|
],
|
|
"predicted_position_m": [
|
|
0.5395058025150521,
|
|
0.1854026757912692,
|
|
-0.031239134022212588
|
|
],
|
|
"error_m": [
|
|
-0.012685824952448077,
|
|
-0.009649285475931024,
|
|
0.013323395661109926
|
|
],
|
|
"error_norm_m": 0.020773823356875123
|
|
},
|
|
{
|
|
"marker_id": 47,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.34252671317878636,
|
|
-0.28837600616335735,
|
|
-0.02874581395626228
|
|
],
|
|
"predicted_position_m": [
|
|
0.3440265090521209,
|
|
-0.28532053889803843,
|
|
-0.026637853787601206
|
|
],
|
|
"error_m": [
|
|
0.0014997958733345418,
|
|
0.003055467265318912,
|
|
0.0021079601686610737
|
|
],
|
|
"error_norm_m": 0.004003593878475735
|
|
},
|
|
{
|
|
"marker_id": 51,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.16859652095094246,
|
|
-0.1709267815532453,
|
|
-0.029962452446950703
|
|
],
|
|
"predicted_position_m": [
|
|
0.16833149285762106,
|
|
-0.1697585761438859,
|
|
-0.02894665192132234
|
|
],
|
|
"error_m": [
|
|
-0.00026502809332140664,
|
|
0.001168205409359413,
|
|
0.001015800525628361
|
|
],
|
|
"error_norm_m": 0.0015706032206044367
|
|
},
|
|
{
|
|
"marker_id": 53,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.48845032061694393,
|
|
0.21205389012218046,
|
|
-0.028438763719903514
|
|
],
|
|
"predicted_position_m": [
|
|
0.48921820646832004,
|
|
0.21251838631581146,
|
|
-0.03182864788118077
|
|
],
|
|
"error_m": [
|
|
0.0007678858513761044,
|
|
0.0004644961936310088,
|
|
-0.0033898841612772547
|
|
],
|
|
"error_norm_m": 0.003506667937161957
|
|
},
|
|
{
|
|
"marker_id": 55,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.28303216189402614,
|
|
-0.26199847747218913,
|
|
-0.028336528000963514
|
|
],
|
|
"predicted_position_m": [
|
|
0.2836711695056911,
|
|
-0.2609812012824432,
|
|
-0.027247224503367903
|
|
],
|
|
"error_m": [
|
|
0.0006390076116649657,
|
|
0.0010172761897459526,
|
|
0.0010893034975956103
|
|
],
|
|
"error_norm_m": 0.0016216546129998943
|
|
},
|
|
{
|
|
"marker_id": 56,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.5135980446553344,
|
|
0.1801240888446982,
|
|
-0.048462259395897114
|
|
],
|
|
"predicted_position_m": [
|
|
0.501370300013414,
|
|
0.16887399652923807,
|
|
-0.03124242042623228
|
|
],
|
|
"error_m": [
|
|
-0.012227744641920446,
|
|
-0.01125009231546012,
|
|
0.017219838969664836
|
|
],
|
|
"error_norm_m": 0.023929169861814613
|
|
},
|
|
{
|
|
"marker_id": 58,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.05023036255474454,
|
|
-0.21575657555351818,
|
|
-0.029863612040348063
|
|
],
|
|
"predicted_position_m": [
|
|
0.05033236684247467,
|
|
-0.21504218041637846,
|
|
-0.029026924917424007
|
|
],
|
|
"error_m": [
|
|
0.00010200428773012721,
|
|
0.0007143951371397228,
|
|
0.0008366871229240555
|
|
],
|
|
"error_norm_m": 0.0011049029949960075
|
|
},
|
|
{
|
|
"marker_id": 61,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
-0.010612077308391265,
|
|
0.36214629472010434,
|
|
-0.058835828435401256
|
|
],
|
|
"predicted_position_m": [
|
|
-0.01864731034125329,
|
|
0.33930435858295105,
|
|
-0.03602281907713707
|
|
],
|
|
"error_m": [
|
|
-0.008035233032862025,
|
|
-0.022841936137153296,
|
|
0.022813009358264184
|
|
],
|
|
"error_norm_m": 0.033267888606980094
|
|
},
|
|
{
|
|
"marker_id": 62,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.40432760940529766,
|
|
-0.18006475587491316,
|
|
-0.02866224548737516
|
|
],
|
|
"predicted_position_m": [
|
|
0.4052041639383518,
|
|
-0.17427200523384054,
|
|
-0.027643942080317778
|
|
],
|
|
"error_m": [
|
|
0.0008765545330541302,
|
|
0.005792750641072625,
|
|
0.0010183034070573825
|
|
],
|
|
"error_norm_m": 0.005946532575197896
|
|
},
|
|
{
|
|
"marker_id": 63,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.7933691068462405,
|
|
-0.24505229595352124,
|
|
-0.04332827278678127
|
|
],
|
|
"predicted_position_m": [
|
|
0.7775026220733696,
|
|
-0.23766637616559638,
|
|
-0.024922856918993215
|
|
],
|
|
"error_m": [
|
|
-0.015866484772870892,
|
|
0.007385919787924855,
|
|
0.018405415867788058
|
|
],
|
|
"error_norm_m": 0.025397962190451977
|
|
},
|
|
{
|
|
"marker_id": 64,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
-0.021310374783166795,
|
|
-0.1864917626478082,
|
|
-0.02661954845002057
|
|
],
|
|
"predicted_position_m": [
|
|
-0.020834899571155665,
|
|
-0.18471497254973585,
|
|
-0.029764931844771598
|
|
],
|
|
"error_m": [
|
|
0.0004754752120111304,
|
|
0.001776790098072356,
|
|
-0.0031453833947510286
|
|
],
|
|
"error_norm_m": 0.0036436926914629486
|
|
},
|
|
{
|
|
"marker_id": 66,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.21033580441055907,
|
|
-0.36184321886758075,
|
|
-0.02599761467953806
|
|
],
|
|
"predicted_position_m": [
|
|
0.20906269359216248,
|
|
-0.3611556011891355,
|
|
-0.026442038068722286
|
|
],
|
|
"error_m": [
|
|
-0.0012731108183965945,
|
|
0.0006876176784452737,
|
|
-0.00044442338918422586
|
|
],
|
|
"error_norm_m": 0.0015136516694678826
|
|
},
|
|
{
|
|
"marker_id": 68,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.5704309948134485,
|
|
0.17060499510418098,
|
|
-0.018887791239312533
|
|
],
|
|
"predicted_position_m": [
|
|
0.5764302815395409,
|
|
0.17037061006940427,
|
|
-0.030864635819792405
|
|
],
|
|
"error_m": [
|
|
0.005999286726092401,
|
|
-0.0002343850347767129,
|
|
-0.011976844580479873
|
|
],
|
|
"error_norm_m": 0.0133974319804717
|
|
},
|
|
{
|
|
"marker_id": 69,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.0139046815836182,
|
|
-0.2818955543187457,
|
|
-0.0202626239668338
|
|
],
|
|
"predicted_position_m": [
|
|
0.007451957280249863,
|
|
-0.277868565076297,
|
|
-0.028501314472499078
|
|
],
|
|
"error_m": [
|
|
-0.0064527243033683365,
|
|
0.004026989242448709,
|
|
-0.008238690505665277
|
|
],
|
|
"error_norm_m": 0.011212952980469383
|
|
},
|
|
{
|
|
"marker_id": 72,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.44152543604951155,
|
|
0.19996106520160864,
|
|
-0.03306713157998317
|
|
],
|
|
"predicted_position_m": [
|
|
0.4438456271017049,
|
|
0.19488539890785356,
|
|
-0.03185687359664922
|
|
],
|
|
"error_m": [
|
|
0.002320191052193332,
|
|
-0.005075666293755082,
|
|
0.0012102579833339552
|
|
],
|
|
"error_norm_m": 0.005710551569722755
|
|
},
|
|
{
|
|
"marker_id": 73,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.21806722294445952,
|
|
0.34122924655343334,
|
|
-0.032547552108283716
|
|
],
|
|
"predicted_position_m": [
|
|
0.22547702357625732,
|
|
0.3350451892583431,
|
|
-0.034684922969039106
|
|
],
|
|
"error_m": [
|
|
0.007409800631797803,
|
|
-0.006184057295090251,
|
|
-0.00213737086075539
|
|
],
|
|
"error_norm_m": 0.009885143611923719
|
|
},
|
|
{
|
|
"marker_id": 75,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
-0.026903050443930404,
|
|
0.1973355566878141,
|
|
-0.034757839179643965
|
|
],
|
|
"predicted_position_m": [
|
|
-0.022826768775181208,
|
|
0.19808795553617334,
|
|
-0.034355324630626884
|
|
],
|
|
"error_m": [
|
|
0.004076281668749196,
|
|
0.0007523988483592314,
|
|
0.00040251454901708145
|
|
],
|
|
"error_norm_m": 0.004164636146431457
|
|
},
|
|
{
|
|
"marker_id": 79,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.3120883468595997,
|
|
-0.1591635270553482,
|
|
-0.03035490943243374
|
|
],
|
|
"predicted_position_m": [
|
|
0.31290915610661896,
|
|
-0.15770086556423232,
|
|
-0.028328748177466927
|
|
],
|
|
"error_m": [
|
|
0.0008208092470192718,
|
|
0.0014626614911158742,
|
|
0.0020261612549668136
|
|
],
|
|
"error_norm_m": 0.0026302919778447317
|
|
},
|
|
{
|
|
"marker_id": 82,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.21805790943664982,
|
|
0.30585531597035254,
|
|
-0.039024096159373585
|
|
],
|
|
"predicted_position_m": [
|
|
0.22267866825354082,
|
|
0.2991946735990578,
|
|
-0.03427075579123611
|
|
],
|
|
"error_m": [
|
|
0.004620758816891002,
|
|
-0.006660642371294712,
|
|
0.004753340368137474
|
|
],
|
|
"error_norm_m": 0.009397330126026629
|
|
},
|
|
{
|
|
"marker_id": 83,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.0425335213527205,
|
|
0.3373471292348405,
|
|
-0.027135101566798946
|
|
],
|
|
"predicted_position_m": [
|
|
0.047952004101645365,
|
|
0.342274247442862,
|
|
-0.0357072625914086
|
|
],
|
|
"error_m": [
|
|
0.005418482748924862,
|
|
0.004927118208021497,
|
|
-0.008572161024609653
|
|
],
|
|
"error_norm_m": 0.011274679319965165
|
|
},
|
|
{
|
|
"marker_id": 84,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.4065514623589491,
|
|
0.26325292736705264,
|
|
-0.03164014170326309
|
|
],
|
|
"predicted_position_m": [
|
|
0.410755001782214,
|
|
0.2591907623010232,
|
|
-0.032800671688123485
|
|
],
|
|
"error_m": [
|
|
0.0042035394232649015,
|
|
-0.004062165066029411,
|
|
-0.001160529984860395
|
|
],
|
|
"error_norm_m": 0.005959677722190355
|
|
},
|
|
{
|
|
"marker_id": 85,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.5039480089751692,
|
|
-0.31406439393536817,
|
|
-0.029468173888729306
|
|
],
|
|
"predicted_position_m": [
|
|
0.5042041073073622,
|
|
-0.31253918335750047,
|
|
-0.025467806364690516
|
|
],
|
|
"error_m": [
|
|
0.00025609833219297773,
|
|
0.0015252105778676972,
|
|
0.004000367524038789
|
|
],
|
|
"error_norm_m": 0.004288915246303635
|
|
},
|
|
{
|
|
"marker_id": 86,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.36129730616659245,
|
|
0.29594173104616067,
|
|
-0.03066481090339598
|
|
],
|
|
"predicted_position_m": [
|
|
0.3663704485521694,
|
|
0.293058903395277,
|
|
-0.03343985350032342
|
|
],
|
|
"error_m": [
|
|
0.005073142385576934,
|
|
-0.002882827650883657,
|
|
-0.00277504259692744
|
|
],
|
|
"error_norm_m": 0.006461294788492351
|
|
},
|
|
{
|
|
"marker_id": 92,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.6477470633290741,
|
|
-0.18755446350368268,
|
|
-0.027186029322572934
|
|
],
|
|
"predicted_position_m": [
|
|
0.6455239184881204,
|
|
-0.1855268250468046,
|
|
-0.026242405738769736
|
|
],
|
|
"error_m": [
|
|
-0.0022231448409536503,
|
|
0.002027638456878089,
|
|
0.0009436235838031978
|
|
],
|
|
"error_norm_m": 0.003153429270425988
|
|
},
|
|
{
|
|
"marker_id": 95,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.18502424323738215,
|
|
-0.27322393103116116,
|
|
-0.030191289158347838
|
|
],
|
|
"predicted_position_m": [
|
|
0.1859213318573731,
|
|
-0.27185425732038365,
|
|
-0.027632441485459517
|
|
],
|
|
"error_m": [
|
|
0.0008970886199909656,
|
|
0.001369673710777508,
|
|
0.002558847672888321
|
|
],
|
|
"error_norm_m": 0.0030378405947577795
|
|
},
|
|
{
|
|
"marker_id": 96,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.36859794795615547,
|
|
-0.18847444718539946,
|
|
-0.0302455105003983
|
|
],
|
|
"predicted_position_m": [
|
|
0.370202818787732,
|
|
-0.18544072260513306,
|
|
-0.027694833409366182
|
|
],
|
|
"error_m": [
|
|
0.0016048708315765103,
|
|
0.003033724580266406,
|
|
0.002550677091032117
|
|
],
|
|
"error_norm_m": 0.0042761020611853644
|
|
},
|
|
{
|
|
"marker_id": 97,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.3044454984296277,
|
|
-0.3518975857511937,
|
|
-0.028499971133479313
|
|
],
|
|
"predicted_position_m": [
|
|
0.3036821331717976,
|
|
-0.3581923999751065,
|
|
-0.025978689171064048
|
|
],
|
|
"error_m": [
|
|
-0.0007633652578301064,
|
|
-0.006294814223912815,
|
|
0.0025212819624152658
|
|
],
|
|
"error_norm_m": 0.006823802119378733
|
|
},
|
|
{
|
|
"marker_id": 102,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.6540979060004576,
|
|
-0.22499416189547747,
|
|
-0.0331267623329287
|
|
],
|
|
"predicted_position_m": [
|
|
0.6498807339562016,
|
|
-0.22371233969491253,
|
|
-0.025762582817033888
|
|
],
|
|
"error_m": [
|
|
-0.004217172044255979,
|
|
0.0012818222005649416,
|
|
0.007364179515894815
|
|
],
|
|
"error_norm_m": 0.008582467485929678
|
|
},
|
|
{
|
|
"marker_id": 103,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.10666888074218231,
|
|
-0.18700147586543833,
|
|
-0.027512991052136556
|
|
],
|
|
"predicted_position_m": [
|
|
0.10614407281302585,
|
|
-0.18499565619410507,
|
|
-0.029092184530364915
|
|
],
|
|
"error_m": [
|
|
-0.0005248079291564622,
|
|
0.0020058196713332588,
|
|
-0.0015791934782283593
|
|
],
|
|
"error_norm_m": 0.002606259380432412
|
|
},
|
|
{
|
|
"marker_id": 105,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.5264126387561544,
|
|
-0.26859223732736076,
|
|
-0.028886158843934702
|
|
],
|
|
"predicted_position_m": [
|
|
0.5247595567590854,
|
|
-0.2661711789404367,
|
|
-0.025914196571593565
|
|
],
|
|
"error_m": [
|
|
-0.0016530819970690391,
|
|
0.00242105838692408,
|
|
0.0029719622723411374
|
|
],
|
|
"error_norm_m": 0.00417453752530125
|
|
},
|
|
{
|
|
"marker_id": 114,
|
|
"link": "Arm2",
|
|
"observed_position_m": [
|
|
0.2712682009905615,
|
|
-0.24359004573541737,
|
|
0.2620424702972379
|
|
],
|
|
"predicted_position_m": [
|
|
0.2515887414118118,
|
|
0.16267220151381032,
|
|
0.41350957882222195
|
|
],
|
|
"error_m": [
|
|
-0.01967945957874967,
|
|
0.40626224724922766,
|
|
0.15146710852498407
|
|
],
|
|
"error_norm_m": 0.43402601262392504
|
|
},
|
|
{
|
|
"marker_id": 115,
|
|
"link": "Arm2",
|
|
"observed_position_m": [
|
|
0.30525450408486055,
|
|
-0.23010780073411682,
|
|
0.22867265032504536
|
|
],
|
|
"predicted_position_m": [
|
|
0.22261618572133193,
|
|
0.20015405405421124,
|
|
0.42786059784133973
|
|
],
|
|
"error_m": [
|
|
-0.08263831836352861,
|
|
0.43026185478832807,
|
|
0.19918794751629437
|
|
],
|
|
"error_norm_m": 0.48127974586886396
|
|
},
|
|
{
|
|
"marker_id": 120,
|
|
"link": "Arm2",
|
|
"observed_position_m": [
|
|
0.2625662059341891,
|
|
-0.18190511521069566,
|
|
0.2939650850820472
|
|
],
|
|
"predicted_position_m": [
|
|
0.2520975551317268,
|
|
0.1880438420124955,
|
|
0.34827139240519783
|
|
],
|
|
"error_m": [
|
|
-0.010468650802462287,
|
|
0.36994895722319115,
|
|
0.054306307323150615
|
|
],
|
|
"error_norm_m": 0.3740601537389767
|
|
},
|
|
{
|
|
"marker_id": 205,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.7494635190169779,
|
|
-0.09438750644187002,
|
|
0.011874659448293403
|
|
],
|
|
"predicted_position_m": [
|
|
0.7508888500677534,
|
|
-0.09102679627230495,
|
|
0.0007847926887032176
|
|
],
|
|
"error_m": [
|
|
0.001425331050775469,
|
|
0.003360710169565073,
|
|
-0.011089866759590186
|
|
],
|
|
"error_norm_m": 0.011675233881750983
|
|
},
|
|
{
|
|
"marker_id": 206,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.6469841760480316,
|
|
-0.013840768336592238,
|
|
0.007224373860460745
|
|
],
|
|
"predicted_position_m": [
|
|
0.651401758653761,
|
|
-0.010403590027052035,
|
|
-0.0007042528845845903
|
|
],
|
|
"error_m": [
|
|
0.004417582605729442,
|
|
0.0034371783095402033,
|
|
-0.007928626745045336
|
|
],
|
|
"error_norm_m": 0.00970527448721906
|
|
},
|
|
{
|
|
"marker_id": 207,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.7468601948033142,
|
|
-0.014430249176107532,
|
|
0.012165388549118845
|
|
],
|
|
"predicted_position_m": [
|
|
0.7513983413368077,
|
|
-0.011034111444401688,
|
|
-0.00016956189450933155
|
|
],
|
|
"error_m": [
|
|
0.004538146533493492,
|
|
0.003396137731705844,
|
|
-0.012334950443628177
|
|
],
|
|
"error_norm_m": 0.013574959591060965
|
|
},
|
|
{
|
|
"marker_id": 208,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.3484725042892376,
|
|
-0.09151206474794678,
|
|
0.002183207241496229
|
|
],
|
|
"predicted_position_m": [
|
|
0.35090251933556676,
|
|
-0.08850471060290635,
|
|
-0.001353971271597816
|
|
],
|
|
"error_m": [
|
|
0.0024300150463291703,
|
|
0.003007354145040428,
|
|
-0.0035371785130940453
|
|
],
|
|
"error_norm_m": 0.005240303799644845
|
|
},
|
|
{
|
|
"marker_id": 210,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.018246349225242323,
|
|
-0.017730470214900453,
|
|
0.00023527095600163288
|
|
],
|
|
"predicted_position_m": [
|
|
0.021359601341935174,
|
|
-0.01643039070123714,
|
|
-0.00395351179915715
|
|
],
|
|
"error_m": [
|
|
0.00311325211669285,
|
|
0.0013000795136633124,
|
|
-0.004188782755158783
|
|
],
|
|
"error_norm_m": 0.005378517124064509
|
|
},
|
|
{
|
|
"marker_id": 211,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.2502132615765682,
|
|
-0.011548956453720479,
|
|
0.0062323222074483955
|
|
],
|
|
"predicted_position_m": [
|
|
0.2514154279215743,
|
|
-0.00788150435765343,
|
|
-0.002843016844885624
|
|
],
|
|
"error_m": [
|
|
0.0012021663450060838,
|
|
0.0036674520960670483,
|
|
-0.009075339052334019
|
|
],
|
|
"error_norm_m": 0.009861905886431425
|
|
},
|
|
{
|
|
"marker_id": 214,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.3501746563830133,
|
|
-0.011658071915536646,
|
|
0.006706704184076964
|
|
],
|
|
"predicted_position_m": [
|
|
0.351412010604621,
|
|
-0.008512025775003082,
|
|
-0.0023083258548103652
|
|
],
|
|
"error_m": [
|
|
0.0012373542216077005,
|
|
0.0031460461405335635,
|
|
-0.00901503003888733
|
|
],
|
|
"error_norm_m": 0.009628053717659525
|
|
},
|
|
{
|
|
"marker_id": 215,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.2510241960445018,
|
|
-0.09147739793535226,
|
|
0.0029471622600684808
|
|
],
|
|
"predicted_position_m": [
|
|
0.25090593665252003,
|
|
-0.08787418918555669,
|
|
-0.0018886622616730749
|
|
],
|
|
"error_m": [
|
|
-0.00011825939198178981,
|
|
0.0036032087497955695,
|
|
-0.004835824521741555
|
|
],
|
|
"error_norm_m": 0.006031773983122394
|
|
},
|
|
{
|
|
"marker_id": 217,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.6500112070813467,
|
|
-0.09371694608806377,
|
|
0.0039579072489725
|
|
],
|
|
"predicted_position_m": [
|
|
0.6508922673847067,
|
|
-0.0903962748549553,
|
|
0.00025010169862795884
|
|
],
|
|
"error_m": [
|
|
0.0008810603033599929,
|
|
0.0033206712331084742,
|
|
-0.003707805550344541
|
|
],
|
|
"error_norm_m": 0.005054794426652457
|
|
},
|
|
{
|
|
"marker_id": 218,
|
|
"link": "Arm2",
|
|
"observed_position_m": [
|
|
0.23793091485346762,
|
|
-0.19025436252979092,
|
|
0.3003723677303802
|
|
],
|
|
"predicted_position_m": [
|
|
0.2781637582858243,
|
|
0.1937311268314266,
|
|
0.3506865206649456
|
|
],
|
|
"error_m": [
|
|
0.04023284343235667,
|
|
0.3839854893612175,
|
|
0.050314152934565426
|
|
],
|
|
"error_norm_m": 0.38935209222007405
|
|
},
|
|
{
|
|
"marker_id": 219,
|
|
"link": "Arm2",
|
|
"observed_position_m": [
|
|
0.24145246887086727,
|
|
-0.2772804241836024,
|
|
0.2541320908140835
|
|
],
|
|
"predicted_position_m": [
|
|
0.27738600017109705,
|
|
0.15494876206915068,
|
|
0.45040774847382536
|
|
],
|
|
"error_m": [
|
|
0.035933531300229776,
|
|
0.4322291862527531,
|
|
0.19627565765974186
|
|
],
|
|
"error_norm_m": 0.4760645144412529
|
|
},
|
|
{
|
|
"marker_id": 243,
|
|
"link": "Arm1",
|
|
"observed_position_m": [
|
|
0.16466563063932055,
|
|
-0.11307099581797364,
|
|
0.3423897820597492
|
|
],
|
|
"predicted_position_m": [
|
|
0.1684780391168424,
|
|
0.2824007048092649,
|
|
0.28396750666767495
|
|
],
|
|
"error_m": [
|
|
0.0038124084775218448,
|
|
0.3954717006272385,
|
|
-0.05842227539207423
|
|
],
|
|
"error_norm_m": 0.39978189393391367
|
|
},
|
|
{
|
|
"marker_id": 246,
|
|
"link": "Ellbow",
|
|
"observed_position_m": [
|
|
0.2312989671490578,
|
|
-0.13675784567214536,
|
|
0.3639158231965809
|
|
],
|
|
"predicted_position_m": [
|
|
0.25863005523091,
|
|
0.2934474104086792,
|
|
0.26913959838714596
|
|
],
|
|
"error_m": [
|
|
0.027331088081852195,
|
|
0.4302052560808246,
|
|
-0.09477622480943493
|
|
],
|
|
"error_norm_m": 0.4413684215306238
|
|
},
|
|
{
|
|
"marker_id": 247,
|
|
"link": "Ellbow",
|
|
"observed_position_m": [
|
|
0.20029291991888915,
|
|
-0.11936100362588432,
|
|
0.3519918211243391
|
|
],
|
|
"predicted_position_m": [
|
|
0.22113133672492216,
|
|
0.29368385594018437,
|
|
0.26893908926586857
|
|
],
|
|
"error_m": [
|
|
0.020838416806033017,
|
|
0.4130448595660687,
|
|
-0.08305273185847051
|
|
],
|
|
"error_norm_m": 0.4218270402642419
|
|
}
|
|
]
|
|
} |