4785 lines
123 KiB
JSON
4785 lines
123 KiB
JSON
{
|
|
"schema_version": "1.0",
|
|
"method": "deterministic_geometric_sequential_prefix",
|
|
"created_utc": "2026-06-01T16:30:02Z",
|
|
"root_pose": {
|
|
"translation_m": [
|
|
0.0024976453548978816,
|
|
0.009531480569759235,
|
|
-0.0107790671059569
|
|
],
|
|
"rotation_matrix": [
|
|
[
|
|
0.9998137460664411,
|
|
0.013859783844868296,
|
|
-0.013430546093245236
|
|
],
|
|
[
|
|
-0.01341300573787106,
|
|
0.999371811432341,
|
|
0.03280356370146102
|
|
],
|
|
[
|
|
0.013876759479975687,
|
|
-0.03261730991687534,
|
|
0.9993715758616116
|
|
]
|
|
],
|
|
"euler_xyz_deg": [
|
|
-1.8693457853714255,
|
|
-0.7951052710818581,
|
|
-0.7686056758658355
|
|
]
|
|
},
|
|
"movements": {
|
|
"x": {
|
|
"value_m": 0.06489017042145476,
|
|
"value_mm": 64.89017042145476,
|
|
"joint_type": "linear",
|
|
"link": "Base"
|
|
},
|
|
"y": {
|
|
"value_rad": -0.05801316485959296,
|
|
"value_deg": -3.3239095026513334,
|
|
"joint_type": "revolute",
|
|
"link": "Arm1"
|
|
},
|
|
"z": {
|
|
"value_rad": 1.6349046839253045,
|
|
"value_deg": 93.6731382950898,
|
|
"joint_type": "revolute",
|
|
"link": "Ellbow"
|
|
},
|
|
"a": {
|
|
"value_rad": -2.968388705126404,
|
|
"value_deg": -170.07614475804638,
|
|
"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.0024976453548978816,
|
|
0.009531480569759235,
|
|
-0.0107790671059569
|
|
],
|
|
"rotation_matrix": [
|
|
[
|
|
0.9998137460664411,
|
|
0.013859783844868296,
|
|
-0.013430546093245236
|
|
],
|
|
[
|
|
-0.01341300573787106,
|
|
0.999371811432341,
|
|
0.03280356370146102
|
|
],
|
|
[
|
|
0.013876759479975687,
|
|
-0.03261730991687534,
|
|
0.9993715758616116
|
|
]
|
|
]
|
|
},
|
|
"Base": {
|
|
"translation_m": [
|
|
0.06716084098930553,
|
|
0.009185965360789078,
|
|
0.006111343395381146
|
|
],
|
|
"rotation_matrix": [
|
|
[
|
|
0.9998137460664411,
|
|
0.013859783844868296,
|
|
-0.013430546093245236
|
|
],
|
|
[
|
|
-0.01341300573787106,
|
|
0.999371811432341,
|
|
0.03280356370146102
|
|
],
|
|
[
|
|
0.013876759479975687,
|
|
-0.03261730991687534,
|
|
0.9993715758616116
|
|
]
|
|
]
|
|
},
|
|
"Arm1": {
|
|
"translation_m": [
|
|
0.1780328351376638,
|
|
0.11711885073088184,
|
|
0.04908683838092846
|
|
],
|
|
"rotation_matrix": [
|
|
[
|
|
0.9998137460664378,
|
|
0.013057756127530911,
|
|
-0.014211550988656499
|
|
],
|
|
[
|
|
-0.013413005737871015,
|
|
0.9995925477501572,
|
|
-0.025195828214557018
|
|
],
|
|
[
|
|
0.01387675947997564,
|
|
0.02538175500739783,
|
|
0.9995815134640457
|
|
]
|
|
]
|
|
},
|
|
"Ellbow": {
|
|
"translation_m": [
|
|
0.17476839610578107,
|
|
-0.13277928620665747,
|
|
0.042741399629079004
|
|
],
|
|
"rotation_matrix": [
|
|
[
|
|
0.9998137460643102,
|
|
0.013345819088128716,
|
|
0.01394138764454428
|
|
],
|
|
[
|
|
-0.013413005737842472,
|
|
-0.03889427997848535,
|
|
0.9991533046835362
|
|
],
|
|
[
|
|
0.01387675947994611,
|
|
-0.9991542043627816,
|
|
-0.03870802821784067
|
|
]
|
|
]
|
|
},
|
|
"Arm2": {
|
|
"translation_m": [
|
|
0.264751633251569,
|
|
-0.13398645672306328,
|
|
0.04399030798227415
|
|
],
|
|
"rotation_matrix": [
|
|
[
|
|
-0.9872568386436547,
|
|
0.013345819088075736,
|
|
0.15857434742063925
|
|
],
|
|
[
|
|
-0.15898100353198621,
|
|
-0.03889427997833095,
|
|
-0.9865152180776827
|
|
],
|
|
[
|
|
-0.00699821856215066,
|
|
-0.9991542043588151,
|
|
0.04052037560454855
|
|
]
|
|
]
|
|
},
|
|
"Hand": {
|
|
"translation_m": [
|
|
0.26141517847955004,
|
|
-0.12426288672848054,
|
|
0.2937788590719779
|
|
],
|
|
"rotation_matrix": [
|
|
[
|
|
-0.9872568386436547,
|
|
0.013345819088075736,
|
|
0.15857434742063925
|
|
],
|
|
[
|
|
-0.15898100353198621,
|
|
-0.03889427997833095,
|
|
-0.9865152180776827
|
|
],
|
|
[
|
|
-0.00699821856215066,
|
|
-0.9991542043588151,
|
|
0.04052037560454855
|
|
]
|
|
]
|
|
},
|
|
"Palm": {
|
|
"translation_m": [
|
|
0.26141517847955004,
|
|
-0.12426288672848054,
|
|
0.2937788590719779
|
|
],
|
|
"rotation_matrix": [
|
|
[
|
|
-0.9872568386436547,
|
|
0.013345819088075736,
|
|
0.15857434742063925
|
|
],
|
|
[
|
|
-0.15898100353198621,
|
|
-0.03889427997833095,
|
|
-0.9865152180776827
|
|
],
|
|
[
|
|
-0.00699821856215066,
|
|
-0.9991542043588151,
|
|
0.04052037560454855
|
|
]
|
|
]
|
|
},
|
|
"FingerA": {
|
|
"translation_m": [
|
|
0.2569990474568928,
|
|
-0.1235375109433669,
|
|
0.32872126335028784
|
|
],
|
|
"rotation_matrix": [
|
|
[
|
|
-0.9872568386436547,
|
|
0.013345819088075736,
|
|
0.15857434742063925
|
|
],
|
|
[
|
|
-0.15898100353198621,
|
|
-0.03889427997833095,
|
|
-0.9865152180776827
|
|
],
|
|
[
|
|
-0.00699821856215066,
|
|
-0.9991542043588151,
|
|
0.04052037560454855
|
|
]
|
|
]
|
|
},
|
|
"FingerB": {
|
|
"translation_m": [
|
|
0.264897102166042,
|
|
-0.12226566291511101,
|
|
0.3287772490987851
|
|
],
|
|
"rotation_matrix": [
|
|
[
|
|
-0.9872568386436547,
|
|
0.013345819088075736,
|
|
0.15857434742063925
|
|
],
|
|
[
|
|
-0.15898100353198621,
|
|
-0.03889427997833095,
|
|
-0.9865152180776827
|
|
],
|
|
[
|
|
-0.00699821856215066,
|
|
-0.9991542043588151,
|
|
0.04052037560454855
|
|
]
|
|
]
|
|
}
|
|
},
|
|
"stage_reports": [
|
|
{
|
|
"method": "deterministic_geometric_prefix",
|
|
"active_links": [
|
|
"Board",
|
|
"Base",
|
|
"Arm1"
|
|
],
|
|
"active_observations": 41,
|
|
"joint_updates": [
|
|
{
|
|
"pass": 0,
|
|
"updates": [
|
|
{
|
|
"link": "Base",
|
|
"joint_variable": "x",
|
|
"joint_type": "linear",
|
|
"old": 0.0,
|
|
"new": 0.060672736696816276,
|
|
"info": {
|
|
"reason": "weighted_projection",
|
|
"used_markers": 3,
|
|
"axis_world": [
|
|
0.9998137460654417,
|
|
-0.01341300573785765,
|
|
0.013876759479961816
|
|
],
|
|
"per_marker": [
|
|
{
|
|
"marker_id": 198,
|
|
"q_i": 0.05562494310371367,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 229,
|
|
"q_i": 0.0653910610551676,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 243,
|
|
"q_i": 0.061002205931567556,
|
|
"weight": 1.0
|
|
}
|
|
]
|
|
}
|
|
},
|
|
{
|
|
"link": "Arm1",
|
|
"joint_variable": "y",
|
|
"joint_type": "revolute",
|
|
"old": 0.0,
|
|
"new": -0.044355505891484626,
|
|
"info": {
|
|
"reason": "2d_alignment+normal_tiebreak",
|
|
"used_markers": 3,
|
|
"axis_world": [
|
|
-0.9998137460654417,
|
|
0.01341300573785765,
|
|
-0.013876759479961816
|
|
],
|
|
"axis_id": 0,
|
|
"theta_rad": -0.04435550589148462,
|
|
"theta_alt_rad": 3.0972371476983085,
|
|
"score_theta": 0.008263514079157984,
|
|
"score_theta_alt": 0.9879189862451968,
|
|
"best_score": 0.008263514079157984,
|
|
"per_marker": [
|
|
{
|
|
"marker_id": 198,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 229,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 243,
|
|
"weight": 1.0
|
|
}
|
|
]
|
|
}
|
|
}
|
|
]
|
|
},
|
|
{
|
|
"pass": 1,
|
|
"updates": [
|
|
{
|
|
"link": "Base",
|
|
"joint_variable": "x",
|
|
"joint_type": "linear",
|
|
"old": 0.060672736696816276,
|
|
"new": 0.060672736696816276,
|
|
"info": {
|
|
"reason": "weighted_projection",
|
|
"used_markers": 3,
|
|
"axis_world": [
|
|
0.9998137460654417,
|
|
-0.01341300573785765,
|
|
0.013876759479961816
|
|
],
|
|
"per_marker": [
|
|
{
|
|
"marker_id": 198,
|
|
"q_i": 0.05562494310371367,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 229,
|
|
"q_i": 0.06539106105516762,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 243,
|
|
"q_i": 0.06100220593156755,
|
|
"weight": 1.0
|
|
}
|
|
]
|
|
}
|
|
},
|
|
{
|
|
"link": "Arm1",
|
|
"joint_variable": "y",
|
|
"joint_type": "revolute",
|
|
"old": -0.044355505891484626,
|
|
"new": -0.044355505891484626,
|
|
"info": {
|
|
"reason": "2d_alignment+normal_tiebreak",
|
|
"used_markers": 3,
|
|
"axis_world": [
|
|
-0.9998137460654417,
|
|
0.01341300573785765,
|
|
-0.013876759479961816
|
|
],
|
|
"axis_id": 0,
|
|
"theta_rad": -0.04435550589148462,
|
|
"theta_alt_rad": 3.0972371476983085,
|
|
"score_theta": 0.008263514079157984,
|
|
"score_theta_alt": 0.9879189862451968,
|
|
"best_score": 0.008263514079157984,
|
|
"per_marker": [
|
|
{
|
|
"marker_id": 198,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 229,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 243,
|
|
"weight": 1.0
|
|
}
|
|
]
|
|
}
|
|
}
|
|
]
|
|
}
|
|
],
|
|
"root_link": "Board",
|
|
"root_pose": {
|
|
"reason": "kabsch",
|
|
"used_markers": [
|
|
210,
|
|
211,
|
|
214,
|
|
208,
|
|
206,
|
|
205,
|
|
207,
|
|
217,
|
|
46,
|
|
47,
|
|
51,
|
|
53,
|
|
54,
|
|
55,
|
|
56,
|
|
58,
|
|
60,
|
|
61,
|
|
62,
|
|
63,
|
|
64,
|
|
66,
|
|
68,
|
|
69,
|
|
72,
|
|
75,
|
|
79,
|
|
83,
|
|
84,
|
|
85,
|
|
86,
|
|
92,
|
|
95,
|
|
96,
|
|
97,
|
|
102,
|
|
103,
|
|
105
|
|
]
|
|
},
|
|
"marker_stats": {
|
|
"num_markers_used": 41,
|
|
"mean_error_m": 0.017340990862884594,
|
|
"rms_error_m": 0.023940596901450104,
|
|
"median_error_m": 0.011053289198199687,
|
|
"worst_error_m": 0.07392562227989355
|
|
},
|
|
"marker_reports": [
|
|
{
|
|
"marker_id": 46,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.005909038104734532,
|
|
-0.005912025002722032,
|
|
-0.004795093568657212
|
|
],
|
|
"error_norm_m": 0.009636477223975206,
|
|
"predicted_m": [
|
|
0.5420444932307554,
|
|
0.18676055768314986,
|
|
-0.03666266949746651
|
|
],
|
|
"observed_m": [
|
|
0.5361354551260209,
|
|
0.1926725826858719,
|
|
-0.031867575928809296
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 47,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.0017790247426832662,
|
|
0.003311081736141752,
|
|
0.0036937551998724068
|
|
],
|
|
"error_norm_m": 0.005269916391658902,
|
|
"predicted_m": [
|
|
0.343058802608786,
|
|
-0.282341214532261,
|
|
-0.023938950227605407
|
|
],
|
|
"observed_m": [
|
|
0.3448378273514693,
|
|
-0.28565229626840277,
|
|
-0.027632705427477814
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 51,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.0018130186400432402,
|
|
0.007841589806590554,
|
|
-0.0012948464725381949
|
|
],
|
|
"error_norm_m": 0.008151944226466085,
|
|
"predicted_m": [
|
|
0.16824805424916736,
|
|
-0.16558666039338263,
|
|
-0.030120604195743066
|
|
],
|
|
"observed_m": [
|
|
0.16643503560912412,
|
|
-0.17342825019997318,
|
|
-0.02882575772320487
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 53,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.011437630887001893,
|
|
-0.00848091304718021,
|
|
-0.00523088908565672
|
|
],
|
|
"error_norm_m": 0.015169294217186699,
|
|
"predicted_m": [
|
|
0.4919653338112853,
|
|
0.21422054249906963,
|
|
-0.03823703468659834
|
|
],
|
|
"observed_m": [
|
|
0.48052770292428343,
|
|
0.22270145554624984,
|
|
-0.03300614560094162
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 54,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.0018633715935418849,
|
|
-0.00026202290098609193,
|
|
0.0010998956810255936
|
|
],
|
|
"error_norm_m": 0.0021795825759531903,
|
|
"predicted_m": [
|
|
0.34048864418812924,
|
|
-0.32633725333460945,
|
|
-0.0225293561743478
|
|
],
|
|
"observed_m": [
|
|
0.3423520157816711,
|
|
-0.32607523043362335,
|
|
-0.023629251855373394
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 55,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.0017318564561557004,
|
|
0.0046670426208414995,
|
|
0.0017811452939564022
|
|
],
|
|
"error_norm_m": 0.005287068390673825,
|
|
"predicted_m": [
|
|
0.28289215325522865,
|
|
-0.2575846449531435,
|
|
-0.02556014368934707
|
|
],
|
|
"observed_m": [
|
|
0.28462400971138435,
|
|
-0.262251687573985,
|
|
-0.02734128898330347
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 56,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.0302235496648251,
|
|
-0.029443948972544487,
|
|
0.060700811724634623
|
|
],
|
|
"error_norm_m": 0.07392562227989355,
|
|
"predicted_m": [
|
|
0.5037891478927703,
|
|
0.17051118901364073,
|
|
-0.036643410373183985
|
|
],
|
|
"observed_m": [
|
|
0.5340126975575954,
|
|
0.19995513798618522,
|
|
-0.09734422209781861
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 58,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.0022024017192950884,
|
|
0.007832819714530759,
|
|
-0.0028935096217191057
|
|
],
|
|
"error_norm_m": 0.008635741771525868,
|
|
"predicted_m": [
|
|
0.04992201234930729,
|
|
-0.21000889996820854,
|
|
-0.030252662778657236
|
|
],
|
|
"observed_m": [
|
|
0.05212441406860238,
|
|
-0.2178417196827393,
|
|
-0.02735915315693813
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 60,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.006548213459839247,
|
|
0.0012692268576284804,
|
|
-0.012634590371468944
|
|
],
|
|
"error_norm_m": 0.014287158926342252,
|
|
"predicted_m": [
|
|
0.441076943257675,
|
|
0.28644158391102037,
|
|
-0.041291520606765046
|
|
],
|
|
"observed_m": [
|
|
0.43452872979783574,
|
|
0.2851723570533919,
|
|
-0.028656930235296103
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 61,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.004773031503023764,
|
|
-0.024724839033023305,
|
|
0.016079162880633865
|
|
],
|
|
"error_norm_m": 0.029877064345074533,
|
|
"predicted_m": [
|
|
-0.014896993714944018,
|
|
0.3445556983026755,
|
|
-0.0493268992639042
|
|
],
|
|
"observed_m": [
|
|
-0.010123962211920254,
|
|
0.3692805373356988,
|
|
-0.06540606214453806
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 62,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.0002670158087336727,
|
|
0.0036099577904157854,
|
|
0.002012572681416889
|
|
],
|
|
"error_norm_m": 0.004141683412416126,
|
|
"predicted_m": [
|
|
0.40506207414509576,
|
|
-0.17178230432320996,
|
|
-0.026734695598987862
|
|
],
|
|
"observed_m": [
|
|
0.4047950583363621,
|
|
-0.17539226211362574,
|
|
-0.02874726828040475
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 63,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.016524322658683088,
|
|
0.007443020870418315,
|
|
0.027506496731969726
|
|
],
|
|
"error_norm_m": 0.03294023620849752,
|
|
"predicted_m": [
|
|
0.7768465175003292,
|
|
-0.23779298064965895,
|
|
-0.01957154057037569
|
|
],
|
|
"observed_m": [
|
|
0.7933708401590123,
|
|
-0.24523600152007727,
|
|
-0.047078037302345416
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 64,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.0015743230007710905,
|
|
0.008489521641287107,
|
|
-0.005963280754507055
|
|
],
|
|
"error_norm_m": 0.010493387821181168,
|
|
"predicted_m": [
|
|
-0.021010566228709286,
|
|
-0.17919051815315568,
|
|
-0.03221751355546453
|
|
],
|
|
"observed_m": [
|
|
-0.019436243227938195,
|
|
-0.18768003979444278,
|
|
-0.026254232800957476
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 66,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.007998311016284065,
|
|
0.0013790262614014615,
|
|
0.0019330736586158047
|
|
],
|
|
"error_norm_m": 0.008343348627048988,
|
|
"predicted_m": [
|
|
0.20754094321470798,
|
|
-0.35717925773937836,
|
|
-0.023303675344947365
|
|
],
|
|
"observed_m": [
|
|
0.21553925423099204,
|
|
-0.3585582840007798,
|
|
-0.02523674900356317
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 68,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.007909606738037422,
|
|
-0.0011650636277719673,
|
|
-0.013591149304143003
|
|
],
|
|
"error_norm_m": 0.01576827801044461,
|
|
"predicted_m": [
|
|
0.5788524733092311,
|
|
0.17147330540153524,
|
|
-0.03566621567474805
|
|
],
|
|
"observed_m": [
|
|
0.5709428665711936,
|
|
0.1726383690293072,
|
|
-0.022075066370605047
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 69,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.01125874075257734,
|
|
-0.0019047553616383106,
|
|
-0.02453303098243099
|
|
],
|
|
"error_norm_m": 0.02706024658990296,
|
|
"predicted_m": [
|
|
0.006575372055793682,
|
|
-0.27249947678584446,
|
|
-0.02878399526561177
|
|
],
|
|
"observed_m": [
|
|
0.017834112808371022,
|
|
-0.27059472142420615,
|
|
-0.004250964283180778
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 72,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.01301934339557137,
|
|
-0.007156955177265112,
|
|
-0.0041459587385330385
|
|
],
|
|
"error_norm_m": 0.015424470289861113,
|
|
"predicted_m": [
|
|
0.4464653963378182,
|
|
0.19691887227789812,
|
|
-0.03828059462695163
|
|
],
|
|
"observed_m": [
|
|
0.4334460529422468,
|
|
0.20407582745516323,
|
|
-0.03413463588841859
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 75,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.001489679189073504,
|
|
-0.020292205908477245,
|
|
0.01741942628795258
|
|
],
|
|
"error_norm_m": 0.02678486843200487,
|
|
"predicted_m": [
|
|
-0.020134077270129586,
|
|
0.20343842459667755,
|
|
-0.044765220009239874
|
|
],
|
|
"observed_m": [
|
|
-0.01864439808105608,
|
|
0.2237306305051548,
|
|
-0.062184646297192454
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 79,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.0010722798357485908,
|
|
0.004005774416510954,
|
|
0.0006733588446190576
|
|
],
|
|
"error_norm_m": 0.004201121856808419,
|
|
"predicted_m": [
|
|
0.31290090195223613,
|
|
-0.15456298732822757,
|
|
-0.028538458960508453
|
|
],
|
|
"observed_m": [
|
|
0.31182862211648754,
|
|
-0.15856876174473852,
|
|
-0.02921181780512751
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 83,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.005255378085870212,
|
|
-0.017837246385331296,
|
|
0.008584734637097906
|
|
],
|
|
"error_norm_m": 0.020481309192184168,
|
|
"predicted_m": [
|
|
0.05171759016539374,
|
|
0.3470505308214037,
|
|
-0.048513557298345625
|
|
],
|
|
"observed_m": [
|
|
0.05697296825126395,
|
|
0.364887777206735,
|
|
-0.05709829193544353
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 84,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.01886370011504146,
|
|
-0.015537334900553867,
|
|
-0.003952255443371466
|
|
],
|
|
"error_norm_m": 0.02475617662184215,
|
|
"predicted_m": [
|
|
0.41386004798904846,
|
|
0.2614279410829299,
|
|
-0.04083623563520253
|
|
],
|
|
"observed_m": [
|
|
0.394996347874007,
|
|
0.27696527598348375,
|
|
-0.03688398019183106
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 85,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.0014332162830252848,
|
|
0.0014130660453137156,
|
|
0.008165047026109568
|
|
],
|
|
"error_norm_m": 0.008409450487453271,
|
|
"predicted_m": [
|
|
0.5030156718559659,
|
|
-0.3106855251799703,
|
|
-0.020858912152070003
|
|
],
|
|
"observed_m": [
|
|
0.5044488881389911,
|
|
-0.312098591225284,
|
|
-0.02902395917817957
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 86,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.00466511573223477,
|
|
0.006131361200086172,
|
|
-0.014563902120428459
|
|
],
|
|
"error_norm_m": 0.0164761688488097,
|
|
"predicted_m": [
|
|
0.3697339050538343,
|
|
0.29559506028485116,
|
|
-0.042550754548117284
|
|
],
|
|
"observed_m": [
|
|
0.36506878932159953,
|
|
0.289463699084765,
|
|
-0.027986852427688825
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 92,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.0030843417438075615,
|
|
0.007025737961659312,
|
|
0.004194660704404177
|
|
],
|
|
"error_norm_m": 0.008744674740867561,
|
|
"predicted_m": [
|
|
0.6452723062673585,
|
|
-0.18474053821588782,
|
|
-0.023081168789006144
|
|
],
|
|
"observed_m": [
|
|
0.6483566480111661,
|
|
-0.19176627617754713,
|
|
-0.02727582949341032
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 95,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.003518654131452137,
|
|
0.005044333025852332,
|
|
-0.00048515309056019335
|
|
],
|
|
"error_norm_m": 0.006169408082933876,
|
|
"predicted_m": [
|
|
0.1850710976230811,
|
|
-0.2677572446660259,
|
|
-0.026540852664406197
|
|
],
|
|
"observed_m": [
|
|
0.18858975175453324,
|
|
-0.27280157769187824,
|
|
-0.026055699573846004
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 96,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.00032807105204279985,
|
|
0.004261768433921759,
|
|
0.0018132550758337973
|
|
],
|
|
"error_norm_m": 0.00464308031048327,
|
|
"predicted_m": [
|
|
0.369980717057002,
|
|
-0.18269663296500055,
|
|
-0.026847899647670207
|
|
],
|
|
"observed_m": [
|
|
0.3696526460049592,
|
|
-0.1869584013989223,
|
|
-0.028661154723504004
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 97,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.004730285155796932,
|
|
0.000687276705387152,
|
|
0.004213699070405662
|
|
],
|
|
"error_norm_m": 0.006372064561887157,
|
|
"predicted_m": [
|
|
0.30217266442308105,
|
|
-0.3548903644334818,
|
|
-0.022107051521445743
|
|
],
|
|
"observed_m": [
|
|
0.306902949578878,
|
|
-0.35557764113886897,
|
|
-0.026320750591851405
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 102,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.004668507356966112,
|
|
0.004636651351887733,
|
|
0.01099065243696026
|
|
],
|
|
"error_norm_m": 0.012809681404744987,
|
|
"predicted_m": [
|
|
0.649342560147744,
|
|
-0.22293826636654013,
|
|
-0.02177265914897029
|
|
],
|
|
"observed_m": [
|
|
0.6540110675047102,
|
|
-0.22757491771842786,
|
|
-0.03276331158593055
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 103,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.00020855262325139567,
|
|
0.00728848879704197,
|
|
-0.0026312704778853648
|
|
],
|
|
"error_norm_m": 0.0077517190009095665,
|
|
"predicted_m": [
|
|
0.10595299033440675,
|
|
-0.18037402827980573,
|
|
-0.030472403637853997
|
|
],
|
|
"observed_m": [
|
|
0.10574443771115535,
|
|
-0.1876625170768477,
|
|
-0.027841133159968633
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 105,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.0012341282300909473,
|
|
0.003863389097407577,
|
|
0.006227435062303922
|
|
],
|
|
"error_norm_m": 0.007431675131589608,
|
|
"predicted_m": [
|
|
0.5239163783000583,
|
|
-0.2644864834446157,
|
|
-0.022094473916140396
|
|
],
|
|
"observed_m": [
|
|
0.5251505065301493,
|
|
-0.2683498725420233,
|
|
-0.02832190897844432
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 198,
|
|
"link": "Arm1",
|
|
"error_m": [
|
|
0.0064160898960205215,
|
|
0.05797850300630067,
|
|
-0.04247643611658032
|
|
],
|
|
"error_norm_m": 0.07215899559702423,
|
|
"predicted_m": [
|
|
0.17120497007552116,
|
|
-0.04320349238191376,
|
|
0.0821460777057791
|
|
],
|
|
"observed_m": [
|
|
0.16478888017950064,
|
|
-0.10118199538821443,
|
|
0.12462251382235942
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 205,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.01787184502840633,
|
|
0.01939057608520195,
|
|
-0.03762305905383564
|
|
],
|
|
"error_norm_m": 0.045944443170026356,
|
|
"predicted_m": [
|
|
0.7511065451948625,
|
|
-0.0904618956934443,
|
|
0.002863871869302129
|
|
],
|
|
"observed_m": [
|
|
0.7332347001664562,
|
|
-0.10985247177864625,
|
|
0.040486930923137765
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 206,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.0035172399804275223,
|
|
-0.002986860807394809,
|
|
-0.004956628989282884
|
|
],
|
|
"error_norm_m": 0.006772037027369862,
|
|
"predicted_m": [
|
|
0.6522339532958079,
|
|
-0.009170850205069928,
|
|
-0.0011331888720454656
|
|
],
|
|
"observed_m": [
|
|
0.6487167133153804,
|
|
-0.0061839893976751185,
|
|
0.003823440117237419
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 207,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.0034450521876430162,
|
|
-0.006453855944835017,
|
|
-0.00391434061794011
|
|
],
|
|
"error_norm_m": 0.008297150330415979,
|
|
"predicted_m": [
|
|
0.752215327902452,
|
|
-0.010512150778857032,
|
|
0.0002544870759521034
|
|
],
|
|
"observed_m": [
|
|
0.748770275714809,
|
|
-0.004058294834022015,
|
|
0.004168827693892214
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 208,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.0026732610778422705,
|
|
0.014079457102600501,
|
|
-0.004986118813423876
|
|
],
|
|
"error_norm_m": 0.01517362243881973,
|
|
"predicted_m": [
|
|
0.3511810467682862,
|
|
-0.08509669339829588,
|
|
-0.002686831922688146
|
|
],
|
|
"observed_m": [
|
|
0.34850778569044394,
|
|
-0.09917615050089638,
|
|
0.0022992868907357297
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 210,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.003165080576081926,
|
|
-0.00494491295578487,
|
|
-0.002157218759001077
|
|
],
|
|
"error_norm_m": 0.006254877454240515,
|
|
"predicted_m": [
|
|
0.022212695435501365,
|
|
-0.010714374704534568,
|
|
-0.009549374245261396
|
|
],
|
|
"observed_m": [
|
|
0.01904761485941944,
|
|
-0.0057694617487496986,
|
|
-0.0073921554862603185
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 211,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.001777675885192731,
|
|
0.007152318498723004,
|
|
-0.01161578587866537
|
|
],
|
|
"error_norm_m": 0.013756535648155493,
|
|
"predicted_m": [
|
|
0.25230845486923154,
|
|
-0.0038056479099215024,
|
|
-0.00668389266403574
|
|
],
|
|
"observed_m": [
|
|
0.2505307789840388,
|
|
-0.010957966408644507,
|
|
0.004931893214629631
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 214,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.0038544636936867493,
|
|
0.00010951264992545631,
|
|
-0.010358876324804485
|
|
],
|
|
"error_norm_m": 0.011053289198199687,
|
|
"predicted_m": [
|
|
0.35228982947587567,
|
|
-0.005146948483708609,
|
|
-0.005296216716038172
|
|
],
|
|
"observed_m": [
|
|
0.3484353657821889,
|
|
-0.005256461133634065,
|
|
0.005062659608766313
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 217,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.0030030815376417275,
|
|
0.016169941354732348,
|
|
-0.0047622245289590005
|
|
],
|
|
"error_norm_m": 0.017122040900588536,
|
|
"predicted_m": [
|
|
0.6511251705882184,
|
|
-0.0891205951196572,
|
|
0.00147619592130456
|
|
],
|
|
"observed_m": [
|
|
0.6541282521258601,
|
|
-0.10529053647438955,
|
|
0.0062384204502635605
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 229,
|
|
"link": "Arm1",
|
|
"error_m": [
|
|
-0.003763120246823848,
|
|
0.0403294419516374,
|
|
-0.0299036653260676
|
|
],
|
|
"error_norm_m": 0.050347335203126724,
|
|
"predicted_m": [
|
|
0.1700124134847137,
|
|
-0.13318940078559968,
|
|
0.08109056951484564
|
|
],
|
|
"observed_m": [
|
|
0.17377553373153753,
|
|
-0.17351884273723708,
|
|
0.11099423484091324
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 243,
|
|
"link": "Arm1",
|
|
"error_m": [
|
|
4.2840664442406196e-05,
|
|
0.005111587752395591,
|
|
-0.021888407351794058
|
|
],
|
|
"error_norm_m": 0.022477378429679975,
|
|
"predicted_m": [
|
|
0.1700397577224266,
|
|
-0.16777995741804264,
|
|
0.045685871462886336
|
|
],
|
|
"observed_m": [
|
|
0.1699969170579842,
|
|
-0.17289154517043823,
|
|
0.0675742788146804
|
|
]
|
|
}
|
|
],
|
|
"stage_idx": 0,
|
|
"num_active_links": 3
|
|
},
|
|
{
|
|
"method": "deterministic_geometric_prefix",
|
|
"active_links": [
|
|
"Board",
|
|
"Base",
|
|
"Arm1",
|
|
"Ellbow"
|
|
],
|
|
"active_observations": 43,
|
|
"joint_updates": [
|
|
{
|
|
"pass": 0,
|
|
"updates": [
|
|
{
|
|
"link": "Base",
|
|
"joint_variable": "x",
|
|
"joint_type": "linear",
|
|
"old": 0.060672736696816276,
|
|
"new": 0.061202970088263954,
|
|
"info": {
|
|
"reason": "weighted_projection",
|
|
"used_markers": 5,
|
|
"axis_world": [
|
|
0.9998137460654417,
|
|
-0.01341300573785765,
|
|
0.013876759479961816
|
|
],
|
|
"per_marker": [
|
|
{
|
|
"marker_id": 198,
|
|
"q_i": 0.05562494310371367,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 229,
|
|
"q_i": 0.06539106105516762,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 243,
|
|
"q_i": 0.06100220593156755,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 244,
|
|
"q_i": 0.0630514099548273,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 245,
|
|
"q_i": 0.06094523039604362,
|
|
"weight": 1.0
|
|
}
|
|
]
|
|
}
|
|
},
|
|
{
|
|
"link": "Arm1",
|
|
"joint_variable": "y",
|
|
"joint_type": "revolute",
|
|
"old": -0.044355505891484626,
|
|
"new": -0.07079579369955846,
|
|
"info": {
|
|
"reason": "2d_alignment+normal_tiebreak",
|
|
"used_markers": 5,
|
|
"axis_world": [
|
|
-0.9998137460654417,
|
|
0.01341300573785765,
|
|
-0.013876759479961816
|
|
],
|
|
"axis_id": 0,
|
|
"theta_rad": -0.07079579369955859,
|
|
"theta_alt_rad": 3.070796859890235,
|
|
"score_theta": 0.016104396417854622,
|
|
"score_theta_alt": 1.5360416384024345,
|
|
"best_score": 0.016104396417854622,
|
|
"per_marker": [
|
|
{
|
|
"marker_id": 198,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 229,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 243,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 244,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 245,
|
|
"weight": 1.0
|
|
}
|
|
]
|
|
}
|
|
},
|
|
{
|
|
"link": "Ellbow",
|
|
"joint_variable": "z",
|
|
"joint_type": "revolute",
|
|
"old": 0.0,
|
|
"new": 0.867856336251057,
|
|
"info": {
|
|
"reason": "2d_alignment+normal_tiebreak",
|
|
"used_markers": 1,
|
|
"axis_world": [
|
|
-0.9998137460654417,
|
|
0.01341300573785765,
|
|
-0.013876759479961816
|
|
],
|
|
"axis_id": 0,
|
|
"theta_rad": -2.2737363173387357,
|
|
"theta_alt_rad": 0.867856336251057,
|
|
"score_theta": 0.08878565615324918,
|
|
"score_theta_alt": 0.02013388445094868,
|
|
"best_score": 0.02013388445094868,
|
|
"per_marker": [
|
|
{
|
|
"marker_id": 245,
|
|
"weight": 1.0
|
|
}
|
|
]
|
|
}
|
|
}
|
|
]
|
|
},
|
|
{
|
|
"pass": 1,
|
|
"updates": [
|
|
{
|
|
"link": "Base",
|
|
"joint_variable": "x",
|
|
"joint_type": "linear",
|
|
"old": 0.061202970088263954,
|
|
"new": 0.061202970088294485,
|
|
"info": {
|
|
"reason": "weighted_projection",
|
|
"used_markers": 5,
|
|
"axis_world": [
|
|
0.9998137460654417,
|
|
-0.01341300573785765,
|
|
0.013876759479961816
|
|
],
|
|
"per_marker": [
|
|
{
|
|
"marker_id": 198,
|
|
"q_i": 0.05562494310371368,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 229,
|
|
"q_i": 0.0653910610551676,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 243,
|
|
"q_i": 0.061002205931567556,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 244,
|
|
"q_i": 0.06305140995491607,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 245,
|
|
"q_i": 0.06094523039610752,
|
|
"weight": 1.0
|
|
}
|
|
]
|
|
}
|
|
},
|
|
{
|
|
"link": "Arm1",
|
|
"joint_variable": "y",
|
|
"joint_type": "revolute",
|
|
"old": -0.07079579369955846,
|
|
"new": -0.059600761695578264,
|
|
"info": {
|
|
"reason": "2d_alignment+normal_tiebreak",
|
|
"used_markers": 5,
|
|
"axis_world": [
|
|
-0.9998137460654417,
|
|
0.01341300573785765,
|
|
-0.013876759479961816
|
|
],
|
|
"axis_id": 0,
|
|
"theta_rad": -0.05960076169557827,
|
|
"theta_alt_rad": 3.081991891894215,
|
|
"score_theta": 0.012282375412612196,
|
|
"score_theta_alt": 1.5665667305798034,
|
|
"best_score": 0.012282375412612196,
|
|
"per_marker": [
|
|
{
|
|
"marker_id": 198,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 229,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 243,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 244,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 245,
|
|
"weight": 1.0
|
|
}
|
|
]
|
|
}
|
|
},
|
|
{
|
|
"link": "Ellbow",
|
|
"joint_variable": "z",
|
|
"joint_type": "revolute",
|
|
"old": 0.867856336251057,
|
|
"new": 0.9235650996583162,
|
|
"info": {
|
|
"reason": "2d_alignment+normal_tiebreak",
|
|
"used_markers": 1,
|
|
"axis_world": [
|
|
-0.9998137460654417,
|
|
0.013413005737857652,
|
|
-0.013876759479961816
|
|
],
|
|
"axis_id": 0,
|
|
"theta_rad": -2.218027553931477,
|
|
"theta_alt_rad": 0.9235650996583162,
|
|
"score_theta": 0.08628409271475003,
|
|
"score_theta_alt": 0.02202155236830828,
|
|
"best_score": 0.02202155236830828,
|
|
"per_marker": [
|
|
{
|
|
"marker_id": 245,
|
|
"weight": 1.0
|
|
}
|
|
]
|
|
}
|
|
}
|
|
]
|
|
}
|
|
],
|
|
"root_link": "Board",
|
|
"root_pose": {
|
|
"reason": "kabsch",
|
|
"used_markers": [
|
|
210,
|
|
211,
|
|
214,
|
|
208,
|
|
206,
|
|
205,
|
|
207,
|
|
217,
|
|
46,
|
|
47,
|
|
51,
|
|
53,
|
|
54,
|
|
55,
|
|
56,
|
|
58,
|
|
60,
|
|
61,
|
|
62,
|
|
63,
|
|
64,
|
|
66,
|
|
68,
|
|
69,
|
|
72,
|
|
75,
|
|
79,
|
|
83,
|
|
84,
|
|
85,
|
|
86,
|
|
92,
|
|
95,
|
|
96,
|
|
97,
|
|
102,
|
|
103,
|
|
105
|
|
]
|
|
},
|
|
"marker_stats": {
|
|
"num_markers_used": 43,
|
|
"mean_error_m": 0.018468897161093106,
|
|
"rms_error_m": 0.02519983965672948,
|
|
"median_error_m": 0.012809681404744987,
|
|
"worst_error_m": 0.07392562227989355
|
|
},
|
|
"marker_reports": [
|
|
{
|
|
"marker_id": 46,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.005909038104734532,
|
|
-0.005912025002722032,
|
|
-0.004795093568657212
|
|
],
|
|
"error_norm_m": 0.009636477223975206,
|
|
"predicted_m": [
|
|
0.5420444932307554,
|
|
0.18676055768314986,
|
|
-0.03666266949746651
|
|
],
|
|
"observed_m": [
|
|
0.5361354551260209,
|
|
0.1926725826858719,
|
|
-0.031867575928809296
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 47,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.0017790247426832662,
|
|
0.003311081736141752,
|
|
0.0036937551998724068
|
|
],
|
|
"error_norm_m": 0.005269916391658902,
|
|
"predicted_m": [
|
|
0.343058802608786,
|
|
-0.282341214532261,
|
|
-0.023938950227605407
|
|
],
|
|
"observed_m": [
|
|
0.3448378273514693,
|
|
-0.28565229626840277,
|
|
-0.027632705427477814
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 51,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.0018130186400432402,
|
|
0.007841589806590554,
|
|
-0.0012948464725381949
|
|
],
|
|
"error_norm_m": 0.008151944226466085,
|
|
"predicted_m": [
|
|
0.16824805424916736,
|
|
-0.16558666039338263,
|
|
-0.030120604195743066
|
|
],
|
|
"observed_m": [
|
|
0.16643503560912412,
|
|
-0.17342825019997318,
|
|
-0.02882575772320487
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 53,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.011437630887001893,
|
|
-0.00848091304718021,
|
|
-0.00523088908565672
|
|
],
|
|
"error_norm_m": 0.015169294217186699,
|
|
"predicted_m": [
|
|
0.4919653338112853,
|
|
0.21422054249906963,
|
|
-0.03823703468659834
|
|
],
|
|
"observed_m": [
|
|
0.48052770292428343,
|
|
0.22270145554624984,
|
|
-0.03300614560094162
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 54,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.0018633715935418849,
|
|
-0.00026202290098609193,
|
|
0.0010998956810255936
|
|
],
|
|
"error_norm_m": 0.0021795825759531903,
|
|
"predicted_m": [
|
|
0.34048864418812924,
|
|
-0.32633725333460945,
|
|
-0.0225293561743478
|
|
],
|
|
"observed_m": [
|
|
0.3423520157816711,
|
|
-0.32607523043362335,
|
|
-0.023629251855373394
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 55,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.0017318564561557004,
|
|
0.0046670426208414995,
|
|
0.0017811452939564022
|
|
],
|
|
"error_norm_m": 0.005287068390673825,
|
|
"predicted_m": [
|
|
0.28289215325522865,
|
|
-0.2575846449531435,
|
|
-0.02556014368934707
|
|
],
|
|
"observed_m": [
|
|
0.28462400971138435,
|
|
-0.262251687573985,
|
|
-0.02734128898330347
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 56,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.0302235496648251,
|
|
-0.029443948972544487,
|
|
0.060700811724634623
|
|
],
|
|
"error_norm_m": 0.07392562227989355,
|
|
"predicted_m": [
|
|
0.5037891478927703,
|
|
0.17051118901364073,
|
|
-0.036643410373183985
|
|
],
|
|
"observed_m": [
|
|
0.5340126975575954,
|
|
0.19995513798618522,
|
|
-0.09734422209781861
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 58,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.0022024017192950884,
|
|
0.007832819714530759,
|
|
-0.0028935096217191057
|
|
],
|
|
"error_norm_m": 0.008635741771525868,
|
|
"predicted_m": [
|
|
0.04992201234930729,
|
|
-0.21000889996820854,
|
|
-0.030252662778657236
|
|
],
|
|
"observed_m": [
|
|
0.05212441406860238,
|
|
-0.2178417196827393,
|
|
-0.02735915315693813
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 60,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.006548213459839247,
|
|
0.0012692268576284804,
|
|
-0.012634590371468944
|
|
],
|
|
"error_norm_m": 0.014287158926342252,
|
|
"predicted_m": [
|
|
0.441076943257675,
|
|
0.28644158391102037,
|
|
-0.041291520606765046
|
|
],
|
|
"observed_m": [
|
|
0.43452872979783574,
|
|
0.2851723570533919,
|
|
-0.028656930235296103
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 61,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.004773031503023764,
|
|
-0.024724839033023305,
|
|
0.016079162880633865
|
|
],
|
|
"error_norm_m": 0.029877064345074533,
|
|
"predicted_m": [
|
|
-0.014896993714944018,
|
|
0.3445556983026755,
|
|
-0.0493268992639042
|
|
],
|
|
"observed_m": [
|
|
-0.010123962211920254,
|
|
0.3692805373356988,
|
|
-0.06540606214453806
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 62,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.0002670158087336727,
|
|
0.0036099577904157854,
|
|
0.002012572681416889
|
|
],
|
|
"error_norm_m": 0.004141683412416126,
|
|
"predicted_m": [
|
|
0.40506207414509576,
|
|
-0.17178230432320996,
|
|
-0.026734695598987862
|
|
],
|
|
"observed_m": [
|
|
0.4047950583363621,
|
|
-0.17539226211362574,
|
|
-0.02874726828040475
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 63,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.016524322658683088,
|
|
0.007443020870418315,
|
|
0.027506496731969726
|
|
],
|
|
"error_norm_m": 0.03294023620849752,
|
|
"predicted_m": [
|
|
0.7768465175003292,
|
|
-0.23779298064965895,
|
|
-0.01957154057037569
|
|
],
|
|
"observed_m": [
|
|
0.7933708401590123,
|
|
-0.24523600152007727,
|
|
-0.047078037302345416
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 64,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.0015743230007710905,
|
|
0.008489521641287107,
|
|
-0.005963280754507055
|
|
],
|
|
"error_norm_m": 0.010493387821181168,
|
|
"predicted_m": [
|
|
-0.021010566228709286,
|
|
-0.17919051815315568,
|
|
-0.03221751355546453
|
|
],
|
|
"observed_m": [
|
|
-0.019436243227938195,
|
|
-0.18768003979444278,
|
|
-0.026254232800957476
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 66,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.007998311016284065,
|
|
0.0013790262614014615,
|
|
0.0019330736586158047
|
|
],
|
|
"error_norm_m": 0.008343348627048988,
|
|
"predicted_m": [
|
|
0.20754094321470798,
|
|
-0.35717925773937836,
|
|
-0.023303675344947365
|
|
],
|
|
"observed_m": [
|
|
0.21553925423099204,
|
|
-0.3585582840007798,
|
|
-0.02523674900356317
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 68,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.007909606738037422,
|
|
-0.0011650636277719673,
|
|
-0.013591149304143003
|
|
],
|
|
"error_norm_m": 0.01576827801044461,
|
|
"predicted_m": [
|
|
0.5788524733092311,
|
|
0.17147330540153524,
|
|
-0.03566621567474805
|
|
],
|
|
"observed_m": [
|
|
0.5709428665711936,
|
|
0.1726383690293072,
|
|
-0.022075066370605047
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 69,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.01125874075257734,
|
|
-0.0019047553616383106,
|
|
-0.02453303098243099
|
|
],
|
|
"error_norm_m": 0.02706024658990296,
|
|
"predicted_m": [
|
|
0.006575372055793682,
|
|
-0.27249947678584446,
|
|
-0.02878399526561177
|
|
],
|
|
"observed_m": [
|
|
0.017834112808371022,
|
|
-0.27059472142420615,
|
|
-0.004250964283180778
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 72,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.01301934339557137,
|
|
-0.007156955177265112,
|
|
-0.0041459587385330385
|
|
],
|
|
"error_norm_m": 0.015424470289861113,
|
|
"predicted_m": [
|
|
0.4464653963378182,
|
|
0.19691887227789812,
|
|
-0.03828059462695163
|
|
],
|
|
"observed_m": [
|
|
0.4334460529422468,
|
|
0.20407582745516323,
|
|
-0.03413463588841859
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 75,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.001489679189073504,
|
|
-0.020292205908477245,
|
|
0.01741942628795258
|
|
],
|
|
"error_norm_m": 0.02678486843200487,
|
|
"predicted_m": [
|
|
-0.020134077270129586,
|
|
0.20343842459667755,
|
|
-0.044765220009239874
|
|
],
|
|
"observed_m": [
|
|
-0.01864439808105608,
|
|
0.2237306305051548,
|
|
-0.062184646297192454
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 79,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.0010722798357485908,
|
|
0.004005774416510954,
|
|
0.0006733588446190576
|
|
],
|
|
"error_norm_m": 0.004201121856808419,
|
|
"predicted_m": [
|
|
0.31290090195223613,
|
|
-0.15456298732822757,
|
|
-0.028538458960508453
|
|
],
|
|
"observed_m": [
|
|
0.31182862211648754,
|
|
-0.15856876174473852,
|
|
-0.02921181780512751
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 83,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.005255378085870212,
|
|
-0.017837246385331296,
|
|
0.008584734637097906
|
|
],
|
|
"error_norm_m": 0.020481309192184168,
|
|
"predicted_m": [
|
|
0.05171759016539374,
|
|
0.3470505308214037,
|
|
-0.048513557298345625
|
|
],
|
|
"observed_m": [
|
|
0.05697296825126395,
|
|
0.364887777206735,
|
|
-0.05709829193544353
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 84,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.01886370011504146,
|
|
-0.015537334900553867,
|
|
-0.003952255443371466
|
|
],
|
|
"error_norm_m": 0.02475617662184215,
|
|
"predicted_m": [
|
|
0.41386004798904846,
|
|
0.2614279410829299,
|
|
-0.04083623563520253
|
|
],
|
|
"observed_m": [
|
|
0.394996347874007,
|
|
0.27696527598348375,
|
|
-0.03688398019183106
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 85,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.0014332162830252848,
|
|
0.0014130660453137156,
|
|
0.008165047026109568
|
|
],
|
|
"error_norm_m": 0.008409450487453271,
|
|
"predicted_m": [
|
|
0.5030156718559659,
|
|
-0.3106855251799703,
|
|
-0.020858912152070003
|
|
],
|
|
"observed_m": [
|
|
0.5044488881389911,
|
|
-0.312098591225284,
|
|
-0.02902395917817957
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 86,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.00466511573223477,
|
|
0.006131361200086172,
|
|
-0.014563902120428459
|
|
],
|
|
"error_norm_m": 0.0164761688488097,
|
|
"predicted_m": [
|
|
0.3697339050538343,
|
|
0.29559506028485116,
|
|
-0.042550754548117284
|
|
],
|
|
"observed_m": [
|
|
0.36506878932159953,
|
|
0.289463699084765,
|
|
-0.027986852427688825
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 92,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.0030843417438075615,
|
|
0.007025737961659312,
|
|
0.004194660704404177
|
|
],
|
|
"error_norm_m": 0.008744674740867561,
|
|
"predicted_m": [
|
|
0.6452723062673585,
|
|
-0.18474053821588782,
|
|
-0.023081168789006144
|
|
],
|
|
"observed_m": [
|
|
0.6483566480111661,
|
|
-0.19176627617754713,
|
|
-0.02727582949341032
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 95,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.003518654131452137,
|
|
0.005044333025852332,
|
|
-0.00048515309056019335
|
|
],
|
|
"error_norm_m": 0.006169408082933876,
|
|
"predicted_m": [
|
|
0.1850710976230811,
|
|
-0.2677572446660259,
|
|
-0.026540852664406197
|
|
],
|
|
"observed_m": [
|
|
0.18858975175453324,
|
|
-0.27280157769187824,
|
|
-0.026055699573846004
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 96,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.00032807105204279985,
|
|
0.004261768433921759,
|
|
0.0018132550758337973
|
|
],
|
|
"error_norm_m": 0.00464308031048327,
|
|
"predicted_m": [
|
|
0.369980717057002,
|
|
-0.18269663296500055,
|
|
-0.026847899647670207
|
|
],
|
|
"observed_m": [
|
|
0.3696526460049592,
|
|
-0.1869584013989223,
|
|
-0.028661154723504004
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 97,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.004730285155796932,
|
|
0.000687276705387152,
|
|
0.004213699070405662
|
|
],
|
|
"error_norm_m": 0.006372064561887157,
|
|
"predicted_m": [
|
|
0.30217266442308105,
|
|
-0.3548903644334818,
|
|
-0.022107051521445743
|
|
],
|
|
"observed_m": [
|
|
0.306902949578878,
|
|
-0.35557764113886897,
|
|
-0.026320750591851405
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 102,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.004668507356966112,
|
|
0.004636651351887733,
|
|
0.01099065243696026
|
|
],
|
|
"error_norm_m": 0.012809681404744987,
|
|
"predicted_m": [
|
|
0.649342560147744,
|
|
-0.22293826636654013,
|
|
-0.02177265914897029
|
|
],
|
|
"observed_m": [
|
|
0.6540110675047102,
|
|
-0.22757491771842786,
|
|
-0.03276331158593055
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 103,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.00020855262325139567,
|
|
0.00728848879704197,
|
|
-0.0026312704778853648
|
|
],
|
|
"error_norm_m": 0.0077517190009095665,
|
|
"predicted_m": [
|
|
0.10595299033440675,
|
|
-0.18037402827980573,
|
|
-0.030472403637853997
|
|
],
|
|
"observed_m": [
|
|
0.10574443771115535,
|
|
-0.1876625170768477,
|
|
-0.027841133159968633
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 105,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.0012341282300909473,
|
|
0.003863389097407577,
|
|
0.006227435062303922
|
|
],
|
|
"error_norm_m": 0.007431675131589608,
|
|
"predicted_m": [
|
|
0.5239163783000583,
|
|
-0.2644864834446157,
|
|
-0.022094473916140396
|
|
],
|
|
"observed_m": [
|
|
0.5251505065301493,
|
|
-0.2683498725420233,
|
|
-0.02832190897844432
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 198,
|
|
"link": "Arm1",
|
|
"error_m": [
|
|
0.006973683762435456,
|
|
0.05748470049960011,
|
|
-0.04491792807952283
|
|
],
|
|
"error_norm_m": 0.07328535542456191,
|
|
"predicted_m": [
|
|
0.1717625639419361,
|
|
-0.04369729488861432,
|
|
0.07970458574283659
|
|
],
|
|
"observed_m": [
|
|
0.16478888017950064,
|
|
-0.10118199538821443,
|
|
0.12462251382235942
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 205,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.01787184502840633,
|
|
0.01939057608520195,
|
|
-0.03762305905383564
|
|
],
|
|
"error_norm_m": 0.045944443170026356,
|
|
"predicted_m": [
|
|
0.7511065451948625,
|
|
-0.0904618956934443,
|
|
0.002863871869302129
|
|
],
|
|
"observed_m": [
|
|
0.7332347001664562,
|
|
-0.10985247177864625,
|
|
0.040486930923137765
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 206,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.0035172399804275223,
|
|
-0.002986860807394809,
|
|
-0.004956628989282884
|
|
],
|
|
"error_norm_m": 0.006772037027369862,
|
|
"predicted_m": [
|
|
0.6522339532958079,
|
|
-0.009170850205069928,
|
|
-0.0011331888720454656
|
|
],
|
|
"observed_m": [
|
|
0.6487167133153804,
|
|
-0.0061839893976751185,
|
|
0.003823440117237419
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 207,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.0034450521876430162,
|
|
-0.006453855944835017,
|
|
-0.00391434061794011
|
|
],
|
|
"error_norm_m": 0.008297150330415979,
|
|
"predicted_m": [
|
|
0.752215327902452,
|
|
-0.010512150778857032,
|
|
0.0002544870759521034
|
|
],
|
|
"observed_m": [
|
|
0.748770275714809,
|
|
-0.004058294834022015,
|
|
0.004168827693892214
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 208,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.0026732610778422705,
|
|
0.014079457102600501,
|
|
-0.004986118813423876
|
|
],
|
|
"error_norm_m": 0.01517362243881973,
|
|
"predicted_m": [
|
|
0.3511810467682862,
|
|
-0.08509669339829588,
|
|
-0.002686831922688146
|
|
],
|
|
"observed_m": [
|
|
0.34850778569044394,
|
|
-0.09917615050089638,
|
|
0.0022992868907357297
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 210,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.003165080576081926,
|
|
-0.00494491295578487,
|
|
-0.002157218759001077
|
|
],
|
|
"error_norm_m": 0.006254877454240515,
|
|
"predicted_m": [
|
|
0.022212695435501365,
|
|
-0.010714374704534568,
|
|
-0.009549374245261396
|
|
],
|
|
"observed_m": [
|
|
0.01904761485941944,
|
|
-0.0057694617487496986,
|
|
-0.0073921554862603185
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 211,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.001777675885192731,
|
|
0.007152318498723004,
|
|
-0.01161578587866537
|
|
],
|
|
"error_norm_m": 0.013756535648155493,
|
|
"predicted_m": [
|
|
0.25230845486923154,
|
|
-0.0038056479099215024,
|
|
-0.00668389266403574
|
|
],
|
|
"observed_m": [
|
|
0.2505307789840388,
|
|
-0.010957966408644507,
|
|
0.004931893214629631
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 214,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.0038544636936867493,
|
|
0.00010951264992545631,
|
|
-0.010358876324804485
|
|
],
|
|
"error_norm_m": 0.011053289198199687,
|
|
"predicted_m": [
|
|
0.35228982947587567,
|
|
-0.005146948483708609,
|
|
-0.005296216716038172
|
|
],
|
|
"observed_m": [
|
|
0.3484353657821889,
|
|
-0.005256461133634065,
|
|
0.005062659608766313
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 217,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.0030030815376417275,
|
|
0.016169941354732348,
|
|
-0.0047622245289590005
|
|
],
|
|
"error_norm_m": 0.017122040900588536,
|
|
"predicted_m": [
|
|
0.6511251705882184,
|
|
-0.0891205951196572,
|
|
0.00147619592130456
|
|
],
|
|
"observed_m": [
|
|
0.6541282521258601,
|
|
-0.10529053647438955,
|
|
0.0062384204502635605
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 229,
|
|
"link": "Arm1",
|
|
"error_m": [
|
|
-0.0031861357617059827,
|
|
0.039861931997769856,
|
|
-0.03371682803025282
|
|
],
|
|
"error_norm_m": 0.05230630531884748,
|
|
"predicted_m": [
|
|
0.17058939796983155,
|
|
-0.13365691073946723,
|
|
0.07727740681066042
|
|
],
|
|
"observed_m": [
|
|
0.17377553373153753,
|
|
-0.17351884273723708,
|
|
0.11099423484091324
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 243,
|
|
"link": "Arm1",
|
|
"error_m": [
|
|
0.0006343789237579223,
|
|
0.005187735479511096,
|
|
-0.026224673444487513
|
|
],
|
|
"error_norm_m": 0.026740391419990378,
|
|
"predicted_m": [
|
|
0.17063129598174212,
|
|
-0.16770380969092713,
|
|
0.04134960537019288
|
|
],
|
|
"observed_m": [
|
|
0.1699969170579842,
|
|
-0.17289154517043823,
|
|
0.0675742788146804
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 244,
|
|
"link": "Ellbow",
|
|
"error_m": [
|
|
-0.0014052453046001223,
|
|
0.009823847467107794,
|
|
-0.02246122177353655
|
|
],
|
|
"error_norm_m": 0.0245558379409682,
|
|
"predicted_m": [
|
|
0.29606424545132154,
|
|
-0.13439614035505015,
|
|
0.044028103223256974
|
|
],
|
|
"observed_m": [
|
|
0.29746949075592166,
|
|
-0.14421998782215795,
|
|
0.06648932499679353
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 245,
|
|
"link": "Ellbow",
|
|
"error_m": [
|
|
0.0011092820978230722,
|
|
0.011875190953467812,
|
|
-0.04987142669823408
|
|
],
|
|
"error_norm_m": 0.05127777167419826,
|
|
"predicted_m": [
|
|
0.26100716490059145,
|
|
-0.16127039831609746,
|
|
0.02169482396786814
|
|
],
|
|
"observed_m": [
|
|
0.2598978828027684,
|
|
-0.17314558926956528,
|
|
0.07156625066610221
|
|
]
|
|
}
|
|
],
|
|
"stage_idx": 1,
|
|
"num_active_links": 4
|
|
},
|
|
{
|
|
"method": "deterministic_geometric_prefix",
|
|
"active_links": [
|
|
"Board",
|
|
"Base",
|
|
"Arm1",
|
|
"Ellbow",
|
|
"Arm2"
|
|
],
|
|
"active_observations": 45,
|
|
"joint_updates": [
|
|
{
|
|
"pass": 0,
|
|
"updates": [
|
|
{
|
|
"link": "Base",
|
|
"joint_variable": "x",
|
|
"joint_type": "linear",
|
|
"old": 0.061202970088294485,
|
|
"new": 0.07341210691100843,
|
|
"info": {
|
|
"reason": "weighted_projection",
|
|
"used_markers": 7,
|
|
"axis_world": [
|
|
0.9998137460654417,
|
|
-0.01341300573785765,
|
|
0.013876759479961816
|
|
],
|
|
"per_marker": [
|
|
{
|
|
"marker_id": 198,
|
|
"q_i": 0.05562494310371367,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 229,
|
|
"q_i": 0.0653910610551676,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 243,
|
|
"q_i": 0.061002205931567556,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 244,
|
|
"q_i": 0.06305140995492677,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 245,
|
|
"q_i": 0.060945230396115206,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 113,
|
|
"q_i": 0.07327054629001889,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 124,
|
|
"q_i": 0.13459935164554934,
|
|
"weight": 1.0
|
|
}
|
|
]
|
|
}
|
|
},
|
|
{
|
|
"link": "Arm1",
|
|
"joint_variable": "y",
|
|
"joint_type": "revolute",
|
|
"old": -0.059600761695578264,
|
|
"new": -0.18000835282807515,
|
|
"info": {
|
|
"reason": "2d_alignment+normal_tiebreak",
|
|
"used_markers": 7,
|
|
"axis_world": [
|
|
-0.9998137460654417,
|
|
0.01341300573785765,
|
|
-0.013876759479961816
|
|
],
|
|
"axis_id": 0,
|
|
"theta_rad": -0.18000835282807534,
|
|
"theta_alt_rad": 2.961584300761718,
|
|
"score_theta": 0.10879031349113559,
|
|
"score_theta_alt": 2.6289737421143533,
|
|
"best_score": 0.10879031349113559,
|
|
"per_marker": [
|
|
{
|
|
"marker_id": 198,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 229,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 243,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 244,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 245,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 113,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 124,
|
|
"weight": 1.0
|
|
}
|
|
]
|
|
}
|
|
},
|
|
{
|
|
"link": "Ellbow",
|
|
"joint_variable": "z",
|
|
"joint_type": "revolute",
|
|
"old": 0.9235650996583162,
|
|
"new": 1.484928793275004,
|
|
"info": {
|
|
"reason": "2d_alignment+normal_tiebreak",
|
|
"used_markers": 3,
|
|
"axis_world": [
|
|
-0.9998137460654417,
|
|
0.01341300573785765,
|
|
-0.013876759479961816
|
|
],
|
|
"axis_id": 0,
|
|
"theta_rad": -1.656663860314789,
|
|
"theta_alt_rad": 1.484928793275004,
|
|
"score_theta": 0.5642088603114379,
|
|
"score_theta_alt": 0.07143828002274752,
|
|
"best_score": 0.07143828002274752,
|
|
"per_marker": [
|
|
{
|
|
"marker_id": 245,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 113,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 124,
|
|
"weight": 1.0
|
|
}
|
|
]
|
|
}
|
|
},
|
|
{
|
|
"link": "Arm2",
|
|
"joint_variable": "a",
|
|
"joint_type": "revolute",
|
|
"old": 0.0,
|
|
"new": -1.4264537625755171,
|
|
"info": {
|
|
"reason": "2d_alignment+normal_tiebreak",
|
|
"used_markers": 2,
|
|
"axis_world": [
|
|
-0.016600353623634944,
|
|
-0.23093848360224598,
|
|
0.972826729201591
|
|
],
|
|
"axis_id": 2,
|
|
"theta_rad": -1.4264537625755171,
|
|
"theta_alt_rad": 1.7151388910142762,
|
|
"score_theta": 0.06820634970692561,
|
|
"score_theta_alt": 0.08447012836885415,
|
|
"best_score": 0.06820634970692561,
|
|
"per_marker": [
|
|
{
|
|
"marker_id": 113,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 124,
|
|
"weight": 1.0
|
|
}
|
|
]
|
|
}
|
|
}
|
|
]
|
|
},
|
|
{
|
|
"pass": 1,
|
|
"updates": [
|
|
{
|
|
"link": "Base",
|
|
"joint_variable": "x",
|
|
"joint_type": "linear",
|
|
"old": 0.07341210691100843,
|
|
"new": 0.06489017042145476,
|
|
"info": {
|
|
"reason": "weighted_projection",
|
|
"used_markers": 7,
|
|
"axis_world": [
|
|
0.9998137460654417,
|
|
-0.01341300573785765,
|
|
0.013876759479961816
|
|
],
|
|
"per_marker": [
|
|
{
|
|
"marker_id": 198,
|
|
"q_i": 0.05562494310371367,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 229,
|
|
"q_i": 0.06539106105516763,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 243,
|
|
"q_i": 0.061002205931567556,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 244,
|
|
"q_i": 0.06305140995505966,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 245,
|
|
"q_i": 0.06094523039621089,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 113,
|
|
"q_i": 0.04358252569475328,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 124,
|
|
"q_i": 0.10463381681371065,
|
|
"weight": 1.0
|
|
}
|
|
]
|
|
}
|
|
},
|
|
{
|
|
"link": "Arm1",
|
|
"joint_variable": "y",
|
|
"joint_type": "revolute",
|
|
"old": -0.18000835282807515,
|
|
"new": -0.05801316485959296,
|
|
"info": {
|
|
"reason": "2d_alignment+normal_tiebreak",
|
|
"used_markers": 7,
|
|
"axis_world": [
|
|
-0.9998137460654417,
|
|
0.01341300573785765,
|
|
-0.013876759479961816
|
|
],
|
|
"axis_id": 0,
|
|
"theta_rad": -0.058013164859592875,
|
|
"theta_alt_rad": 3.0835794887301997,
|
|
"score_theta": 0.02006340785810553,
|
|
"score_theta_alt": 2.49823200530699,
|
|
"best_score": 0.02006340785810553,
|
|
"per_marker": [
|
|
{
|
|
"marker_id": 198,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 229,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 243,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 244,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 245,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 113,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 124,
|
|
"weight": 1.0
|
|
}
|
|
]
|
|
}
|
|
},
|
|
{
|
|
"link": "Ellbow",
|
|
"joint_variable": "z",
|
|
"joint_type": "revolute",
|
|
"old": 1.484928793275004,
|
|
"new": 1.6349046839253045,
|
|
"info": {
|
|
"reason": "2d_alignment+normal_tiebreak",
|
|
"used_markers": 3,
|
|
"axis_world": [
|
|
-0.9998137460654417,
|
|
0.01341300573785765,
|
|
-0.013876759479961814
|
|
],
|
|
"axis_id": 0,
|
|
"theta_rad": -1.5066879696644886,
|
|
"theta_alt_rad": 1.6349046839253045,
|
|
"score_theta": 0.4896902400990149,
|
|
"score_theta_alt": 0.06487537733146216,
|
|
"best_score": 0.06487537733146216,
|
|
"per_marker": [
|
|
{
|
|
"marker_id": 245,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 113,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 124,
|
|
"weight": 1.0
|
|
}
|
|
]
|
|
}
|
|
},
|
|
{
|
|
"link": "Arm2",
|
|
"joint_variable": "a",
|
|
"joint_type": "revolute",
|
|
"old": -1.4264537625755171,
|
|
"new": -2.968388705126404,
|
|
"info": {
|
|
"reason": "2d_alignment+normal_tiebreak",
|
|
"used_markers": 2,
|
|
"axis_world": [
|
|
-0.013345819088128711,
|
|
0.03889427997848533,
|
|
0.9991542043627811
|
|
],
|
|
"axis_id": 2,
|
|
"theta_rad": -2.968388705126404,
|
|
"theta_alt_rad": 0.17320394846338916,
|
|
"score_theta": 0.055691943258982926,
|
|
"score_theta_alt": 0.06780217490833534,
|
|
"best_score": 0.055691943258982926,
|
|
"per_marker": [
|
|
{
|
|
"marker_id": 113,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 124,
|
|
"weight": 1.0
|
|
}
|
|
]
|
|
}
|
|
}
|
|
]
|
|
}
|
|
],
|
|
"root_link": "Board",
|
|
"root_pose": {
|
|
"reason": "kabsch",
|
|
"used_markers": [
|
|
210,
|
|
211,
|
|
214,
|
|
208,
|
|
206,
|
|
205,
|
|
207,
|
|
217,
|
|
46,
|
|
47,
|
|
51,
|
|
53,
|
|
54,
|
|
55,
|
|
56,
|
|
58,
|
|
60,
|
|
61,
|
|
62,
|
|
63,
|
|
64,
|
|
66,
|
|
68,
|
|
69,
|
|
72,
|
|
75,
|
|
79,
|
|
83,
|
|
84,
|
|
85,
|
|
86,
|
|
92,
|
|
95,
|
|
96,
|
|
97,
|
|
102,
|
|
103,
|
|
105
|
|
]
|
|
},
|
|
"marker_stats": {
|
|
"num_markers_used": 45,
|
|
"mean_error_m": 0.019848749962387186,
|
|
"rms_error_m": 0.027116917243099923,
|
|
"median_error_m": 0.013756535648155493,
|
|
"worst_error_m": 0.07392562227989355
|
|
},
|
|
"marker_reports": [
|
|
{
|
|
"marker_id": 46,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.005909038104734532,
|
|
-0.005912025002722032,
|
|
-0.004795093568657212
|
|
],
|
|
"error_norm_m": 0.009636477223975206,
|
|
"predicted_m": [
|
|
0.5420444932307554,
|
|
0.18676055768314986,
|
|
-0.03666266949746651
|
|
],
|
|
"observed_m": [
|
|
0.5361354551260209,
|
|
0.1926725826858719,
|
|
-0.031867575928809296
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 47,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.0017790247426832662,
|
|
0.003311081736141752,
|
|
0.0036937551998724068
|
|
],
|
|
"error_norm_m": 0.005269916391658902,
|
|
"predicted_m": [
|
|
0.343058802608786,
|
|
-0.282341214532261,
|
|
-0.023938950227605407
|
|
],
|
|
"observed_m": [
|
|
0.3448378273514693,
|
|
-0.28565229626840277,
|
|
-0.027632705427477814
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 51,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.0018130186400432402,
|
|
0.007841589806590554,
|
|
-0.0012948464725381949
|
|
],
|
|
"error_norm_m": 0.008151944226466085,
|
|
"predicted_m": [
|
|
0.16824805424916736,
|
|
-0.16558666039338263,
|
|
-0.030120604195743066
|
|
],
|
|
"observed_m": [
|
|
0.16643503560912412,
|
|
-0.17342825019997318,
|
|
-0.02882575772320487
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 53,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.011437630887001893,
|
|
-0.00848091304718021,
|
|
-0.00523088908565672
|
|
],
|
|
"error_norm_m": 0.015169294217186699,
|
|
"predicted_m": [
|
|
0.4919653338112853,
|
|
0.21422054249906963,
|
|
-0.03823703468659834
|
|
],
|
|
"observed_m": [
|
|
0.48052770292428343,
|
|
0.22270145554624984,
|
|
-0.03300614560094162
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 54,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.0018633715935418849,
|
|
-0.00026202290098609193,
|
|
0.0010998956810255936
|
|
],
|
|
"error_norm_m": 0.0021795825759531903,
|
|
"predicted_m": [
|
|
0.34048864418812924,
|
|
-0.32633725333460945,
|
|
-0.0225293561743478
|
|
],
|
|
"observed_m": [
|
|
0.3423520157816711,
|
|
-0.32607523043362335,
|
|
-0.023629251855373394
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 55,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.0017318564561557004,
|
|
0.0046670426208414995,
|
|
0.0017811452939564022
|
|
],
|
|
"error_norm_m": 0.005287068390673825,
|
|
"predicted_m": [
|
|
0.28289215325522865,
|
|
-0.2575846449531435,
|
|
-0.02556014368934707
|
|
],
|
|
"observed_m": [
|
|
0.28462400971138435,
|
|
-0.262251687573985,
|
|
-0.02734128898330347
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 56,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.0302235496648251,
|
|
-0.029443948972544487,
|
|
0.060700811724634623
|
|
],
|
|
"error_norm_m": 0.07392562227989355,
|
|
"predicted_m": [
|
|
0.5037891478927703,
|
|
0.17051118901364073,
|
|
-0.036643410373183985
|
|
],
|
|
"observed_m": [
|
|
0.5340126975575954,
|
|
0.19995513798618522,
|
|
-0.09734422209781861
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 58,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.0022024017192950884,
|
|
0.007832819714530759,
|
|
-0.0028935096217191057
|
|
],
|
|
"error_norm_m": 0.008635741771525868,
|
|
"predicted_m": [
|
|
0.04992201234930729,
|
|
-0.21000889996820854,
|
|
-0.030252662778657236
|
|
],
|
|
"observed_m": [
|
|
0.05212441406860238,
|
|
-0.2178417196827393,
|
|
-0.02735915315693813
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 60,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.006548213459839247,
|
|
0.0012692268576284804,
|
|
-0.012634590371468944
|
|
],
|
|
"error_norm_m": 0.014287158926342252,
|
|
"predicted_m": [
|
|
0.441076943257675,
|
|
0.28644158391102037,
|
|
-0.041291520606765046
|
|
],
|
|
"observed_m": [
|
|
0.43452872979783574,
|
|
0.2851723570533919,
|
|
-0.028656930235296103
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 61,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.004773031503023764,
|
|
-0.024724839033023305,
|
|
0.016079162880633865
|
|
],
|
|
"error_norm_m": 0.029877064345074533,
|
|
"predicted_m": [
|
|
-0.014896993714944018,
|
|
0.3445556983026755,
|
|
-0.0493268992639042
|
|
],
|
|
"observed_m": [
|
|
-0.010123962211920254,
|
|
0.3692805373356988,
|
|
-0.06540606214453806
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 62,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.0002670158087336727,
|
|
0.0036099577904157854,
|
|
0.002012572681416889
|
|
],
|
|
"error_norm_m": 0.004141683412416126,
|
|
"predicted_m": [
|
|
0.40506207414509576,
|
|
-0.17178230432320996,
|
|
-0.026734695598987862
|
|
],
|
|
"observed_m": [
|
|
0.4047950583363621,
|
|
-0.17539226211362574,
|
|
-0.02874726828040475
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 63,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.016524322658683088,
|
|
0.007443020870418315,
|
|
0.027506496731969726
|
|
],
|
|
"error_norm_m": 0.03294023620849752,
|
|
"predicted_m": [
|
|
0.7768465175003292,
|
|
-0.23779298064965895,
|
|
-0.01957154057037569
|
|
],
|
|
"observed_m": [
|
|
0.7933708401590123,
|
|
-0.24523600152007727,
|
|
-0.047078037302345416
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 64,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.0015743230007710905,
|
|
0.008489521641287107,
|
|
-0.005963280754507055
|
|
],
|
|
"error_norm_m": 0.010493387821181168,
|
|
"predicted_m": [
|
|
-0.021010566228709286,
|
|
-0.17919051815315568,
|
|
-0.03221751355546453
|
|
],
|
|
"observed_m": [
|
|
-0.019436243227938195,
|
|
-0.18768003979444278,
|
|
-0.026254232800957476
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 66,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.007998311016284065,
|
|
0.0013790262614014615,
|
|
0.0019330736586158047
|
|
],
|
|
"error_norm_m": 0.008343348627048988,
|
|
"predicted_m": [
|
|
0.20754094321470798,
|
|
-0.35717925773937836,
|
|
-0.023303675344947365
|
|
],
|
|
"observed_m": [
|
|
0.21553925423099204,
|
|
-0.3585582840007798,
|
|
-0.02523674900356317
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 68,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.007909606738037422,
|
|
-0.0011650636277719673,
|
|
-0.013591149304143003
|
|
],
|
|
"error_norm_m": 0.01576827801044461,
|
|
"predicted_m": [
|
|
0.5788524733092311,
|
|
0.17147330540153524,
|
|
-0.03566621567474805
|
|
],
|
|
"observed_m": [
|
|
0.5709428665711936,
|
|
0.1726383690293072,
|
|
-0.022075066370605047
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 69,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.01125874075257734,
|
|
-0.0019047553616383106,
|
|
-0.02453303098243099
|
|
],
|
|
"error_norm_m": 0.02706024658990296,
|
|
"predicted_m": [
|
|
0.006575372055793682,
|
|
-0.27249947678584446,
|
|
-0.02878399526561177
|
|
],
|
|
"observed_m": [
|
|
0.017834112808371022,
|
|
-0.27059472142420615,
|
|
-0.004250964283180778
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 72,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.01301934339557137,
|
|
-0.007156955177265112,
|
|
-0.0041459587385330385
|
|
],
|
|
"error_norm_m": 0.015424470289861113,
|
|
"predicted_m": [
|
|
0.4464653963378182,
|
|
0.19691887227789812,
|
|
-0.03828059462695163
|
|
],
|
|
"observed_m": [
|
|
0.4334460529422468,
|
|
0.20407582745516323,
|
|
-0.03413463588841859
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 75,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.001489679189073504,
|
|
-0.020292205908477245,
|
|
0.01741942628795258
|
|
],
|
|
"error_norm_m": 0.02678486843200487,
|
|
"predicted_m": [
|
|
-0.020134077270129586,
|
|
0.20343842459667755,
|
|
-0.044765220009239874
|
|
],
|
|
"observed_m": [
|
|
-0.01864439808105608,
|
|
0.2237306305051548,
|
|
-0.062184646297192454
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 79,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.0010722798357485908,
|
|
0.004005774416510954,
|
|
0.0006733588446190576
|
|
],
|
|
"error_norm_m": 0.004201121856808419,
|
|
"predicted_m": [
|
|
0.31290090195223613,
|
|
-0.15456298732822757,
|
|
-0.028538458960508453
|
|
],
|
|
"observed_m": [
|
|
0.31182862211648754,
|
|
-0.15856876174473852,
|
|
-0.02921181780512751
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 83,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.005255378085870212,
|
|
-0.017837246385331296,
|
|
0.008584734637097906
|
|
],
|
|
"error_norm_m": 0.020481309192184168,
|
|
"predicted_m": [
|
|
0.05171759016539374,
|
|
0.3470505308214037,
|
|
-0.048513557298345625
|
|
],
|
|
"observed_m": [
|
|
0.05697296825126395,
|
|
0.364887777206735,
|
|
-0.05709829193544353
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 84,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.01886370011504146,
|
|
-0.015537334900553867,
|
|
-0.003952255443371466
|
|
],
|
|
"error_norm_m": 0.02475617662184215,
|
|
"predicted_m": [
|
|
0.41386004798904846,
|
|
0.2614279410829299,
|
|
-0.04083623563520253
|
|
],
|
|
"observed_m": [
|
|
0.394996347874007,
|
|
0.27696527598348375,
|
|
-0.03688398019183106
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 85,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.0014332162830252848,
|
|
0.0014130660453137156,
|
|
0.008165047026109568
|
|
],
|
|
"error_norm_m": 0.008409450487453271,
|
|
"predicted_m": [
|
|
0.5030156718559659,
|
|
-0.3106855251799703,
|
|
-0.020858912152070003
|
|
],
|
|
"observed_m": [
|
|
0.5044488881389911,
|
|
-0.312098591225284,
|
|
-0.02902395917817957
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 86,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.00466511573223477,
|
|
0.006131361200086172,
|
|
-0.014563902120428459
|
|
],
|
|
"error_norm_m": 0.0164761688488097,
|
|
"predicted_m": [
|
|
0.3697339050538343,
|
|
0.29559506028485116,
|
|
-0.042550754548117284
|
|
],
|
|
"observed_m": [
|
|
0.36506878932159953,
|
|
0.289463699084765,
|
|
-0.027986852427688825
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 92,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.0030843417438075615,
|
|
0.007025737961659312,
|
|
0.004194660704404177
|
|
],
|
|
"error_norm_m": 0.008744674740867561,
|
|
"predicted_m": [
|
|
0.6452723062673585,
|
|
-0.18474053821588782,
|
|
-0.023081168789006144
|
|
],
|
|
"observed_m": [
|
|
0.6483566480111661,
|
|
-0.19176627617754713,
|
|
-0.02727582949341032
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 95,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.003518654131452137,
|
|
0.005044333025852332,
|
|
-0.00048515309056019335
|
|
],
|
|
"error_norm_m": 0.006169408082933876,
|
|
"predicted_m": [
|
|
0.1850710976230811,
|
|
-0.2677572446660259,
|
|
-0.026540852664406197
|
|
],
|
|
"observed_m": [
|
|
0.18858975175453324,
|
|
-0.27280157769187824,
|
|
-0.026055699573846004
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 96,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.00032807105204279985,
|
|
0.004261768433921759,
|
|
0.0018132550758337973
|
|
],
|
|
"error_norm_m": 0.00464308031048327,
|
|
"predicted_m": [
|
|
0.369980717057002,
|
|
-0.18269663296500055,
|
|
-0.026847899647670207
|
|
],
|
|
"observed_m": [
|
|
0.3696526460049592,
|
|
-0.1869584013989223,
|
|
-0.028661154723504004
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 97,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.004730285155796932,
|
|
0.000687276705387152,
|
|
0.004213699070405662
|
|
],
|
|
"error_norm_m": 0.006372064561887157,
|
|
"predicted_m": [
|
|
0.30217266442308105,
|
|
-0.3548903644334818,
|
|
-0.022107051521445743
|
|
],
|
|
"observed_m": [
|
|
0.306902949578878,
|
|
-0.35557764113886897,
|
|
-0.026320750591851405
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 102,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.004668507356966112,
|
|
0.004636651351887733,
|
|
0.01099065243696026
|
|
],
|
|
"error_norm_m": 0.012809681404744987,
|
|
"predicted_m": [
|
|
0.649342560147744,
|
|
-0.22293826636654013,
|
|
-0.02177265914897029
|
|
],
|
|
"observed_m": [
|
|
0.6540110675047102,
|
|
-0.22757491771842786,
|
|
-0.03276331158593055
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 103,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.00020855262325139567,
|
|
0.00728848879704197,
|
|
-0.0026312704778853648
|
|
],
|
|
"error_norm_m": 0.0077517190009095665,
|
|
"predicted_m": [
|
|
0.10595299033440675,
|
|
-0.18037402827980573,
|
|
-0.030472403637853997
|
|
],
|
|
"observed_m": [
|
|
0.10574443771115535,
|
|
-0.1876625170768477,
|
|
-0.027841133159968633
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 105,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.0012341282300909473,
|
|
0.003863389097407577,
|
|
0.006227435062303922
|
|
],
|
|
"error_norm_m": 0.007431675131589608,
|
|
"predicted_m": [
|
|
0.5239163783000583,
|
|
-0.2644864834446157,
|
|
-0.022094473916140396
|
|
],
|
|
"observed_m": [
|
|
0.5251505065301493,
|
|
-0.2683498725420233,
|
|
-0.02832190897844432
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 113,
|
|
"link": "Arm2",
|
|
"error_m": [
|
|
-0.0023937631501873557,
|
|
-0.006388175409712316,
|
|
-0.06504155799621728
|
|
],
|
|
"error_norm_m": 0.06539834213234877,
|
|
"predicted_m": [
|
|
0.26707992460015834,
|
|
-0.15650315430933753,
|
|
0.22705198444371497
|
|
],
|
|
"observed_m": [
|
|
0.2694736877503457,
|
|
-0.15011497889962522,
|
|
0.29209354243993224
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 124,
|
|
"link": "Arm2",
|
|
"error_m": [
|
|
0.0005947359909202476,
|
|
0.0010168575563119508,
|
|
-0.05864836890623654
|
|
],
|
|
"error_norm_m": 0.058660198478616976,
|
|
"predicted_m": [
|
|
0.2963828882238083,
|
|
-0.11990427428418927,
|
|
0.2630500163865299
|
|
],
|
|
"observed_m": [
|
|
0.29578815223288807,
|
|
-0.12092113184050123,
|
|
0.32169838529276645
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 198,
|
|
"link": "Arm1",
|
|
"error_m": [
|
|
0.010657309693155231,
|
|
0.05748418449156162,
|
|
-0.044611403271373015
|
|
],
|
|
"error_norm_m": 0.07354037678987499,
|
|
"predicted_m": [
|
|
0.17544618987265587,
|
|
-0.04369781089665281,
|
|
0.0800111105509864
|
|
],
|
|
"observed_m": [
|
|
0.16478888017950064,
|
|
-0.10118199538821443,
|
|
0.12462251382235942
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 205,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.01787184502840633,
|
|
0.01939057608520195,
|
|
-0.03762305905383564
|
|
],
|
|
"error_norm_m": 0.045944443170026356,
|
|
"predicted_m": [
|
|
0.7511065451948625,
|
|
-0.0904618956934443,
|
|
0.002863871869302129
|
|
],
|
|
"observed_m": [
|
|
0.7332347001664562,
|
|
-0.10985247177864625,
|
|
0.040486930923137765
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 206,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.0035172399804275223,
|
|
-0.002986860807394809,
|
|
-0.004956628989282884
|
|
],
|
|
"error_norm_m": 0.006772037027369862,
|
|
"predicted_m": [
|
|
0.6522339532958079,
|
|
-0.009170850205069928,
|
|
-0.0011331888720454656
|
|
],
|
|
"observed_m": [
|
|
0.6487167133153804,
|
|
-0.0061839893976751185,
|
|
0.003823440117237419
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 207,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.0034450521876430162,
|
|
-0.006453855944835017,
|
|
-0.00391434061794011
|
|
],
|
|
"error_norm_m": 0.008297150330415979,
|
|
"predicted_m": [
|
|
0.752215327902452,
|
|
-0.010512150778857032,
|
|
0.0002544870759521034
|
|
],
|
|
"observed_m": [
|
|
0.748770275714809,
|
|
-0.004058294834022015,
|
|
0.004168827693892214
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 208,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.0026732610778422705,
|
|
0.014079457102600501,
|
|
-0.004986118813423876
|
|
],
|
|
"error_norm_m": 0.01517362243881973,
|
|
"predicted_m": [
|
|
0.3511810467682862,
|
|
-0.08509669339829588,
|
|
-0.002686831922688146
|
|
],
|
|
"observed_m": [
|
|
0.34850778569044394,
|
|
-0.09917615050089638,
|
|
0.0022992868907357297
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 210,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.003165080576081926,
|
|
-0.00494491295578487,
|
|
-0.002157218759001077
|
|
],
|
|
"error_norm_m": 0.006254877454240515,
|
|
"predicted_m": [
|
|
0.022212695435501365,
|
|
-0.010714374704534568,
|
|
-0.009549374245261396
|
|
],
|
|
"observed_m": [
|
|
0.01904761485941944,
|
|
-0.0057694617487496986,
|
|
-0.0073921554862603185
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 211,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.001777675885192731,
|
|
0.007152318498723004,
|
|
-0.01161578587866537
|
|
],
|
|
"error_norm_m": 0.013756535648155493,
|
|
"predicted_m": [
|
|
0.25230845486923154,
|
|
-0.0038056479099215024,
|
|
-0.00668389266403574
|
|
],
|
|
"observed_m": [
|
|
0.2505307789840388,
|
|
-0.010957966408644507,
|
|
0.004931893214629631
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 214,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.0038544636936867493,
|
|
0.00010951264992545631,
|
|
-0.010358876324804485
|
|
],
|
|
"error_norm_m": 0.011053289198199687,
|
|
"predicted_m": [
|
|
0.35228982947587567,
|
|
-0.005146948483708609,
|
|
-0.005296216716038172
|
|
],
|
|
"observed_m": [
|
|
0.3484353657821889,
|
|
-0.005256461133634065,
|
|
0.005062659608766313
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 217,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.0030030815376417275,
|
|
0.016169941354732348,
|
|
-0.0047622245289590005
|
|
],
|
|
"error_norm_m": 0.017122040900588536,
|
|
"predicted_m": [
|
|
0.6511251705882184,
|
|
-0.0891205951196572,
|
|
0.00147619592130456
|
|
],
|
|
"observed_m": [
|
|
0.6541282521258601,
|
|
-0.10529053647438955,
|
|
0.0062384204502635605
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 229,
|
|
"link": "Arm1",
|
|
"error_m": [
|
|
0.0004954580896405492,
|
|
0.03985770254307011,
|
|
-0.03326748224059263
|
|
],
|
|
"error_norm_m": 0.0519192382971726,
|
|
"predicted_m": [
|
|
0.17427099182117808,
|
|
-0.13366114019416697,
|
|
0.07772675260032061
|
|
],
|
|
"observed_m": [
|
|
0.17377553373153753,
|
|
-0.17351884273723708,
|
|
0.11099423484091324
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 243,
|
|
"link": "Arm1",
|
|
"error_m": [
|
|
0.004314457583333292,
|
|
0.005126519792525236,
|
|
-0.025721240610860313
|
|
],
|
|
"error_norm_m": 0.026579653270562144,
|
|
"predicted_m": [
|
|
0.1743113746413175,
|
|
-0.167765025377913,
|
|
0.04185303820382008
|
|
],
|
|
"observed_m": [
|
|
0.1699969170579842,
|
|
-0.17289154517043823,
|
|
0.0675742788146804
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 244,
|
|
"link": "Ellbow",
|
|
"error_m": [
|
|
0.0022756236078981806,
|
|
0.009764075898270164,
|
|
-0.02201333043272126
|
|
],
|
|
"error_norm_m": 0.024188889137208756,
|
|
"predicted_m": [
|
|
0.29974511436381984,
|
|
-0.13445591192388778,
|
|
0.044475994564072266
|
|
],
|
|
"observed_m": [
|
|
0.29746949075592166,
|
|
-0.14421998782215795,
|
|
0.06648932499679353
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 245,
|
|
"link": "Ellbow",
|
|
"error_m": [
|
|
0.004365801881241582,
|
|
0.004188766882578215,
|
|
-0.026221161696203636
|
|
],
|
|
"error_norm_m": 0.02691013405320184,
|
|
"predicted_m": [
|
|
0.26426368468400996,
|
|
-0.16895682238698706,
|
|
0.04534508896989858
|
|
],
|
|
"observed_m": [
|
|
0.2598978828027684,
|
|
-0.17314558926956528,
|
|
0.07156625066610221
|
|
]
|
|
}
|
|
],
|
|
"stage_idx": 2,
|
|
"num_active_links": 5
|
|
}
|
|
],
|
|
"markers": [
|
|
{
|
|
"marker_id": 41,
|
|
"link": "FingerA",
|
|
"observed_position_m": [
|
|
0.16618766117232975,
|
|
-0.2569426700546937,
|
|
0.4724411904678126
|
|
],
|
|
"predicted_position_m": [
|
|
0.259580019560386,
|
|
-0.14914250765911677,
|
|
0.3319543309626314
|
|
],
|
|
"error_m": [
|
|
0.09339235838805626,
|
|
0.10780016239557691,
|
|
-0.1404868595051812
|
|
],
|
|
"error_norm_m": 0.2001988144605867
|
|
},
|
|
{
|
|
"marker_id": 42,
|
|
"link": "FingerA",
|
|
"observed_position_m": [
|
|
0.22321886551095868,
|
|
-0.035360792452610305,
|
|
0.42901134599473967
|
|
],
|
|
"predicted_position_m": [
|
|
0.24274234463622293,
|
|
-0.12419157569332828,
|
|
0.36859015628662656
|
|
],
|
|
"error_m": [
|
|
0.019523479125264254,
|
|
-0.08883078324071797,
|
|
-0.06042118970811311
|
|
],
|
|
"error_norm_m": 0.10919154937108386
|
|
},
|
|
{
|
|
"marker_id": 43,
|
|
"link": "FingerB",
|
|
"observed_position_m": [
|
|
0.2734953381578942,
|
|
-0.036947160499206384,
|
|
0.4303044703555823
|
|
],
|
|
"predicted_position_m": [
|
|
0.279135505912545,
|
|
-0.1362938383823756,
|
|
0.35353382704898023
|
|
],
|
|
"error_m": [
|
|
0.0056401677546508155,
|
|
-0.09934667788316923,
|
|
-0.07677064330660205
|
|
],
|
|
"error_norm_m": 0.12567937608228452
|
|
},
|
|
{
|
|
"marker_id": 46,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.5361354551260209,
|
|
0.1926725826858719,
|
|
-0.031867575928809296
|
|
],
|
|
"predicted_position_m": [
|
|
0.5420444932307554,
|
|
0.18676055768314986,
|
|
-0.03666266949746651
|
|
],
|
|
"error_m": [
|
|
0.005909038104734532,
|
|
-0.005912025002722032,
|
|
-0.004795093568657212
|
|
],
|
|
"error_norm_m": 0.009636477223975206
|
|
},
|
|
{
|
|
"marker_id": 47,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.3448378273514693,
|
|
-0.28565229626840277,
|
|
-0.027632705427477814
|
|
],
|
|
"predicted_position_m": [
|
|
0.343058802608786,
|
|
-0.282341214532261,
|
|
-0.023938950227605407
|
|
],
|
|
"error_m": [
|
|
-0.0017790247426832662,
|
|
0.003311081736141752,
|
|
0.0036937551998724068
|
|
],
|
|
"error_norm_m": 0.005269916391658902
|
|
},
|
|
{
|
|
"marker_id": 51,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.16643503560912412,
|
|
-0.17342825019997318,
|
|
-0.02882575772320487
|
|
],
|
|
"predicted_position_m": [
|
|
0.16824805424916736,
|
|
-0.16558666039338263,
|
|
-0.030120604195743066
|
|
],
|
|
"error_m": [
|
|
0.0018130186400432402,
|
|
0.007841589806590554,
|
|
-0.0012948464725381949
|
|
],
|
|
"error_norm_m": 0.008151944226466085
|
|
},
|
|
{
|
|
"marker_id": 53,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.48052770292428343,
|
|
0.22270145554624984,
|
|
-0.03300614560094162
|
|
],
|
|
"predicted_position_m": [
|
|
0.4919653338112853,
|
|
0.21422054249906963,
|
|
-0.03823703468659834
|
|
],
|
|
"error_m": [
|
|
0.011437630887001893,
|
|
-0.00848091304718021,
|
|
-0.00523088908565672
|
|
],
|
|
"error_norm_m": 0.015169294217186699
|
|
},
|
|
{
|
|
"marker_id": 54,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.3423520157816711,
|
|
-0.32607523043362335,
|
|
-0.023629251855373394
|
|
],
|
|
"predicted_position_m": [
|
|
0.34048864418812924,
|
|
-0.32633725333460945,
|
|
-0.0225293561743478
|
|
],
|
|
"error_m": [
|
|
-0.0018633715935418849,
|
|
-0.00026202290098609193,
|
|
0.0010998956810255936
|
|
],
|
|
"error_norm_m": 0.0021795825759531903
|
|
},
|
|
{
|
|
"marker_id": 55,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.28462400971138435,
|
|
-0.262251687573985,
|
|
-0.02734128898330347
|
|
],
|
|
"predicted_position_m": [
|
|
0.28289215325522865,
|
|
-0.2575846449531435,
|
|
-0.02556014368934707
|
|
],
|
|
"error_m": [
|
|
-0.0017318564561557004,
|
|
0.0046670426208414995,
|
|
0.0017811452939564022
|
|
],
|
|
"error_norm_m": 0.005287068390673825
|
|
},
|
|
{
|
|
"marker_id": 56,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.5340126975575954,
|
|
0.19995513798618522,
|
|
-0.09734422209781861
|
|
],
|
|
"predicted_position_m": [
|
|
0.5037891478927703,
|
|
0.17051118901364073,
|
|
-0.036643410373183985
|
|
],
|
|
"error_m": [
|
|
-0.0302235496648251,
|
|
-0.029443948972544487,
|
|
0.060700811724634623
|
|
],
|
|
"error_norm_m": 0.07392562227989355
|
|
},
|
|
{
|
|
"marker_id": 58,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.05212441406860238,
|
|
-0.2178417196827393,
|
|
-0.02735915315693813
|
|
],
|
|
"predicted_position_m": [
|
|
0.04992201234930729,
|
|
-0.21000889996820854,
|
|
-0.030252662778657236
|
|
],
|
|
"error_m": [
|
|
-0.0022024017192950884,
|
|
0.007832819714530759,
|
|
-0.0028935096217191057
|
|
],
|
|
"error_norm_m": 0.008635741771525868
|
|
},
|
|
{
|
|
"marker_id": 60,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.43452872979783574,
|
|
0.2851723570533919,
|
|
-0.028656930235296103
|
|
],
|
|
"predicted_position_m": [
|
|
0.441076943257675,
|
|
0.28644158391102037,
|
|
-0.041291520606765046
|
|
],
|
|
"error_m": [
|
|
0.006548213459839247,
|
|
0.0012692268576284804,
|
|
-0.012634590371468944
|
|
],
|
|
"error_norm_m": 0.014287158926342252
|
|
},
|
|
{
|
|
"marker_id": 61,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
-0.010123962211920254,
|
|
0.3692805373356988,
|
|
-0.06540606214453806
|
|
],
|
|
"predicted_position_m": [
|
|
-0.014896993714944018,
|
|
0.3445556983026755,
|
|
-0.0493268992639042
|
|
],
|
|
"error_m": [
|
|
-0.004773031503023764,
|
|
-0.024724839033023305,
|
|
0.016079162880633865
|
|
],
|
|
"error_norm_m": 0.029877064345074533
|
|
},
|
|
{
|
|
"marker_id": 62,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.4047950583363621,
|
|
-0.17539226211362574,
|
|
-0.02874726828040475
|
|
],
|
|
"predicted_position_m": [
|
|
0.40506207414509576,
|
|
-0.17178230432320996,
|
|
-0.026734695598987862
|
|
],
|
|
"error_m": [
|
|
0.0002670158087336727,
|
|
0.0036099577904157854,
|
|
0.002012572681416889
|
|
],
|
|
"error_norm_m": 0.004141683412416126
|
|
},
|
|
{
|
|
"marker_id": 63,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.7933708401590123,
|
|
-0.24523600152007727,
|
|
-0.047078037302345416
|
|
],
|
|
"predicted_position_m": [
|
|
0.7768465175003292,
|
|
-0.23779298064965895,
|
|
-0.01957154057037569
|
|
],
|
|
"error_m": [
|
|
-0.016524322658683088,
|
|
0.007443020870418315,
|
|
0.027506496731969726
|
|
],
|
|
"error_norm_m": 0.03294023620849752
|
|
},
|
|
{
|
|
"marker_id": 64,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
-0.019436243227938195,
|
|
-0.18768003979444278,
|
|
-0.026254232800957476
|
|
],
|
|
"predicted_position_m": [
|
|
-0.021010566228709286,
|
|
-0.17919051815315568,
|
|
-0.03221751355546453
|
|
],
|
|
"error_m": [
|
|
-0.0015743230007710905,
|
|
0.008489521641287107,
|
|
-0.005963280754507055
|
|
],
|
|
"error_norm_m": 0.010493387821181168
|
|
},
|
|
{
|
|
"marker_id": 66,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.21553925423099204,
|
|
-0.3585582840007798,
|
|
-0.02523674900356317
|
|
],
|
|
"predicted_position_m": [
|
|
0.20754094321470798,
|
|
-0.35717925773937836,
|
|
-0.023303675344947365
|
|
],
|
|
"error_m": [
|
|
-0.007998311016284065,
|
|
0.0013790262614014615,
|
|
0.0019330736586158047
|
|
],
|
|
"error_norm_m": 0.008343348627048988
|
|
},
|
|
{
|
|
"marker_id": 68,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.5709428665711936,
|
|
0.1726383690293072,
|
|
-0.022075066370605047
|
|
],
|
|
"predicted_position_m": [
|
|
0.5788524733092311,
|
|
0.17147330540153524,
|
|
-0.03566621567474805
|
|
],
|
|
"error_m": [
|
|
0.007909606738037422,
|
|
-0.0011650636277719673,
|
|
-0.013591149304143003
|
|
],
|
|
"error_norm_m": 0.01576827801044461
|
|
},
|
|
{
|
|
"marker_id": 69,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.017834112808371022,
|
|
-0.27059472142420615,
|
|
-0.004250964283180778
|
|
],
|
|
"predicted_position_m": [
|
|
0.006575372055793682,
|
|
-0.27249947678584446,
|
|
-0.02878399526561177
|
|
],
|
|
"error_m": [
|
|
-0.01125874075257734,
|
|
-0.0019047553616383106,
|
|
-0.02453303098243099
|
|
],
|
|
"error_norm_m": 0.02706024658990296
|
|
},
|
|
{
|
|
"marker_id": 72,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.4334460529422468,
|
|
0.20407582745516323,
|
|
-0.03413463588841859
|
|
],
|
|
"predicted_position_m": [
|
|
0.4464653963378182,
|
|
0.19691887227789812,
|
|
-0.03828059462695163
|
|
],
|
|
"error_m": [
|
|
0.01301934339557137,
|
|
-0.007156955177265112,
|
|
-0.0041459587385330385
|
|
],
|
|
"error_norm_m": 0.015424470289861113
|
|
},
|
|
{
|
|
"marker_id": 75,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
-0.01864439808105608,
|
|
0.2237306305051548,
|
|
-0.062184646297192454
|
|
],
|
|
"predicted_position_m": [
|
|
-0.020134077270129586,
|
|
0.20343842459667755,
|
|
-0.044765220009239874
|
|
],
|
|
"error_m": [
|
|
-0.001489679189073504,
|
|
-0.020292205908477245,
|
|
0.01741942628795258
|
|
],
|
|
"error_norm_m": 0.02678486843200487
|
|
},
|
|
{
|
|
"marker_id": 79,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.31182862211648754,
|
|
-0.15856876174473852,
|
|
-0.02921181780512751
|
|
],
|
|
"predicted_position_m": [
|
|
0.31290090195223613,
|
|
-0.15456298732822757,
|
|
-0.028538458960508453
|
|
],
|
|
"error_m": [
|
|
0.0010722798357485908,
|
|
0.004005774416510954,
|
|
0.0006733588446190576
|
|
],
|
|
"error_norm_m": 0.004201121856808419
|
|
},
|
|
{
|
|
"marker_id": 83,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.05697296825126395,
|
|
0.364887777206735,
|
|
-0.05709829193544353
|
|
],
|
|
"predicted_position_m": [
|
|
0.05171759016539374,
|
|
0.3470505308214037,
|
|
-0.048513557298345625
|
|
],
|
|
"error_m": [
|
|
-0.005255378085870212,
|
|
-0.017837246385331296,
|
|
0.008584734637097906
|
|
],
|
|
"error_norm_m": 0.020481309192184168
|
|
},
|
|
{
|
|
"marker_id": 84,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.394996347874007,
|
|
0.27696527598348375,
|
|
-0.03688398019183106
|
|
],
|
|
"predicted_position_m": [
|
|
0.41386004798904846,
|
|
0.2614279410829299,
|
|
-0.04083623563520253
|
|
],
|
|
"error_m": [
|
|
0.01886370011504146,
|
|
-0.015537334900553867,
|
|
-0.003952255443371466
|
|
],
|
|
"error_norm_m": 0.02475617662184215
|
|
},
|
|
{
|
|
"marker_id": 85,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.5044488881389911,
|
|
-0.312098591225284,
|
|
-0.02902395917817957
|
|
],
|
|
"predicted_position_m": [
|
|
0.5030156718559659,
|
|
-0.3106855251799703,
|
|
-0.020858912152070003
|
|
],
|
|
"error_m": [
|
|
-0.0014332162830252848,
|
|
0.0014130660453137156,
|
|
0.008165047026109568
|
|
],
|
|
"error_norm_m": 0.008409450487453271
|
|
},
|
|
{
|
|
"marker_id": 86,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.36506878932159953,
|
|
0.289463699084765,
|
|
-0.027986852427688825
|
|
],
|
|
"predicted_position_m": [
|
|
0.3697339050538343,
|
|
0.29559506028485116,
|
|
-0.042550754548117284
|
|
],
|
|
"error_m": [
|
|
0.00466511573223477,
|
|
0.006131361200086172,
|
|
-0.014563902120428459
|
|
],
|
|
"error_norm_m": 0.0164761688488097
|
|
},
|
|
{
|
|
"marker_id": 92,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.6483566480111661,
|
|
-0.19176627617754713,
|
|
-0.02727582949341032
|
|
],
|
|
"predicted_position_m": [
|
|
0.6452723062673585,
|
|
-0.18474053821588782,
|
|
-0.023081168789006144
|
|
],
|
|
"error_m": [
|
|
-0.0030843417438075615,
|
|
0.007025737961659312,
|
|
0.004194660704404177
|
|
],
|
|
"error_norm_m": 0.008744674740867561
|
|
},
|
|
{
|
|
"marker_id": 95,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.18858975175453324,
|
|
-0.27280157769187824,
|
|
-0.026055699573846004
|
|
],
|
|
"predicted_position_m": [
|
|
0.1850710976230811,
|
|
-0.2677572446660259,
|
|
-0.026540852664406197
|
|
],
|
|
"error_m": [
|
|
-0.003518654131452137,
|
|
0.005044333025852332,
|
|
-0.00048515309056019335
|
|
],
|
|
"error_norm_m": 0.006169408082933876
|
|
},
|
|
{
|
|
"marker_id": 96,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.3696526460049592,
|
|
-0.1869584013989223,
|
|
-0.028661154723504004
|
|
],
|
|
"predicted_position_m": [
|
|
0.369980717057002,
|
|
-0.18269663296500055,
|
|
-0.026847899647670207
|
|
],
|
|
"error_m": [
|
|
0.00032807105204279985,
|
|
0.004261768433921759,
|
|
0.0018132550758337973
|
|
],
|
|
"error_norm_m": 0.00464308031048327
|
|
},
|
|
{
|
|
"marker_id": 97,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.306902949578878,
|
|
-0.35557764113886897,
|
|
-0.026320750591851405
|
|
],
|
|
"predicted_position_m": [
|
|
0.30217266442308105,
|
|
-0.3548903644334818,
|
|
-0.022107051521445743
|
|
],
|
|
"error_m": [
|
|
-0.004730285155796932,
|
|
0.000687276705387152,
|
|
0.004213699070405662
|
|
],
|
|
"error_norm_m": 0.006372064561887157
|
|
},
|
|
{
|
|
"marker_id": 102,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.6540110675047102,
|
|
-0.22757491771842786,
|
|
-0.03276331158593055
|
|
],
|
|
"predicted_position_m": [
|
|
0.649342560147744,
|
|
-0.22293826636654013,
|
|
-0.02177265914897029
|
|
],
|
|
"error_m": [
|
|
-0.004668507356966112,
|
|
0.004636651351887733,
|
|
0.01099065243696026
|
|
],
|
|
"error_norm_m": 0.012809681404744987
|
|
},
|
|
{
|
|
"marker_id": 103,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.10574443771115535,
|
|
-0.1876625170768477,
|
|
-0.027841133159968633
|
|
],
|
|
"predicted_position_m": [
|
|
0.10595299033440675,
|
|
-0.18037402827980573,
|
|
-0.030472403637853997
|
|
],
|
|
"error_m": [
|
|
0.00020855262325139567,
|
|
0.00728848879704197,
|
|
-0.0026312704778853648
|
|
],
|
|
"error_norm_m": 0.0077517190009095665
|
|
},
|
|
{
|
|
"marker_id": 105,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.5251505065301493,
|
|
-0.2683498725420233,
|
|
-0.02832190897844432
|
|
],
|
|
"predicted_position_m": [
|
|
0.5239163783000583,
|
|
-0.2644864834446157,
|
|
-0.022094473916140396
|
|
],
|
|
"error_m": [
|
|
-0.0012341282300909473,
|
|
0.003863389097407577,
|
|
0.006227435062303922
|
|
],
|
|
"error_norm_m": 0.007431675131589608
|
|
},
|
|
{
|
|
"marker_id": 113,
|
|
"link": "Arm2",
|
|
"observed_position_m": [
|
|
0.2694736877503457,
|
|
-0.15011497889962522,
|
|
0.29209354243993224
|
|
],
|
|
"predicted_position_m": [
|
|
0.26707992460015834,
|
|
-0.15650315430933753,
|
|
0.22705198444371497
|
|
],
|
|
"error_m": [
|
|
-0.0023937631501873557,
|
|
-0.006388175409712316,
|
|
-0.06504155799621728
|
|
],
|
|
"error_norm_m": 0.06539834213234877
|
|
},
|
|
{
|
|
"marker_id": 124,
|
|
"link": "Arm2",
|
|
"observed_position_m": [
|
|
0.29578815223288807,
|
|
-0.12092113184050123,
|
|
0.32169838529276645
|
|
],
|
|
"predicted_position_m": [
|
|
0.2963828882238083,
|
|
-0.11990427428418927,
|
|
0.2630500163865299
|
|
],
|
|
"error_m": [
|
|
0.0005947359909202476,
|
|
0.0010168575563119508,
|
|
-0.05864836890623654
|
|
],
|
|
"error_norm_m": 0.058660198478616976
|
|
},
|
|
{
|
|
"marker_id": 198,
|
|
"link": "Arm1",
|
|
"observed_position_m": [
|
|
0.16478888017950064,
|
|
-0.10118199538821443,
|
|
0.12462251382235942
|
|
],
|
|
"predicted_position_m": [
|
|
0.17544618987265587,
|
|
-0.04369781089665281,
|
|
0.0800111105509864
|
|
],
|
|
"error_m": [
|
|
0.010657309693155231,
|
|
0.05748418449156162,
|
|
-0.044611403271373015
|
|
],
|
|
"error_norm_m": 0.07354037678987499
|
|
},
|
|
{
|
|
"marker_id": 205,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.7332347001664562,
|
|
-0.10985247177864625,
|
|
0.040486930923137765
|
|
],
|
|
"predicted_position_m": [
|
|
0.7511065451948625,
|
|
-0.0904618956934443,
|
|
0.002863871869302129
|
|
],
|
|
"error_m": [
|
|
0.01787184502840633,
|
|
0.01939057608520195,
|
|
-0.03762305905383564
|
|
],
|
|
"error_norm_m": 0.045944443170026356
|
|
},
|
|
{
|
|
"marker_id": 206,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.6487167133153804,
|
|
-0.0061839893976751185,
|
|
0.003823440117237419
|
|
],
|
|
"predicted_position_m": [
|
|
0.6522339532958079,
|
|
-0.009170850205069928,
|
|
-0.0011331888720454656
|
|
],
|
|
"error_m": [
|
|
0.0035172399804275223,
|
|
-0.002986860807394809,
|
|
-0.004956628989282884
|
|
],
|
|
"error_norm_m": 0.006772037027369862
|
|
},
|
|
{
|
|
"marker_id": 207,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.748770275714809,
|
|
-0.004058294834022015,
|
|
0.004168827693892214
|
|
],
|
|
"predicted_position_m": [
|
|
0.752215327902452,
|
|
-0.010512150778857032,
|
|
0.0002544870759521034
|
|
],
|
|
"error_m": [
|
|
0.0034450521876430162,
|
|
-0.006453855944835017,
|
|
-0.00391434061794011
|
|
],
|
|
"error_norm_m": 0.008297150330415979
|
|
},
|
|
{
|
|
"marker_id": 208,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.34850778569044394,
|
|
-0.09917615050089638,
|
|
0.0022992868907357297
|
|
],
|
|
"predicted_position_m": [
|
|
0.3511810467682862,
|
|
-0.08509669339829588,
|
|
-0.002686831922688146
|
|
],
|
|
"error_m": [
|
|
0.0026732610778422705,
|
|
0.014079457102600501,
|
|
-0.004986118813423876
|
|
],
|
|
"error_norm_m": 0.01517362243881973
|
|
},
|
|
{
|
|
"marker_id": 210,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.01904761485941944,
|
|
-0.0057694617487496986,
|
|
-0.0073921554862603185
|
|
],
|
|
"predicted_position_m": [
|
|
0.022212695435501365,
|
|
-0.010714374704534568,
|
|
-0.009549374245261396
|
|
],
|
|
"error_m": [
|
|
0.003165080576081926,
|
|
-0.00494491295578487,
|
|
-0.002157218759001077
|
|
],
|
|
"error_norm_m": 0.006254877454240515
|
|
},
|
|
{
|
|
"marker_id": 211,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.2505307789840388,
|
|
-0.010957966408644507,
|
|
0.004931893214629631
|
|
],
|
|
"predicted_position_m": [
|
|
0.25230845486923154,
|
|
-0.0038056479099215024,
|
|
-0.00668389266403574
|
|
],
|
|
"error_m": [
|
|
0.001777675885192731,
|
|
0.007152318498723004,
|
|
-0.01161578587866537
|
|
],
|
|
"error_norm_m": 0.013756535648155493
|
|
},
|
|
{
|
|
"marker_id": 214,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.3484353657821889,
|
|
-0.005256461133634065,
|
|
0.005062659608766313
|
|
],
|
|
"predicted_position_m": [
|
|
0.35228982947587567,
|
|
-0.005146948483708609,
|
|
-0.005296216716038172
|
|
],
|
|
"error_m": [
|
|
0.0038544636936867493,
|
|
0.00010951264992545631,
|
|
-0.010358876324804485
|
|
],
|
|
"error_norm_m": 0.011053289198199687
|
|
},
|
|
{
|
|
"marker_id": 217,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.6541282521258601,
|
|
-0.10529053647438955,
|
|
0.0062384204502635605
|
|
],
|
|
"predicted_position_m": [
|
|
0.6511251705882184,
|
|
-0.0891205951196572,
|
|
0.00147619592130456
|
|
],
|
|
"error_m": [
|
|
-0.0030030815376417275,
|
|
0.016169941354732348,
|
|
-0.0047622245289590005
|
|
],
|
|
"error_norm_m": 0.017122040900588536
|
|
},
|
|
{
|
|
"marker_id": 229,
|
|
"link": "Arm1",
|
|
"observed_position_m": [
|
|
0.17377553373153753,
|
|
-0.17351884273723708,
|
|
0.11099423484091324
|
|
],
|
|
"predicted_position_m": [
|
|
0.17427099182117808,
|
|
-0.13366114019416697,
|
|
0.07772675260032061
|
|
],
|
|
"error_m": [
|
|
0.0004954580896405492,
|
|
0.03985770254307011,
|
|
-0.03326748224059263
|
|
],
|
|
"error_norm_m": 0.0519192382971726
|
|
},
|
|
{
|
|
"marker_id": 243,
|
|
"link": "Arm1",
|
|
"observed_position_m": [
|
|
0.1699969170579842,
|
|
-0.17289154517043823,
|
|
0.0675742788146804
|
|
],
|
|
"predicted_position_m": [
|
|
0.1743113746413175,
|
|
-0.167765025377913,
|
|
0.04185303820382008
|
|
],
|
|
"error_m": [
|
|
0.004314457583333292,
|
|
0.005126519792525236,
|
|
-0.025721240610860313
|
|
],
|
|
"error_norm_m": 0.026579653270562144
|
|
},
|
|
{
|
|
"marker_id": 244,
|
|
"link": "Ellbow",
|
|
"observed_position_m": [
|
|
0.29746949075592166,
|
|
-0.14421998782215795,
|
|
0.06648932499679353
|
|
],
|
|
"predicted_position_m": [
|
|
0.29974511436381984,
|
|
-0.13445591192388778,
|
|
0.044475994564072266
|
|
],
|
|
"error_m": [
|
|
0.0022756236078981806,
|
|
0.009764075898270164,
|
|
-0.02201333043272126
|
|
],
|
|
"error_norm_m": 0.024188889137208756
|
|
},
|
|
{
|
|
"marker_id": 245,
|
|
"link": "Ellbow",
|
|
"observed_position_m": [
|
|
0.2598978828027684,
|
|
-0.17314558926956528,
|
|
0.07156625066610221
|
|
],
|
|
"predicted_position_m": [
|
|
0.26426368468400996,
|
|
-0.16895682238698706,
|
|
0.04534508896989858
|
|
],
|
|
"error_m": [
|
|
0.004365801881241582,
|
|
0.004188766882578215,
|
|
-0.026221161696203636
|
|
],
|
|
"error_norm_m": 0.02691013405320184
|
|
}
|
|
]
|
|
} |