4838 lines
124 KiB
JSON
4838 lines
124 KiB
JSON
{
|
|
"schema_version": "1.0",
|
|
"method": "deterministic_geometric_sequential_prefix",
|
|
"created_utc": "2026-06-01T12:39:08Z",
|
|
"root_pose": {
|
|
"translation_m": [
|
|
0.0019224037975286157,
|
|
0.012171944273737134,
|
|
-0.018053948299541114
|
|
],
|
|
"rotation_matrix": [
|
|
[
|
|
0.9996311795809228,
|
|
0.016393495873428504,
|
|
-0.021650822217672182
|
|
],
|
|
[
|
|
-0.015254209080218337,
|
|
0.998542164908404,
|
|
0.05177696404170404
|
|
],
|
|
[
|
|
0.022468064335637708,
|
|
-0.0514276014712607,
|
|
0.9984239519822843
|
|
]
|
|
],
|
|
"euler_xyz_deg": [
|
|
-2.94862992286624,
|
|
-1.2874335948229583,
|
|
-0.8742564124135219
|
|
]
|
|
},
|
|
"movements": {
|
|
"x": {
|
|
"value_m": 0.07253974336302962,
|
|
"value_mm": 72.53974336302963,
|
|
"joint_type": "linear",
|
|
"link": "Base"
|
|
},
|
|
"y": {
|
|
"value_rad": -0.16779287946966148,
|
|
"value_deg": -9.613823825958923,
|
|
"joint_type": "revolute",
|
|
"link": "Arm1"
|
|
},
|
|
"z": {
|
|
"value_rad": 1.925767292056002,
|
|
"value_deg": 110.3383381591463,
|
|
"joint_type": "revolute",
|
|
"link": "Ellbow"
|
|
},
|
|
"a": {
|
|
"value_rad": -1.1466874518758399,
|
|
"value_deg": -65.70035141309631,
|
|
"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.0019224037975286157,
|
|
0.012171944273737134,
|
|
-0.018053948299541114
|
|
],
|
|
"rotation_matrix": [
|
|
[
|
|
0.9996311795809228,
|
|
0.016393495873428504,
|
|
-0.021650822217672182
|
|
],
|
|
[
|
|
-0.015254209080218337,
|
|
0.998542164908404,
|
|
0.05177696404170404
|
|
],
|
|
[
|
|
0.022468064335637708,
|
|
-0.0514276014712607,
|
|
0.9984239519822843
|
|
]
|
|
]
|
|
},
|
|
"Base": {
|
|
"translation_m": [
|
|
0.07408897986645607,
|
|
0.01189383928652047,
|
|
-0.000449337447054998
|
|
],
|
|
"rotation_matrix": [
|
|
[
|
|
0.9996311795809228,
|
|
0.016393495873428504,
|
|
-0.021650822217672182
|
|
],
|
|
[
|
|
-0.015254209080218337,
|
|
0.998542164908404,
|
|
0.05177696404170404
|
|
],
|
|
[
|
|
0.022468064335637708,
|
|
-0.0514276014712607,
|
|
0.9984239519822843
|
|
]
|
|
]
|
|
},
|
|
"Arm1": {
|
|
"translation_m": [
|
|
0.18484462017489262,
|
|
0.12038839347968078,
|
|
0.04139704651017179
|
|
],
|
|
"rotation_matrix": [
|
|
[
|
|
0.9996311795808948,
|
|
0.012547430927217452,
|
|
-0.024084575702719584
|
|
],
|
|
[
|
|
-0.015254209080217908,
|
|
0.993165507444127,
|
|
-0.11571336970519874
|
|
],
|
|
[
|
|
0.022468064335637077,
|
|
0.11603808340506865,
|
|
0.9929906088602409
|
|
]
|
|
]
|
|
},
|
|
"Ellbow": {
|
|
"translation_m": [
|
|
0.18170776244308826,
|
|
-0.12790298338135098,
|
|
0.012387525658904625
|
|
],
|
|
"rotation_matrix": [
|
|
[
|
|
0.9996311795782006,
|
|
0.018222036397426856,
|
|
0.02013609195407286
|
|
],
|
|
[
|
|
-0.015254209080176795,
|
|
-0.23668832050037894,
|
|
0.9714658759021
|
|
],
|
|
[
|
|
0.02246806433557652,
|
|
-0.9714147396073556,
|
|
-0.2363230622617475
|
|
]
|
|
]
|
|
},
|
|
"Arm2": {
|
|
"translation_m": [
|
|
0.2716745686051263,
|
|
-0.12927586219856688,
|
|
0.014409651449106511
|
|
],
|
|
"rotation_matrix": [
|
|
[
|
|
0.3930048448281811,
|
|
0.01822203639740541,
|
|
0.9193558338989338
|
|
],
|
|
[
|
|
-0.8916768751436214,
|
|
-0.23668832050010036,
|
|
0.3858639517620616
|
|
],
|
|
[
|
|
0.22463201524180532,
|
|
-0.9714147396062123,
|
|
-0.0767714881975667
|
|
]
|
|
]
|
|
},
|
|
"Hand": {
|
|
"translation_m": [
|
|
0.2671190595057749,
|
|
-0.07010378207354179,
|
|
0.25726333635065957
|
|
],
|
|
"rotation_matrix": [
|
|
[
|
|
0.3930048448281811,
|
|
0.01822203639740541,
|
|
0.9193558338989338
|
|
],
|
|
[
|
|
-0.8916768751436214,
|
|
-0.23668832050010036,
|
|
0.3858639517620616
|
|
],
|
|
[
|
|
0.22463201524180532,
|
|
-0.9714147396062123,
|
|
-0.0767714881975667
|
|
]
|
|
]
|
|
},
|
|
"Palm": {
|
|
"translation_m": [
|
|
0.2671190595057749,
|
|
-0.07010378207354179,
|
|
0.25726333635065957
|
|
],
|
|
"rotation_matrix": [
|
|
[
|
|
0.3930048448281811,
|
|
0.01822203639740541,
|
|
0.9193558338989338
|
|
],
|
|
[
|
|
-0.8916768751436214,
|
|
-0.23668832050010036,
|
|
0.3858639517620616
|
|
],
|
|
[
|
|
0.22463201524180532,
|
|
-0.9714147396062123,
|
|
-0.0767714881975667
|
|
]
|
|
]
|
|
},
|
|
"FingerA": {
|
|
"translation_m": [
|
|
0.26805330761117846,
|
|
-0.06538639835661277,
|
|
0.2921613802978442
|
|
],
|
|
"rotation_matrix": [
|
|
[
|
|
0.3930048448281811,
|
|
0.01822203639740541,
|
|
0.9193558338989338
|
|
],
|
|
[
|
|
-0.8916768751436214,
|
|
-0.23668832050010036,
|
|
0.3858639517620616
|
|
],
|
|
[
|
|
0.22463201524180532,
|
|
-0.9714147396062123,
|
|
-0.0767714881975667
|
|
]
|
|
]
|
|
},
|
|
"FingerB": {
|
|
"translation_m": [
|
|
0.264909268852553,
|
|
-0.05825298335546379,
|
|
0.2903643241759098
|
|
],
|
|
"rotation_matrix": [
|
|
[
|
|
0.3930048448281811,
|
|
0.01822203639740541,
|
|
0.9193558338989338
|
|
],
|
|
[
|
|
-0.8916768751436214,
|
|
-0.23668832050010036,
|
|
0.3858639517620616
|
|
],
|
|
[
|
|
0.22463201524180532,
|
|
-0.9714147396062123,
|
|
-0.0767714881975667
|
|
]
|
|
]
|
|
}
|
|
},
|
|
"stage_reports": [
|
|
{
|
|
"method": "deterministic_geometric_prefix",
|
|
"active_links": [
|
|
"Board",
|
|
"Base",
|
|
"Arm1"
|
|
],
|
|
"active_observations": 40,
|
|
"joint_updates": [
|
|
{
|
|
"pass": 0,
|
|
"updates": [
|
|
{
|
|
"link": "Base",
|
|
"joint_variable": "x",
|
|
"joint_type": "linear",
|
|
"old": 0.0,
|
|
"new": 0.07938666692103401,
|
|
"info": {
|
|
"reason": "weighted_projection",
|
|
"used_markers": 1,
|
|
"axis_world": [
|
|
0.9996311795799229,
|
|
-0.015254209080203078,
|
|
0.022468064335615233
|
|
],
|
|
"per_marker": [
|
|
{
|
|
"marker_id": 243,
|
|
"q_i": 0.07938666692103401,
|
|
"weight": 1.0
|
|
}
|
|
]
|
|
}
|
|
},
|
|
{
|
|
"link": "Arm1",
|
|
"joint_variable": "y",
|
|
"joint_type": "revolute",
|
|
"old": 0.0,
|
|
"new": -0.7368976031326713,
|
|
"info": {
|
|
"reason": "2d_alignment+normal_tiebreak",
|
|
"used_markers": 1,
|
|
"axis_world": [
|
|
-0.9996311795799229,
|
|
0.015254209080203078,
|
|
-0.022468064335615233
|
|
],
|
|
"axis_id": 0,
|
|
"theta_rad": -0.7368976031326713,
|
|
"theta_alt_rad": 2.4046950504571214,
|
|
"score_theta": 0.20723346686265914,
|
|
"score_theta_alt": 0.24964332925065008,
|
|
"best_score": 0.20723346686265914,
|
|
"per_marker": [
|
|
{
|
|
"marker_id": 243,
|
|
"weight": 1.0
|
|
}
|
|
]
|
|
}
|
|
}
|
|
]
|
|
},
|
|
{
|
|
"pass": 1,
|
|
"updates": [
|
|
{
|
|
"link": "Base",
|
|
"joint_variable": "x",
|
|
"joint_type": "linear",
|
|
"old": 0.07938666692103401,
|
|
"new": 0.07938666692103402,
|
|
"info": {
|
|
"reason": "weighted_projection",
|
|
"used_markers": 1,
|
|
"axis_world": [
|
|
0.9996311795799229,
|
|
-0.015254209080203078,
|
|
0.022468064335615233
|
|
],
|
|
"per_marker": [
|
|
{
|
|
"marker_id": 243,
|
|
"q_i": 0.07938666692103402,
|
|
"weight": 1.0
|
|
}
|
|
]
|
|
}
|
|
},
|
|
{
|
|
"link": "Arm1",
|
|
"joint_variable": "y",
|
|
"joint_type": "revolute",
|
|
"old": -0.7368976031326713,
|
|
"new": -0.7368976031326713,
|
|
"info": {
|
|
"reason": "2d_alignment+normal_tiebreak",
|
|
"used_markers": 1,
|
|
"axis_world": [
|
|
-0.9996311795799229,
|
|
0.015254209080203078,
|
|
-0.022468064335615233
|
|
],
|
|
"axis_id": 0,
|
|
"theta_rad": -0.7368976031326713,
|
|
"theta_alt_rad": 2.4046950504571214,
|
|
"score_theta": 0.20723346686265914,
|
|
"score_theta_alt": 0.24964332925065008,
|
|
"best_score": 0.20723346686265914,
|
|
"per_marker": [
|
|
{
|
|
"marker_id": 243,
|
|
"weight": 1.0
|
|
}
|
|
]
|
|
}
|
|
}
|
|
]
|
|
}
|
|
],
|
|
"root_link": "Board",
|
|
"root_pose": {
|
|
"reason": "kabsch",
|
|
"used_markers": [
|
|
210,
|
|
211,
|
|
215,
|
|
214,
|
|
208,
|
|
206,
|
|
205,
|
|
207,
|
|
217,
|
|
46,
|
|
47,
|
|
51,
|
|
53,
|
|
55,
|
|
56,
|
|
58,
|
|
61,
|
|
62,
|
|
63,
|
|
64,
|
|
66,
|
|
68,
|
|
69,
|
|
72,
|
|
73,
|
|
75,
|
|
79,
|
|
82,
|
|
83,
|
|
84,
|
|
85,
|
|
86,
|
|
92,
|
|
95,
|
|
96,
|
|
97,
|
|
102,
|
|
103,
|
|
105
|
|
]
|
|
},
|
|
"marker_stats": {
|
|
"num_markers_used": 40,
|
|
"mean_error_m": 0.032743534983656494,
|
|
"rms_error_m": 0.08102124202436241,
|
|
"median_error_m": 0.015747403822132994,
|
|
"worst_error_m": 0.4552290268234871
|
|
},
|
|
"marker_reports": [
|
|
{
|
|
"marker_id": 46,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.007895331762659885,
|
|
-0.0006314475403442765,
|
|
-0.018285418768428742
|
|
],
|
|
"error_norm_m": 0.019927155571618317,
|
|
"predicted_m": [
|
|
0.5420655315117168,
|
|
0.18774100566056906,
|
|
-0.04278882179590794
|
|
],
|
|
"observed_m": [
|
|
0.5341701997490569,
|
|
0.18837245320091334,
|
|
-0.0245034030274792
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 47,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.00216719129998999,
|
|
0.008630400445827136,
|
|
0.006567463574039992
|
|
],
|
|
"error_norm_m": 0.011059480448123576,
|
|
"predicted_m": [
|
|
0.34191911988364,
|
|
-0.28061479516913906,
|
|
-0.02284067547682586
|
|
],
|
|
"observed_m": [
|
|
0.34408631118363,
|
|
-0.2892451956149662,
|
|
-0.029408139050865853
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 51,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.0019825139298365047,
|
|
0.010321285886508186,
|
|
-0.0032476596525796604
|
|
],
|
|
"error_norm_m": 0.011000299861913887,
|
|
"predicted_m": [
|
|
0.16743059040785033,
|
|
-0.16363035886570018,
|
|
-0.03269111933196293
|
|
],
|
|
"observed_m": [
|
|
0.16544807647801382,
|
|
-0.17395164475220837,
|
|
-0.029443459679383267
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 53,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.010190425417623772,
|
|
-0.004685057942000026,
|
|
-0.013386768405419927
|
|
],
|
|
"error_norm_m": 0.01746425224429604,
|
|
"predicted_m": [
|
|
0.4920634878794713,
|
|
0.2152716630703021,
|
|
-0.04530082004171401
|
|
],
|
|
"observed_m": [
|
|
0.4818730624618475,
|
|
0.21995672101230213,
|
|
-0.031914051636294086
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 55,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.000648024175633255,
|
|
0.005926273650224356,
|
|
0.0030121560446546916
|
|
],
|
|
"error_norm_m": 0.0066793516711503124,
|
|
"predicted_m": [
|
|
0.2818242253683257,
|
|
-0.2557666927064896,
|
|
-0.025432423381026713
|
|
],
|
|
"observed_m": [
|
|
0.28247224954395894,
|
|
-0.26169296635671396,
|
|
-0.028444579425681404
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 56,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.02817326017385502,
|
|
-0.024584323572284905,
|
|
0.04561768174620743
|
|
],
|
|
"error_norm_m": 0.05898384899469341,
|
|
"predicted_m": [
|
|
0.5037746388264569,
|
|
0.17157557112637584,
|
|
-0.04278084140591921
|
|
],
|
|
"observed_m": [
|
|
0.5319478990003119,
|
|
0.19615989469866074,
|
|
-0.08839852315212664
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 58,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.0036283215191368137,
|
|
0.011792552986691573,
|
|
-0.007131376636709666
|
|
],
|
|
"error_norm_m": 0.014250808949837483,
|
|
"predicted_m": [
|
|
0.049009411644326,
|
|
-0.20779768176560154,
|
|
-0.03296862268918871
|
|
],
|
|
"observed_m": [
|
|
0.05263773316346281,
|
|
-0.2195902347522931,
|
|
-0.025837246052479043
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 61,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.0039243565853280555,
|
|
-0.019787233763559453,
|
|
0.0009600037431695824
|
|
],
|
|
"error_norm_m": 0.020195464882231715,
|
|
"predicted_m": [
|
|
-0.01439283208295973,
|
|
0.34644084776416645,
|
|
-0.06308558759315597
|
|
],
|
|
"observed_m": [
|
|
-0.010468475497631675,
|
|
0.3662280815277259,
|
|
-0.06404559133632555
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 62,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.001397680135084567,
|
|
0.009276782057794891,
|
|
0.0008861811743844303
|
|
],
|
|
"error_norm_m": 0.009423243188078538,
|
|
"predicted_m": [
|
|
0.40419370849303327,
|
|
-0.17025967833482727,
|
|
-0.02721312353440715
|
|
],
|
|
"observed_m": [
|
|
0.40559138862811783,
|
|
-0.17953646039262217,
|
|
-0.02809930470879158
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 63,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.016894642595327913,
|
|
0.007560854561507152,
|
|
0.025439453433518014
|
|
],
|
|
"error_norm_m": 0.03146047140651683,
|
|
"predicted_m": [
|
|
0.7757554261997703,
|
|
-0.23690592122668272,
|
|
-0.015699620886694507
|
|
],
|
|
"observed_m": [
|
|
0.7926500687950983,
|
|
-0.24446677578818987,
|
|
-0.04113907432021252
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 64,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.004552252702011261,
|
|
0.013858071762736263,
|
|
-0.010677996191135613
|
|
],
|
|
"error_norm_m": 0.01807729958544759,
|
|
"predicted_m": [
|
|
-0.021834431673870613,
|
|
-0.176872701518174,
|
|
-0.03610860049214109
|
|
],
|
|
"observed_m": [
|
|
-0.017282178971859352,
|
|
-0.19073077328091026,
|
|
-0.025430604301005477
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 66,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.006401515405434849,
|
|
0.0017781585298348723,
|
|
0.004280175892847616
|
|
],
|
|
"error_norm_m": 0.007903236863270524,
|
|
"predicted_m": [
|
|
0.20623150165506418,
|
|
-0.35514160775885684,
|
|
-0.02191819801185144
|
|
],
|
|
"observed_m": [
|
|
0.21263301706049903,
|
|
-0.3569197662886917,
|
|
-0.026198373904699056
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 68,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.009920935536029796,
|
|
0.0036147367659919716,
|
|
-0.026317210500698983
|
|
],
|
|
"error_norm_m": 0.028356425239010184,
|
|
"predicted_m": [
|
|
0.5788292540408758,
|
|
0.17239787079977498,
|
|
-0.04119592555242797
|
|
],
|
|
"observed_m": [
|
|
0.568908318504846,
|
|
0.168783134033783,
|
|
-0.014878715051728992
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 69,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.009765747793697124,
|
|
0.010144855342052395,
|
|
-0.008205682086978694
|
|
],
|
|
"error_norm_m": 0.016297887543906795,
|
|
"predicted_m": [
|
|
0.005510649546115061,
|
|
-0.2701576935695941,
|
|
-0.03067798440933005
|
|
],
|
|
"observed_m": [
|
|
0.015276397339812184,
|
|
-0.2803025489116465,
|
|
-0.022472302322351357
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 72,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.01206183061354199,
|
|
-0.0026924053683481386,
|
|
-0.012113612864273517
|
|
],
|
|
"error_norm_m": 0.01730538705267182,
|
|
"predicted_m": [
|
|
0.4465264092455869,
|
|
0.1980681929781142,
|
|
-0.04539614201517998
|
|
],
|
|
"observed_m": [
|
|
0.4344645786320449,
|
|
0.20076059834646234,
|
|
-0.033282529150906466
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 73,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.0015939358789230362,
|
|
0.01307317060974833,
|
|
-0.03553258191354361
|
|
],
|
|
"error_norm_m": 0.037894759516592685,
|
|
"predicted_m": [
|
|
0.22962253010294684,
|
|
0.3400004979286803,
|
|
-0.05746012660960818
|
|
],
|
|
"observed_m": [
|
|
0.2280285942240238,
|
|
0.326927327318932,
|
|
-0.021927544696064564
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 75,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.0010134425856457747,
|
|
-0.015618359499804751,
|
|
0.005265080475666747
|
|
],
|
|
"error_norm_m": 0.016513064275136487,
|
|
"predicted_m": [
|
|
-0.019987203644106936,
|
|
0.20544680077663746,
|
|
-0.05589513413636127
|
|
],
|
|
"observed_m": [
|
|
-0.01897376105846116,
|
|
0.2210651602764422,
|
|
-0.061160214612028016
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 79,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.00047735424737849197,
|
|
0.006572400528108202,
|
|
-0.000397956849068775
|
|
],
|
|
"error_norm_m": 0.006601718369719206,
|
|
"predicted_m": [
|
|
0.3120899194987721,
|
|
-0.15288350019892974,
|
|
-0.03011150002654553
|
|
],
|
|
"observed_m": [
|
|
0.3116125652513936,
|
|
-0.15945590072703794,
|
|
-0.029713543177476754
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 82,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.007144984498683116,
|
|
-0.1226123391767675,
|
|
0.1569432012310248
|
|
],
|
|
"error_norm_m": 0.19928874763650617,
|
|
"predicted_m": [
|
|
0.22646544327444398,
|
|
0.304221993790752,
|
|
-0.055673161470176646
|
|
],
|
|
"observed_m": [
|
|
0.21932045877576087,
|
|
0.4268343329675195,
|
|
-0.21261636270120143
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 83,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.0042926929946417725,
|
|
-0.013398273717934894,
|
|
-0.005745035140862921
|
|
],
|
|
"error_norm_m": 0.015196920100359194,
|
|
"predicted_m": [
|
|
0.05221818580454903,
|
|
0.348810280462645,
|
|
-0.06176400343867677
|
|
],
|
|
"observed_m": [
|
|
0.056510878799190804,
|
|
0.3622085541805799,
|
|
-0.05601896829781385
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 84,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.017540563212802673,
|
|
-0.010434471361215614,
|
|
-0.013233216494029719
|
|
],
|
|
"error_norm_m": 0.02432421775079757,
|
|
"predicted_m": [
|
|
0.41408958781511274,
|
|
0.26258576175293025,
|
|
-0.04944533142473166
|
|
],
|
|
"observed_m": [
|
|
0.39654902460231006,
|
|
0.27302023311414586,
|
|
-0.03621211493070194
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 85,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.00026024434744487124,
|
|
0.000995853133054947,
|
|
0.012418126233019036
|
|
],
|
|
"error_norm_m": 0.012460710642743773,
|
|
"predicted_m": [
|
|
0.5017803060025984,
|
|
-0.3092325977374013,
|
|
-0.017890003926044614
|
|
],
|
|
"observed_m": [
|
|
0.5020405503500432,
|
|
-0.31022845087045625,
|
|
-0.03030813015906365
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 86,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.005119978759483168,
|
|
0.0051937441900155035,
|
|
-0.024585506760890694
|
|
],
|
|
"error_norm_m": 0.025644420521795393,
|
|
"predicted_m": [
|
|
0.370056694732192,
|
|
0.29680713079718124,
|
|
-0.05217486022752074
|
|
],
|
|
"observed_m": [
|
|
0.3649367159727088,
|
|
0.29161338660716574,
|
|
-0.027589353466630048
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 92,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.0040650859796993455,
|
|
0.00716592616144629,
|
|
0.005916398562679989
|
|
],
|
|
"error_norm_m": 0.010142938120984983,
|
|
"predicted_m": [
|
|
0.6443353751026841,
|
|
-0.18365243834182884,
|
|
-0.021311120710433118
|
|
],
|
|
"observed_m": [
|
|
0.6484004610823835,
|
|
-0.19081836450327513,
|
|
-0.027227519273113107
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 95,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.002655917912978728,
|
|
0.006827652227407333,
|
|
-0.00022795801062122645
|
|
],
|
|
"error_norm_m": 0.007329577051474933,
|
|
"predicted_m": [
|
|
0.1839918904792754,
|
|
-0.2657499110383315,
|
|
-0.027036200764427018
|
|
],
|
|
"observed_m": [
|
|
0.18664780839225412,
|
|
-0.27257756326573884,
|
|
-0.02680824275380579
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 96,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.0003330489368492118,
|
|
0.006534855641922105,
|
|
0.0016518584152897288
|
|
],
|
|
"error_norm_m": 0.0067486217910963904,
|
|
"predicted_m": [
|
|
0.3690898694722732,
|
|
-0.181100244069962,
|
|
-0.027412172640893313
|
|
],
|
|
"observed_m": [
|
|
0.3694229184091224,
|
|
-0.1876350997118841,
|
|
-0.02906403105618304
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 97,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.0002234266098899429,
|
|
-0.001703688491849431,
|
|
0.008865359330947977
|
|
],
|
|
"error_norm_m": 0.009030341632191633,
|
|
"predicted_m": [
|
|
0.30085497208872897,
|
|
-0.35302984583077157,
|
|
-0.019975801386937803
|
|
],
|
|
"observed_m": [
|
|
0.300631545478839,
|
|
-0.35132615733892214,
|
|
-0.02884116071788578
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 102,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.006605472273244595,
|
|
0.005727217418135866,
|
|
0.015832561515091527
|
|
],
|
|
"error_norm_m": 0.01808599699868269,
|
|
"predicted_m": [
|
|
0.6483081027262264,
|
|
-0.22182697671650253,
|
|
-0.019245290342345872
|
|
],
|
|
"observed_m": [
|
|
0.654913574999471,
|
|
-0.2275541941346384,
|
|
-0.0350778518574374
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 103,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.0004628579451216863,
|
|
0.011151957883560049,
|
|
-0.005196230324720625
|
|
],
|
|
"error_norm_m": 0.012311832182969584,
|
|
"predicted_m": [
|
|
0.10510726012716916,
|
|
-0.17829043906142777,
|
|
-0.033282348035566865
|
|
],
|
|
"observed_m": [
|
|
0.10557011807229084,
|
|
-0.18944239694498782,
|
|
-0.02808611771084624
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 105,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.0007442236148308412,
|
|
0.003659016775769186,
|
|
0.009758098129132975
|
|
],
|
|
"error_norm_m": 0.010448097992075911,
|
|
"predicted_m": [
|
|
0.5227951312590223,
|
|
-0.2631094373451257,
|
|
-0.019826184411018216
|
|
],
|
|
"observed_m": [
|
|
0.5235393548738532,
|
|
-0.2667684541208949,
|
|
-0.02958428254015119
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 205,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.014332872658958107,
|
|
0.019444247927015365,
|
|
-0.032248762424642204
|
|
],
|
|
"error_norm_m": 0.04029258857440367,
|
|
"predicted_m": [
|
|
0.7501638786079469,
|
|
-0.08912197428897047,
|
|
0.0037251112701953155
|
|
],
|
|
"observed_m": [
|
|
0.7358310059489888,
|
|
-0.10856622221598583,
|
|
0.03597387369483752
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 206,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.0030432648939281437,
|
|
-0.0007510465654346253,
|
|
-0.006402658259601998
|
|
],
|
|
"error_norm_m": 0.007128784254507659,
|
|
"predicted_m": [
|
|
0.651512240319729,
|
|
-0.007713180188276315,
|
|
-0.002635903281069312
|
|
],
|
|
"observed_m": [
|
|
0.6484689754258008,
|
|
-0.006962133622841689,
|
|
0.0037667549785326865
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 207,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.002108795921038853,
|
|
-0.005278021166740238,
|
|
-0.003292708202213847
|
|
],
|
|
"error_norm_m": 0.006568596119268898,
|
|
"predicted_m": [
|
|
0.7514753582778212,
|
|
-0.009238601096298147,
|
|
-0.00038909684750553994
|
|
],
|
|
"observed_m": [
|
|
0.7493665623567823,
|
|
-0.0039605799295579095,
|
|
0.002903611354708307
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 208,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.0005659718848211592,
|
|
0.005974973451685045,
|
|
-0.010586207674555946
|
|
],
|
|
"error_norm_m": 0.012169158756938638,
|
|
"predicted_m": [
|
|
0.35031140677557776,
|
|
-0.08302029065688313,
|
|
-0.005262114464059768
|
|
],
|
|
"observed_m": [
|
|
0.3497454348907566,
|
|
-0.08899526410856817,
|
|
0.005324093210496179
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 210,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.0035239332237271027,
|
|
0.008874902306851047,
|
|
-0.019692754042329164
|
|
],
|
|
"error_norm_m": 0.0218857615378837,
|
|
"predicted_m": [
|
|
0.0215806622250132,
|
|
-0.0080884501168228,
|
|
-0.01627650779780846
|
|
],
|
|
"observed_m": [
|
|
0.018056729001286097,
|
|
-0.016963352423673847,
|
|
0.003416246244520705
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 211,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.0018608685919185297,
|
|
0.007536852132166777,
|
|
-0.016705736727285002
|
|
],
|
|
"error_norm_m": 0.018421417197921956,
|
|
"predicted_m": [
|
|
0.25165976848735977,
|
|
-0.0016114965561889781,
|
|
-0.011623129015324394
|
|
],
|
|
"observed_m": [
|
|
0.24979889989544124,
|
|
-0.009148348688355755,
|
|
0.005082607711960607
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 214,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.0015684750862626218,
|
|
0.00574582775206614,
|
|
-0.013908941678217828
|
|
],
|
|
"error_norm_m": 0.01513054226591714,
|
|
"predicted_m": [
|
|
0.35162288644545203,
|
|
-0.0031369174642108125,
|
|
-0.009376322581760623
|
|
],
|
|
"observed_m": [
|
|
0.3500544113591894,
|
|
-0.008882745216276952,
|
|
0.004532619096457205
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 215,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.000845131230164442,
|
|
0.007216838764547803,
|
|
-0.011914373933465288
|
|
],
|
|
"error_norm_m": 0.013955261186237836,
|
|
"predicted_m": [
|
|
0.25034828881748544,
|
|
-0.0814948697488613,
|
|
-0.007508920897623539
|
|
],
|
|
"observed_m": [
|
|
0.249503157587321,
|
|
-0.08871170851340911,
|
|
0.004405453035841749
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 217,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.004014614981723508,
|
|
0.017577259273614684,
|
|
-0.004377445959401687
|
|
],
|
|
"error_norm_m": 0.01855368454379977,
|
|
"predicted_m": [
|
|
0.6502007606498547,
|
|
-0.08759655338094864,
|
|
0.0014783048366315433
|
|
],
|
|
"observed_m": [
|
|
0.6542153756315782,
|
|
-0.10517381265456333,
|
|
0.0058557507960332305
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 243,
|
|
"link": "Arm1",
|
|
"error_m": [
|
|
0.010926669040788761,
|
|
0.04973858521635084,
|
|
-0.4523716922034446
|
|
],
|
|
"error_norm_m": 0.4552290268234871,
|
|
"predicted_m": [
|
|
0.19237555447674304,
|
|
-0.10038331195515142,
|
|
-0.13881122042026806
|
|
],
|
|
"observed_m": [
|
|
0.18144888543595428,
|
|
-0.15012189717150226,
|
|
0.31356047178317653
|
|
]
|
|
}
|
|
],
|
|
"stage_idx": 0,
|
|
"num_active_links": 3
|
|
},
|
|
{
|
|
"method": "deterministic_geometric_prefix",
|
|
"active_links": [
|
|
"Board",
|
|
"Base",
|
|
"Arm1",
|
|
"Ellbow"
|
|
],
|
|
"active_observations": 42,
|
|
"joint_updates": [
|
|
{
|
|
"pass": 0,
|
|
"updates": [
|
|
{
|
|
"link": "Base",
|
|
"joint_variable": "x",
|
|
"joint_type": "linear",
|
|
"old": 0.07938666692103402,
|
|
"new": 0.07215835667657483,
|
|
"info": {
|
|
"reason": "weighted_projection",
|
|
"used_markers": 3,
|
|
"axis_world": [
|
|
0.9996311795799229,
|
|
-0.015254209080203078,
|
|
0.022468064335615233
|
|
],
|
|
"per_marker": [
|
|
{
|
|
"marker_id": 243,
|
|
"q_i": 0.07938666692103402,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 246,
|
|
"q_i": 0.05602961483089345,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 247,
|
|
"q_i": 0.08105878827779704,
|
|
"weight": 1.0
|
|
}
|
|
]
|
|
}
|
|
},
|
|
{
|
|
"link": "Arm1",
|
|
"joint_variable": "y",
|
|
"joint_type": "revolute",
|
|
"old": -0.7368976031326713,
|
|
"new": -0.6419108701295015,
|
|
"info": {
|
|
"reason": "2d_alignment+normal_tiebreak",
|
|
"used_markers": 3,
|
|
"axis_world": [
|
|
-0.9996311795799229,
|
|
0.015254209080203078,
|
|
-0.022468064335615233
|
|
],
|
|
"axis_id": 0,
|
|
"theta_rad": -0.6419108701295015,
|
|
"theta_alt_rad": 2.499681783460291,
|
|
"score_theta": 0.5112455268615865,
|
|
"score_theta_alt": 0.8669823358189679,
|
|
"best_score": 0.5112455268615865,
|
|
"per_marker": [
|
|
{
|
|
"marker_id": 243,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 246,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 247,
|
|
"weight": 1.0
|
|
}
|
|
]
|
|
}
|
|
},
|
|
{
|
|
"link": "Ellbow",
|
|
"joint_variable": "z",
|
|
"joint_type": "revolute",
|
|
"old": 0.0,
|
|
"new": -0.40236514567185955,
|
|
"info": {
|
|
"reason": "2d_alignment+normal_tiebreak",
|
|
"used_markers": 2,
|
|
"axis_world": [
|
|
-0.999631179579923,
|
|
0.01525420908020308,
|
|
-0.022468064335615236
|
|
],
|
|
"axis_id": 0,
|
|
"theta_rad": -0.4023651456718594,
|
|
"theta_alt_rad": 2.739227507917933,
|
|
"score_theta": 0.3836561731885004,
|
|
"score_theta_alt": 0.5770814115071045,
|
|
"best_score": 0.3836561731885004,
|
|
"per_marker": [
|
|
{
|
|
"marker_id": 246,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 247,
|
|
"weight": 1.0
|
|
}
|
|
]
|
|
}
|
|
}
|
|
]
|
|
},
|
|
{
|
|
"pass": 1,
|
|
"updates": [
|
|
{
|
|
"link": "Base",
|
|
"joint_variable": "x",
|
|
"joint_type": "linear",
|
|
"old": 0.07215835667657483,
|
|
"new": 0.0721583566765767,
|
|
"info": {
|
|
"reason": "weighted_projection",
|
|
"used_markers": 3,
|
|
"axis_world": [
|
|
0.9996311795799229,
|
|
-0.015254209080203078,
|
|
0.022468064335615233
|
|
],
|
|
"per_marker": [
|
|
{
|
|
"marker_id": 243,
|
|
"q_i": 0.07938666692103402,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 246,
|
|
"q_i": 0.05602961483089698,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 247,
|
|
"q_i": 0.08105878827779911,
|
|
"weight": 1.0
|
|
}
|
|
]
|
|
}
|
|
},
|
|
{
|
|
"link": "Arm1",
|
|
"joint_variable": "y",
|
|
"joint_type": "revolute",
|
|
"old": -0.6419108701295015,
|
|
"new": -0.6519211760926327,
|
|
"info": {
|
|
"reason": "2d_alignment+normal_tiebreak",
|
|
"used_markers": 3,
|
|
"axis_world": [
|
|
-0.9996311795799229,
|
|
0.015254209080203078,
|
|
-0.022468064335615233
|
|
],
|
|
"axis_id": 0,
|
|
"theta_rad": -0.6519211760926328,
|
|
"theta_alt_rad": 2.4896714774971604,
|
|
"score_theta": 0.5312800483233868,
|
|
"score_theta_alt": 0.8743595129731793,
|
|
"best_score": 0.5312800483233868,
|
|
"per_marker": [
|
|
{
|
|
"marker_id": 243,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 246,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 247,
|
|
"weight": 1.0
|
|
}
|
|
]
|
|
}
|
|
},
|
|
{
|
|
"link": "Ellbow",
|
|
"joint_variable": "z",
|
|
"joint_type": "revolute",
|
|
"old": -0.40236514567185955,
|
|
"new": -0.4101046699037387,
|
|
"info": {
|
|
"reason": "2d_alignment+normal_tiebreak",
|
|
"used_markers": 2,
|
|
"axis_world": [
|
|
-0.999631179579923,
|
|
0.01525420908020308,
|
|
-0.022468064335615233
|
|
],
|
|
"axis_id": 0,
|
|
"theta_rad": -0.4101046699037389,
|
|
"theta_alt_rad": 2.731487983686055,
|
|
"score_theta": 0.3896114322584153,
|
|
"score_theta_alt": 0.5791222762119865,
|
|
"best_score": 0.3896114322584153,
|
|
"per_marker": [
|
|
{
|
|
"marker_id": 246,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 247,
|
|
"weight": 1.0
|
|
}
|
|
]
|
|
}
|
|
}
|
|
]
|
|
}
|
|
],
|
|
"root_link": "Board",
|
|
"root_pose": {
|
|
"reason": "kabsch",
|
|
"used_markers": [
|
|
210,
|
|
211,
|
|
215,
|
|
214,
|
|
208,
|
|
206,
|
|
205,
|
|
207,
|
|
217,
|
|
46,
|
|
47,
|
|
51,
|
|
53,
|
|
55,
|
|
56,
|
|
58,
|
|
61,
|
|
62,
|
|
63,
|
|
64,
|
|
66,
|
|
68,
|
|
69,
|
|
72,
|
|
73,
|
|
75,
|
|
79,
|
|
82,
|
|
83,
|
|
84,
|
|
85,
|
|
86,
|
|
92,
|
|
95,
|
|
96,
|
|
97,
|
|
102,
|
|
103,
|
|
105
|
|
]
|
|
},
|
|
"marker_stats": {
|
|
"num_markers_used": 42,
|
|
"mean_error_m": 0.05039363756277761,
|
|
"rms_error_m": 0.11821775252473529,
|
|
"median_error_m": 0.01640547590952164,
|
|
"worst_error_m": 0.4346121389883154
|
|
},
|
|
"marker_reports": [
|
|
{
|
|
"marker_id": 46,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.007895331762659885,
|
|
-0.0006314475403442765,
|
|
-0.018285418768428742
|
|
],
|
|
"error_norm_m": 0.019927155571618317,
|
|
"predicted_m": [
|
|
0.5420655315117168,
|
|
0.18774100566056906,
|
|
-0.04278882179590794
|
|
],
|
|
"observed_m": [
|
|
0.5341701997490569,
|
|
0.18837245320091334,
|
|
-0.0245034030274792
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 47,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.00216719129998999,
|
|
0.008630400445827136,
|
|
0.006567463574039992
|
|
],
|
|
"error_norm_m": 0.011059480448123576,
|
|
"predicted_m": [
|
|
0.34191911988364,
|
|
-0.28061479516913906,
|
|
-0.02284067547682586
|
|
],
|
|
"observed_m": [
|
|
0.34408631118363,
|
|
-0.2892451956149662,
|
|
-0.029408139050865853
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 51,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.0019825139298365047,
|
|
0.010321285886508186,
|
|
-0.0032476596525796604
|
|
],
|
|
"error_norm_m": 0.011000299861913887,
|
|
"predicted_m": [
|
|
0.16743059040785033,
|
|
-0.16363035886570018,
|
|
-0.03269111933196293
|
|
],
|
|
"observed_m": [
|
|
0.16544807647801382,
|
|
-0.17395164475220837,
|
|
-0.029443459679383267
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 53,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.010190425417623772,
|
|
-0.004685057942000026,
|
|
-0.013386768405419927
|
|
],
|
|
"error_norm_m": 0.01746425224429604,
|
|
"predicted_m": [
|
|
0.4920634878794713,
|
|
0.2152716630703021,
|
|
-0.04530082004171401
|
|
],
|
|
"observed_m": [
|
|
0.4818730624618475,
|
|
0.21995672101230213,
|
|
-0.031914051636294086
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 55,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.000648024175633255,
|
|
0.005926273650224356,
|
|
0.0030121560446546916
|
|
],
|
|
"error_norm_m": 0.0066793516711503124,
|
|
"predicted_m": [
|
|
0.2818242253683257,
|
|
-0.2557666927064896,
|
|
-0.025432423381026713
|
|
],
|
|
"observed_m": [
|
|
0.28247224954395894,
|
|
-0.26169296635671396,
|
|
-0.028444579425681404
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 56,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.02817326017385502,
|
|
-0.024584323572284905,
|
|
0.04561768174620743
|
|
],
|
|
"error_norm_m": 0.05898384899469341,
|
|
"predicted_m": [
|
|
0.5037746388264569,
|
|
0.17157557112637584,
|
|
-0.04278084140591921
|
|
],
|
|
"observed_m": [
|
|
0.5319478990003119,
|
|
0.19615989469866074,
|
|
-0.08839852315212664
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 58,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.0036283215191368137,
|
|
0.011792552986691573,
|
|
-0.007131376636709666
|
|
],
|
|
"error_norm_m": 0.014250808949837483,
|
|
"predicted_m": [
|
|
0.049009411644326,
|
|
-0.20779768176560154,
|
|
-0.03296862268918871
|
|
],
|
|
"observed_m": [
|
|
0.05263773316346281,
|
|
-0.2195902347522931,
|
|
-0.025837246052479043
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 61,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.0039243565853280555,
|
|
-0.019787233763559453,
|
|
0.0009600037431695824
|
|
],
|
|
"error_norm_m": 0.020195464882231715,
|
|
"predicted_m": [
|
|
-0.01439283208295973,
|
|
0.34644084776416645,
|
|
-0.06308558759315597
|
|
],
|
|
"observed_m": [
|
|
-0.010468475497631675,
|
|
0.3662280815277259,
|
|
-0.06404559133632555
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 62,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.001397680135084567,
|
|
0.009276782057794891,
|
|
0.0008861811743844303
|
|
],
|
|
"error_norm_m": 0.009423243188078538,
|
|
"predicted_m": [
|
|
0.40419370849303327,
|
|
-0.17025967833482727,
|
|
-0.02721312353440715
|
|
],
|
|
"observed_m": [
|
|
0.40559138862811783,
|
|
-0.17953646039262217,
|
|
-0.02809930470879158
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 63,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.016894642595327913,
|
|
0.007560854561507152,
|
|
0.025439453433518014
|
|
],
|
|
"error_norm_m": 0.03146047140651683,
|
|
"predicted_m": [
|
|
0.7757554261997703,
|
|
-0.23690592122668272,
|
|
-0.015699620886694507
|
|
],
|
|
"observed_m": [
|
|
0.7926500687950983,
|
|
-0.24446677578818987,
|
|
-0.04113907432021252
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 64,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.004552252702011261,
|
|
0.013858071762736263,
|
|
-0.010677996191135613
|
|
],
|
|
"error_norm_m": 0.01807729958544759,
|
|
"predicted_m": [
|
|
-0.021834431673870613,
|
|
-0.176872701518174,
|
|
-0.03610860049214109
|
|
],
|
|
"observed_m": [
|
|
-0.017282178971859352,
|
|
-0.19073077328091026,
|
|
-0.025430604301005477
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 66,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.006401515405434849,
|
|
0.0017781585298348723,
|
|
0.004280175892847616
|
|
],
|
|
"error_norm_m": 0.007903236863270524,
|
|
"predicted_m": [
|
|
0.20623150165506418,
|
|
-0.35514160775885684,
|
|
-0.02191819801185144
|
|
],
|
|
"observed_m": [
|
|
0.21263301706049903,
|
|
-0.3569197662886917,
|
|
-0.026198373904699056
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 68,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.009920935536029796,
|
|
0.0036147367659919716,
|
|
-0.026317210500698983
|
|
],
|
|
"error_norm_m": 0.028356425239010184,
|
|
"predicted_m": [
|
|
0.5788292540408758,
|
|
0.17239787079977498,
|
|
-0.04119592555242797
|
|
],
|
|
"observed_m": [
|
|
0.568908318504846,
|
|
0.168783134033783,
|
|
-0.014878715051728992
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 69,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.009765747793697124,
|
|
0.010144855342052395,
|
|
-0.008205682086978694
|
|
],
|
|
"error_norm_m": 0.016297887543906795,
|
|
"predicted_m": [
|
|
0.005510649546115061,
|
|
-0.2701576935695941,
|
|
-0.03067798440933005
|
|
],
|
|
"observed_m": [
|
|
0.015276397339812184,
|
|
-0.2803025489116465,
|
|
-0.022472302322351357
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 72,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.01206183061354199,
|
|
-0.0026924053683481386,
|
|
-0.012113612864273517
|
|
],
|
|
"error_norm_m": 0.01730538705267182,
|
|
"predicted_m": [
|
|
0.4465264092455869,
|
|
0.1980681929781142,
|
|
-0.04539614201517998
|
|
],
|
|
"observed_m": [
|
|
0.4344645786320449,
|
|
0.20076059834646234,
|
|
-0.033282529150906466
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 73,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.0015939358789230362,
|
|
0.01307317060974833,
|
|
-0.03553258191354361
|
|
],
|
|
"error_norm_m": 0.037894759516592685,
|
|
"predicted_m": [
|
|
0.22962253010294684,
|
|
0.3400004979286803,
|
|
-0.05746012660960818
|
|
],
|
|
"observed_m": [
|
|
0.2280285942240238,
|
|
0.326927327318932,
|
|
-0.021927544696064564
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 75,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.0010134425856457747,
|
|
-0.015618359499804751,
|
|
0.005265080475666747
|
|
],
|
|
"error_norm_m": 0.016513064275136487,
|
|
"predicted_m": [
|
|
-0.019987203644106936,
|
|
0.20544680077663746,
|
|
-0.05589513413636127
|
|
],
|
|
"observed_m": [
|
|
-0.01897376105846116,
|
|
0.2210651602764422,
|
|
-0.061160214612028016
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 79,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.00047735424737849197,
|
|
0.006572400528108202,
|
|
-0.000397956849068775
|
|
],
|
|
"error_norm_m": 0.006601718369719206,
|
|
"predicted_m": [
|
|
0.3120899194987721,
|
|
-0.15288350019892974,
|
|
-0.03011150002654553
|
|
],
|
|
"observed_m": [
|
|
0.3116125652513936,
|
|
-0.15945590072703794,
|
|
-0.029713543177476754
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 82,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.007144984498683116,
|
|
-0.1226123391767675,
|
|
0.1569432012310248
|
|
],
|
|
"error_norm_m": 0.19928874763650617,
|
|
"predicted_m": [
|
|
0.22646544327444398,
|
|
0.304221993790752,
|
|
-0.055673161470176646
|
|
],
|
|
"observed_m": [
|
|
0.21932045877576087,
|
|
0.4268343329675195,
|
|
-0.21261636270120143
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 83,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.0042926929946417725,
|
|
-0.013398273717934894,
|
|
-0.005745035140862921
|
|
],
|
|
"error_norm_m": 0.015196920100359194,
|
|
"predicted_m": [
|
|
0.05221818580454903,
|
|
0.348810280462645,
|
|
-0.06176400343867677
|
|
],
|
|
"observed_m": [
|
|
0.056510878799190804,
|
|
0.3622085541805799,
|
|
-0.05601896829781385
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 84,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.017540563212802673,
|
|
-0.010434471361215614,
|
|
-0.013233216494029719
|
|
],
|
|
"error_norm_m": 0.02432421775079757,
|
|
"predicted_m": [
|
|
0.41408958781511274,
|
|
0.26258576175293025,
|
|
-0.04944533142473166
|
|
],
|
|
"observed_m": [
|
|
0.39654902460231006,
|
|
0.27302023311414586,
|
|
-0.03621211493070194
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 85,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.00026024434744487124,
|
|
0.000995853133054947,
|
|
0.012418126233019036
|
|
],
|
|
"error_norm_m": 0.012460710642743773,
|
|
"predicted_m": [
|
|
0.5017803060025984,
|
|
-0.3092325977374013,
|
|
-0.017890003926044614
|
|
],
|
|
"observed_m": [
|
|
0.5020405503500432,
|
|
-0.31022845087045625,
|
|
-0.03030813015906365
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 86,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.005119978759483168,
|
|
0.0051937441900155035,
|
|
-0.024585506760890694
|
|
],
|
|
"error_norm_m": 0.025644420521795393,
|
|
"predicted_m": [
|
|
0.370056694732192,
|
|
0.29680713079718124,
|
|
-0.05217486022752074
|
|
],
|
|
"observed_m": [
|
|
0.3649367159727088,
|
|
0.29161338660716574,
|
|
-0.027589353466630048
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 92,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.0040650859796993455,
|
|
0.00716592616144629,
|
|
0.005916398562679989
|
|
],
|
|
"error_norm_m": 0.010142938120984983,
|
|
"predicted_m": [
|
|
0.6443353751026841,
|
|
-0.18365243834182884,
|
|
-0.021311120710433118
|
|
],
|
|
"observed_m": [
|
|
0.6484004610823835,
|
|
-0.19081836450327513,
|
|
-0.027227519273113107
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 95,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.002655917912978728,
|
|
0.006827652227407333,
|
|
-0.00022795801062122645
|
|
],
|
|
"error_norm_m": 0.007329577051474933,
|
|
"predicted_m": [
|
|
0.1839918904792754,
|
|
-0.2657499110383315,
|
|
-0.027036200764427018
|
|
],
|
|
"observed_m": [
|
|
0.18664780839225412,
|
|
-0.27257756326573884,
|
|
-0.02680824275380579
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 96,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.0003330489368492118,
|
|
0.006534855641922105,
|
|
0.0016518584152897288
|
|
],
|
|
"error_norm_m": 0.0067486217910963904,
|
|
"predicted_m": [
|
|
0.3690898694722732,
|
|
-0.181100244069962,
|
|
-0.027412172640893313
|
|
],
|
|
"observed_m": [
|
|
0.3694229184091224,
|
|
-0.1876350997118841,
|
|
-0.02906403105618304
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 97,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.0002234266098899429,
|
|
-0.001703688491849431,
|
|
0.008865359330947977
|
|
],
|
|
"error_norm_m": 0.009030341632191633,
|
|
"predicted_m": [
|
|
0.30085497208872897,
|
|
-0.35302984583077157,
|
|
-0.019975801386937803
|
|
],
|
|
"observed_m": [
|
|
0.300631545478839,
|
|
-0.35132615733892214,
|
|
-0.02884116071788578
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 102,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.006605472273244595,
|
|
0.005727217418135866,
|
|
0.015832561515091527
|
|
],
|
|
"error_norm_m": 0.01808599699868269,
|
|
"predicted_m": [
|
|
0.6483081027262264,
|
|
-0.22182697671650253,
|
|
-0.019245290342345872
|
|
],
|
|
"observed_m": [
|
|
0.654913574999471,
|
|
-0.2275541941346384,
|
|
-0.0350778518574374
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 103,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.0004628579451216863,
|
|
0.011151957883560049,
|
|
-0.005196230324720625
|
|
],
|
|
"error_norm_m": 0.012311832182969584,
|
|
"predicted_m": [
|
|
0.10510726012716916,
|
|
-0.17829043906142777,
|
|
-0.033282348035566865
|
|
],
|
|
"observed_m": [
|
|
0.10557011807229084,
|
|
-0.18944239694498782,
|
|
-0.02808611771084624
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 105,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.0007442236148308412,
|
|
0.003659016775769186,
|
|
0.009758098129132975
|
|
],
|
|
"error_norm_m": 0.010448097992075911,
|
|
"predicted_m": [
|
|
0.5227951312590223,
|
|
-0.2631094373451257,
|
|
-0.019826184411018216
|
|
],
|
|
"observed_m": [
|
|
0.5235393548738532,
|
|
-0.2667684541208949,
|
|
-0.02958428254015119
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 205,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.014332872658958107,
|
|
0.019444247927015365,
|
|
-0.032248762424642204
|
|
],
|
|
"error_norm_m": 0.04029258857440367,
|
|
"predicted_m": [
|
|
0.7501638786079469,
|
|
-0.08912197428897047,
|
|
0.0037251112701953155
|
|
],
|
|
"observed_m": [
|
|
0.7358310059489888,
|
|
-0.10856622221598583,
|
|
0.03597387369483752
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 206,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.0030432648939281437,
|
|
-0.0007510465654346253,
|
|
-0.006402658259601998
|
|
],
|
|
"error_norm_m": 0.007128784254507659,
|
|
"predicted_m": [
|
|
0.651512240319729,
|
|
-0.007713180188276315,
|
|
-0.002635903281069312
|
|
],
|
|
"observed_m": [
|
|
0.6484689754258008,
|
|
-0.006962133622841689,
|
|
0.0037667549785326865
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 207,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.002108795921038853,
|
|
-0.005278021166740238,
|
|
-0.003292708202213847
|
|
],
|
|
"error_norm_m": 0.006568596119268898,
|
|
"predicted_m": [
|
|
0.7514753582778212,
|
|
-0.009238601096298147,
|
|
-0.00038909684750553994
|
|
],
|
|
"observed_m": [
|
|
0.7493665623567823,
|
|
-0.0039605799295579095,
|
|
0.002903611354708307
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 208,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.0005659718848211592,
|
|
0.005974973451685045,
|
|
-0.010586207674555946
|
|
],
|
|
"error_norm_m": 0.012169158756938638,
|
|
"predicted_m": [
|
|
0.35031140677557776,
|
|
-0.08302029065688313,
|
|
-0.005262114464059768
|
|
],
|
|
"observed_m": [
|
|
0.3497454348907566,
|
|
-0.08899526410856817,
|
|
0.005324093210496179
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 210,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.0035239332237271027,
|
|
0.008874902306851047,
|
|
-0.019692754042329164
|
|
],
|
|
"error_norm_m": 0.0218857615378837,
|
|
"predicted_m": [
|
|
0.0215806622250132,
|
|
-0.0080884501168228,
|
|
-0.01627650779780846
|
|
],
|
|
"observed_m": [
|
|
0.018056729001286097,
|
|
-0.016963352423673847,
|
|
0.003416246244520705
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 211,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.0018608685919185297,
|
|
0.007536852132166777,
|
|
-0.016705736727285002
|
|
],
|
|
"error_norm_m": 0.018421417197921956,
|
|
"predicted_m": [
|
|
0.25165976848735977,
|
|
-0.0016114965561889781,
|
|
-0.011623129015324394
|
|
],
|
|
"observed_m": [
|
|
0.24979889989544124,
|
|
-0.009148348688355755,
|
|
0.005082607711960607
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 214,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.0015684750862626218,
|
|
0.00574582775206614,
|
|
-0.013908941678217828
|
|
],
|
|
"error_norm_m": 0.01513054226591714,
|
|
"predicted_m": [
|
|
0.35162288644545203,
|
|
-0.0031369174642108125,
|
|
-0.009376322581760623
|
|
],
|
|
"observed_m": [
|
|
0.3500544113591894,
|
|
-0.008882745216276952,
|
|
0.004532619096457205
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 215,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.000845131230164442,
|
|
0.007216838764547803,
|
|
-0.011914373933465288
|
|
],
|
|
"error_norm_m": 0.013955261186237836,
|
|
"predicted_m": [
|
|
0.25034828881748544,
|
|
-0.0814948697488613,
|
|
-0.007508920897623539
|
|
],
|
|
"observed_m": [
|
|
0.249503157587321,
|
|
-0.08871170851340911,
|
|
0.004405453035841749
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 217,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.004014614981723508,
|
|
0.017577259273614684,
|
|
-0.004377445959401687
|
|
],
|
|
"error_norm_m": 0.01855368454379977,
|
|
"predicted_m": [
|
|
0.6502007606498547,
|
|
-0.08759655338094864,
|
|
0.0014783048366315433
|
|
],
|
|
"observed_m": [
|
|
0.6542153756315782,
|
|
-0.10517381265456333,
|
|
0.0058557507960332305
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 243,
|
|
"link": "Arm1",
|
|
"error_m": [
|
|
0.0030442313280949485,
|
|
0.03534133481652427,
|
|
-0.4331621336924618
|
|
],
|
|
"error_norm_m": 0.4346121389883154,
|
|
"predicted_m": [
|
|
0.18449311676404923,
|
|
-0.114780562354978,
|
|
-0.11960166190928528
|
|
],
|
|
"observed_m": [
|
|
0.18144888543595428,
|
|
-0.15012189717150226,
|
|
0.31356047178317653
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 246,
|
|
"link": "Ellbow",
|
|
"error_m": [
|
|
0.02677293000620254,
|
|
0.07784663277603267,
|
|
-0.4204556655931915
|
|
],
|
|
"error_norm_m": 0.42843885765077044,
|
|
"predicted_m": [
|
|
0.2735860527010144,
|
|
-0.11691208291075626,
|
|
-0.0792150632606324
|
|
],
|
|
"observed_m": [
|
|
0.24681312269481184,
|
|
-0.19475871568678893,
|
|
0.34124060233255904
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 247,
|
|
"link": "Ellbow",
|
|
"error_m": [
|
|
0.00046222396424286383,
|
|
0.02751821645243417,
|
|
-0.39801899830412135
|
|
],
|
|
"error_norm_m": 0.3989694084748006,
|
|
"predicted_m": [
|
|
0.23609988346675137,
|
|
-0.1163400500702484,
|
|
-0.08005761567321834
|
|
],
|
|
"observed_m": [
|
|
0.2356376595025085,
|
|
-0.14385826652268258,
|
|
0.317961382630903
|
|
]
|
|
}
|
|
],
|
|
"stage_idx": 1,
|
|
"num_active_links": 4
|
|
},
|
|
{
|
|
"method": "deterministic_geometric_prefix",
|
|
"active_links": [
|
|
"Board",
|
|
"Base",
|
|
"Arm1",
|
|
"Ellbow",
|
|
"Arm2"
|
|
],
|
|
"active_observations": 47,
|
|
"joint_updates": [
|
|
{
|
|
"pass": 0,
|
|
"updates": [
|
|
{
|
|
"link": "Base",
|
|
"joint_variable": "x",
|
|
"joint_type": "linear",
|
|
"old": 0.0721583566765767,
|
|
"new": 0.06036539553405373,
|
|
"info": {
|
|
"reason": "weighted_projection",
|
|
"used_markers": 8,
|
|
"axis_world": [
|
|
0.9996311795799229,
|
|
-0.015254209080203078,
|
|
0.022468064335615233
|
|
],
|
|
"per_marker": [
|
|
{
|
|
"marker_id": 243,
|
|
"q_i": 0.07938666692103402,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 246,
|
|
"q_i": 0.05602961483089859,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 247,
|
|
"q_i": 0.08105878827780005,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 120,
|
|
"q_i": 0.05834849326850647,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 218,
|
|
"q_i": 0.008245410693012156,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 114,
|
|
"q_i": 0.05395390438968481,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 115,
|
|
"q_i": 0.13467523330363856,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 219,
|
|
"q_i": 0.01122505258785522,
|
|
"weight": 1.0
|
|
}
|
|
]
|
|
}
|
|
},
|
|
{
|
|
"link": "Arm1",
|
|
"joint_variable": "y",
|
|
"joint_type": "revolute",
|
|
"old": -0.6519211760926327,
|
|
"new": -0.6514312290618247,
|
|
"info": {
|
|
"reason": "2d_alignment+normal_tiebreak",
|
|
"used_markers": 8,
|
|
"axis_world": [
|
|
-0.9996311795799229,
|
|
0.015254209080203078,
|
|
-0.022468064335615233
|
|
],
|
|
"axis_id": 0,
|
|
"theta_rad": -0.6514312290618246,
|
|
"theta_alt_rad": 2.490161424527969,
|
|
"score_theta": 1.8768481157361248,
|
|
"score_theta_alt": 3.1652579672227588,
|
|
"best_score": 1.8768481157361248,
|
|
"per_marker": [
|
|
{
|
|
"marker_id": 243,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 246,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 247,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 120,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 218,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 114,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 115,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 219,
|
|
"weight": 1.0
|
|
}
|
|
]
|
|
}
|
|
},
|
|
{
|
|
"link": "Ellbow",
|
|
"joint_variable": "z",
|
|
"joint_type": "revolute",
|
|
"old": -0.4101046699037387,
|
|
"new": 1.4578495646523564,
|
|
"info": {
|
|
"reason": "2d_alignment+normal_tiebreak",
|
|
"used_markers": 7,
|
|
"axis_world": [
|
|
-0.999631179579923,
|
|
0.01525420908020308,
|
|
-0.022468064335615236
|
|
],
|
|
"axis_id": 0,
|
|
"theta_rad": -1.6837430889374367,
|
|
"theta_alt_rad": 1.4578495646523564,
|
|
"score_theta": 2.1671521471209187,
|
|
"score_theta_alt": 0.7481164620118095,
|
|
"best_score": 0.7481164620118095,
|
|
"per_marker": [
|
|
{
|
|
"marker_id": 246,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 247,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 120,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 218,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 114,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 115,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 219,
|
|
"weight": 1.0
|
|
}
|
|
]
|
|
}
|
|
},
|
|
{
|
|
"link": "Arm2",
|
|
"joint_variable": "a",
|
|
"joint_type": "revolute",
|
|
"old": 0.0,
|
|
"new": -0.9280827828682447,
|
|
"info": {
|
|
"reason": "2d_alignment+normal_tiebreak",
|
|
"used_markers": 5,
|
|
"axis_world": [
|
|
-0.026973588916499855,
|
|
-0.6537059232346972,
|
|
0.7562678040395716
|
|
],
|
|
"axis_id": 2,
|
|
"theta_rad": 2.2135098707215475,
|
|
"theta_alt_rad": -0.9280827828682447,
|
|
"score_theta": 0.5234144848366329,
|
|
"score_theta_alt": 0.4577967285459642,
|
|
"best_score": 0.4577967285459642,
|
|
"per_marker": [
|
|
{
|
|
"marker_id": 120,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 218,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 114,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 115,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 219,
|
|
"weight": 1.0
|
|
}
|
|
]
|
|
}
|
|
}
|
|
]
|
|
},
|
|
{
|
|
"pass": 1,
|
|
"updates": [
|
|
{
|
|
"link": "Base",
|
|
"joint_variable": "x",
|
|
"joint_type": "linear",
|
|
"old": 0.06036539553405373,
|
|
"new": 0.07253974336302962,
|
|
"info": {
|
|
"reason": "weighted_projection",
|
|
"used_markers": 8,
|
|
"axis_world": [
|
|
0.9996311795799229,
|
|
-0.015254209080203078,
|
|
0.022468064335615233
|
|
],
|
|
"per_marker": [
|
|
{
|
|
"marker_id": 243,
|
|
"q_i": 0.07938666692103402,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 246,
|
|
"q_i": 0.05602961483104335,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 247,
|
|
"q_i": 0.08105878827788449,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 120,
|
|
"q_i": 0.08807578085324477,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 218,
|
|
"q_i": 0.02226746901986768,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 114,
|
|
"q_i": 0.0836811919744231,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 115,
|
|
"q_i": 0.1445713241120288,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 219,
|
|
"q_i": 0.025247110914710734,
|
|
"weight": 1.0
|
|
}
|
|
]
|
|
}
|
|
},
|
|
{
|
|
"link": "Arm1",
|
|
"joint_variable": "y",
|
|
"joint_type": "revolute",
|
|
"old": -0.6514312290618247,
|
|
"new": -0.16779287946966148,
|
|
"info": {
|
|
"reason": "2d_alignment+normal_tiebreak",
|
|
"used_markers": 8,
|
|
"axis_world": [
|
|
-0.9996311795799229,
|
|
0.015254209080203078,
|
|
-0.022468064335615233
|
|
],
|
|
"axis_id": 0,
|
|
"theta_rad": -0.16779287946966157,
|
|
"theta_alt_rad": 2.973799774120131,
|
|
"score_theta": 0.40848547611494357,
|
|
"score_theta_alt": 4.038934603547279,
|
|
"best_score": 0.40848547611494357,
|
|
"per_marker": [
|
|
{
|
|
"marker_id": 243,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 246,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 247,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 120,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 218,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 114,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 115,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 219,
|
|
"weight": 1.0
|
|
}
|
|
]
|
|
}
|
|
},
|
|
{
|
|
"link": "Ellbow",
|
|
"joint_variable": "z",
|
|
"joint_type": "revolute",
|
|
"old": 1.4578495646523564,
|
|
"new": 1.925767292056002,
|
|
"info": {
|
|
"reason": "2d_alignment+normal_tiebreak",
|
|
"used_markers": 7,
|
|
"axis_world": [
|
|
-0.999631179579923,
|
|
0.01525420908020308,
|
|
-0.022468064335615233
|
|
],
|
|
"axis_id": 0,
|
|
"theta_rad": -1.2158253615337913,
|
|
"theta_alt_rad": 1.925767292056002,
|
|
"score_theta": 1.210726275397398,
|
|
"score_theta_alt": 0.5394744999967191,
|
|
"best_score": 0.5394744999967191,
|
|
"per_marker": [
|
|
{
|
|
"marker_id": 246,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 247,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 120,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 218,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 114,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 115,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 219,
|
|
"weight": 1.0
|
|
}
|
|
]
|
|
}
|
|
},
|
|
{
|
|
"link": "Arm2",
|
|
"joint_variable": "a",
|
|
"joint_type": "revolute",
|
|
"old": -0.9280827828682447,
|
|
"new": -1.1466874518758399,
|
|
"info": {
|
|
"reason": "2d_alignment+normal_tiebreak",
|
|
"used_markers": 5,
|
|
"axis_world": [
|
|
-0.018222036397425166,
|
|
0.236688320500357,
|
|
0.9714147396072654
|
|
],
|
|
"axis_id": 2,
|
|
"theta_rad": -1.1466874518758399,
|
|
"theta_alt_rad": 1.9949052017139532,
|
|
"score_theta": 0.3580336246587261,
|
|
"score_theta_alt": 0.4172551491372727,
|
|
"best_score": 0.3580336246587261,
|
|
"per_marker": [
|
|
{
|
|
"marker_id": 120,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 218,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 114,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 115,
|
|
"weight": 1.0
|
|
},
|
|
{
|
|
"marker_id": 219,
|
|
"weight": 1.0
|
|
}
|
|
]
|
|
}
|
|
}
|
|
]
|
|
}
|
|
],
|
|
"root_link": "Board",
|
|
"root_pose": {
|
|
"reason": "kabsch",
|
|
"used_markers": [
|
|
210,
|
|
211,
|
|
215,
|
|
214,
|
|
208,
|
|
206,
|
|
205,
|
|
207,
|
|
217,
|
|
46,
|
|
47,
|
|
51,
|
|
53,
|
|
55,
|
|
56,
|
|
58,
|
|
61,
|
|
62,
|
|
63,
|
|
64,
|
|
66,
|
|
68,
|
|
69,
|
|
72,
|
|
73,
|
|
75,
|
|
79,
|
|
82,
|
|
83,
|
|
84,
|
|
85,
|
|
86,
|
|
92,
|
|
95,
|
|
96,
|
|
97,
|
|
102,
|
|
103,
|
|
105
|
|
]
|
|
},
|
|
"marker_stats": {
|
|
"num_markers_used": 47,
|
|
"mean_error_m": 0.059486942035126236,
|
|
"rms_error_m": 0.1095094670694353,
|
|
"median_error_m": 0.01746425224429604,
|
|
"worst_error_m": 0.3504914440162874
|
|
},
|
|
"marker_reports": [
|
|
{
|
|
"marker_id": 46,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.007895331762659885,
|
|
-0.0006314475403442765,
|
|
-0.018285418768428742
|
|
],
|
|
"error_norm_m": 0.019927155571618317,
|
|
"predicted_m": [
|
|
0.5420655315117168,
|
|
0.18774100566056906,
|
|
-0.04278882179590794
|
|
],
|
|
"observed_m": [
|
|
0.5341701997490569,
|
|
0.18837245320091334,
|
|
-0.0245034030274792
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 47,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.00216719129998999,
|
|
0.008630400445827136,
|
|
0.006567463574039992
|
|
],
|
|
"error_norm_m": 0.011059480448123576,
|
|
"predicted_m": [
|
|
0.34191911988364,
|
|
-0.28061479516913906,
|
|
-0.02284067547682586
|
|
],
|
|
"observed_m": [
|
|
0.34408631118363,
|
|
-0.2892451956149662,
|
|
-0.029408139050865853
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 51,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.0019825139298365047,
|
|
0.010321285886508186,
|
|
-0.0032476596525796604
|
|
],
|
|
"error_norm_m": 0.011000299861913887,
|
|
"predicted_m": [
|
|
0.16743059040785033,
|
|
-0.16363035886570018,
|
|
-0.03269111933196293
|
|
],
|
|
"observed_m": [
|
|
0.16544807647801382,
|
|
-0.17395164475220837,
|
|
-0.029443459679383267
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 53,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.010190425417623772,
|
|
-0.004685057942000026,
|
|
-0.013386768405419927
|
|
],
|
|
"error_norm_m": 0.01746425224429604,
|
|
"predicted_m": [
|
|
0.4920634878794713,
|
|
0.2152716630703021,
|
|
-0.04530082004171401
|
|
],
|
|
"observed_m": [
|
|
0.4818730624618475,
|
|
0.21995672101230213,
|
|
-0.031914051636294086
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 55,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.000648024175633255,
|
|
0.005926273650224356,
|
|
0.0030121560446546916
|
|
],
|
|
"error_norm_m": 0.0066793516711503124,
|
|
"predicted_m": [
|
|
0.2818242253683257,
|
|
-0.2557666927064896,
|
|
-0.025432423381026713
|
|
],
|
|
"observed_m": [
|
|
0.28247224954395894,
|
|
-0.26169296635671396,
|
|
-0.028444579425681404
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 56,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.02817326017385502,
|
|
-0.024584323572284905,
|
|
0.04561768174620743
|
|
],
|
|
"error_norm_m": 0.05898384899469341,
|
|
"predicted_m": [
|
|
0.5037746388264569,
|
|
0.17157557112637584,
|
|
-0.04278084140591921
|
|
],
|
|
"observed_m": [
|
|
0.5319478990003119,
|
|
0.19615989469866074,
|
|
-0.08839852315212664
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 58,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.0036283215191368137,
|
|
0.011792552986691573,
|
|
-0.007131376636709666
|
|
],
|
|
"error_norm_m": 0.014250808949837483,
|
|
"predicted_m": [
|
|
0.049009411644326,
|
|
-0.20779768176560154,
|
|
-0.03296862268918871
|
|
],
|
|
"observed_m": [
|
|
0.05263773316346281,
|
|
-0.2195902347522931,
|
|
-0.025837246052479043
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 61,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.0039243565853280555,
|
|
-0.019787233763559453,
|
|
0.0009600037431695824
|
|
],
|
|
"error_norm_m": 0.020195464882231715,
|
|
"predicted_m": [
|
|
-0.01439283208295973,
|
|
0.34644084776416645,
|
|
-0.06308558759315597
|
|
],
|
|
"observed_m": [
|
|
-0.010468475497631675,
|
|
0.3662280815277259,
|
|
-0.06404559133632555
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 62,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.001397680135084567,
|
|
0.009276782057794891,
|
|
0.0008861811743844303
|
|
],
|
|
"error_norm_m": 0.009423243188078538,
|
|
"predicted_m": [
|
|
0.40419370849303327,
|
|
-0.17025967833482727,
|
|
-0.02721312353440715
|
|
],
|
|
"observed_m": [
|
|
0.40559138862811783,
|
|
-0.17953646039262217,
|
|
-0.02809930470879158
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 63,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.016894642595327913,
|
|
0.007560854561507152,
|
|
0.025439453433518014
|
|
],
|
|
"error_norm_m": 0.03146047140651683,
|
|
"predicted_m": [
|
|
0.7757554261997703,
|
|
-0.23690592122668272,
|
|
-0.015699620886694507
|
|
],
|
|
"observed_m": [
|
|
0.7926500687950983,
|
|
-0.24446677578818987,
|
|
-0.04113907432021252
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 64,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.004552252702011261,
|
|
0.013858071762736263,
|
|
-0.010677996191135613
|
|
],
|
|
"error_norm_m": 0.01807729958544759,
|
|
"predicted_m": [
|
|
-0.021834431673870613,
|
|
-0.176872701518174,
|
|
-0.03610860049214109
|
|
],
|
|
"observed_m": [
|
|
-0.017282178971859352,
|
|
-0.19073077328091026,
|
|
-0.025430604301005477
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 66,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.006401515405434849,
|
|
0.0017781585298348723,
|
|
0.004280175892847616
|
|
],
|
|
"error_norm_m": 0.007903236863270524,
|
|
"predicted_m": [
|
|
0.20623150165506418,
|
|
-0.35514160775885684,
|
|
-0.02191819801185144
|
|
],
|
|
"observed_m": [
|
|
0.21263301706049903,
|
|
-0.3569197662886917,
|
|
-0.026198373904699056
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 68,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.009920935536029796,
|
|
0.0036147367659919716,
|
|
-0.026317210500698983
|
|
],
|
|
"error_norm_m": 0.028356425239010184,
|
|
"predicted_m": [
|
|
0.5788292540408758,
|
|
0.17239787079977498,
|
|
-0.04119592555242797
|
|
],
|
|
"observed_m": [
|
|
0.568908318504846,
|
|
0.168783134033783,
|
|
-0.014878715051728992
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 69,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.009765747793697124,
|
|
0.010144855342052395,
|
|
-0.008205682086978694
|
|
],
|
|
"error_norm_m": 0.016297887543906795,
|
|
"predicted_m": [
|
|
0.005510649546115061,
|
|
-0.2701576935695941,
|
|
-0.03067798440933005
|
|
],
|
|
"observed_m": [
|
|
0.015276397339812184,
|
|
-0.2803025489116465,
|
|
-0.022472302322351357
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 72,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.01206183061354199,
|
|
-0.0026924053683481386,
|
|
-0.012113612864273517
|
|
],
|
|
"error_norm_m": 0.01730538705267182,
|
|
"predicted_m": [
|
|
0.4465264092455869,
|
|
0.1980681929781142,
|
|
-0.04539614201517998
|
|
],
|
|
"observed_m": [
|
|
0.4344645786320449,
|
|
0.20076059834646234,
|
|
-0.033282529150906466
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 73,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.0015939358789230362,
|
|
0.01307317060974833,
|
|
-0.03553258191354361
|
|
],
|
|
"error_norm_m": 0.037894759516592685,
|
|
"predicted_m": [
|
|
0.22962253010294684,
|
|
0.3400004979286803,
|
|
-0.05746012660960818
|
|
],
|
|
"observed_m": [
|
|
0.2280285942240238,
|
|
0.326927327318932,
|
|
-0.021927544696064564
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 75,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.0010134425856457747,
|
|
-0.015618359499804751,
|
|
0.005265080475666747
|
|
],
|
|
"error_norm_m": 0.016513064275136487,
|
|
"predicted_m": [
|
|
-0.019987203644106936,
|
|
0.20544680077663746,
|
|
-0.05589513413636127
|
|
],
|
|
"observed_m": [
|
|
-0.01897376105846116,
|
|
0.2210651602764422,
|
|
-0.061160214612028016
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 79,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.00047735424737849197,
|
|
0.006572400528108202,
|
|
-0.000397956849068775
|
|
],
|
|
"error_norm_m": 0.006601718369719206,
|
|
"predicted_m": [
|
|
0.3120899194987721,
|
|
-0.15288350019892974,
|
|
-0.03011150002654553
|
|
],
|
|
"observed_m": [
|
|
0.3116125652513936,
|
|
-0.15945590072703794,
|
|
-0.029713543177476754
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 82,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.007144984498683116,
|
|
-0.1226123391767675,
|
|
0.1569432012310248
|
|
],
|
|
"error_norm_m": 0.19928874763650617,
|
|
"predicted_m": [
|
|
0.22646544327444398,
|
|
0.304221993790752,
|
|
-0.055673161470176646
|
|
],
|
|
"observed_m": [
|
|
0.21932045877576087,
|
|
0.4268343329675195,
|
|
-0.21261636270120143
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 83,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.0042926929946417725,
|
|
-0.013398273717934894,
|
|
-0.005745035140862921
|
|
],
|
|
"error_norm_m": 0.015196920100359194,
|
|
"predicted_m": [
|
|
0.05221818580454903,
|
|
0.348810280462645,
|
|
-0.06176400343867677
|
|
],
|
|
"observed_m": [
|
|
0.056510878799190804,
|
|
0.3622085541805799,
|
|
-0.05601896829781385
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 84,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.017540563212802673,
|
|
-0.010434471361215614,
|
|
-0.013233216494029719
|
|
],
|
|
"error_norm_m": 0.02432421775079757,
|
|
"predicted_m": [
|
|
0.41408958781511274,
|
|
0.26258576175293025,
|
|
-0.04944533142473166
|
|
],
|
|
"observed_m": [
|
|
0.39654902460231006,
|
|
0.27302023311414586,
|
|
-0.03621211493070194
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 85,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.00026024434744487124,
|
|
0.000995853133054947,
|
|
0.012418126233019036
|
|
],
|
|
"error_norm_m": 0.012460710642743773,
|
|
"predicted_m": [
|
|
0.5017803060025984,
|
|
-0.3092325977374013,
|
|
-0.017890003926044614
|
|
],
|
|
"observed_m": [
|
|
0.5020405503500432,
|
|
-0.31022845087045625,
|
|
-0.03030813015906365
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 86,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.005119978759483168,
|
|
0.0051937441900155035,
|
|
-0.024585506760890694
|
|
],
|
|
"error_norm_m": 0.025644420521795393,
|
|
"predicted_m": [
|
|
0.370056694732192,
|
|
0.29680713079718124,
|
|
-0.05217486022752074
|
|
],
|
|
"observed_m": [
|
|
0.3649367159727088,
|
|
0.29161338660716574,
|
|
-0.027589353466630048
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 92,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.0040650859796993455,
|
|
0.00716592616144629,
|
|
0.005916398562679989
|
|
],
|
|
"error_norm_m": 0.010142938120984983,
|
|
"predicted_m": [
|
|
0.6443353751026841,
|
|
-0.18365243834182884,
|
|
-0.021311120710433118
|
|
],
|
|
"observed_m": [
|
|
0.6484004610823835,
|
|
-0.19081836450327513,
|
|
-0.027227519273113107
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 95,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.002655917912978728,
|
|
0.006827652227407333,
|
|
-0.00022795801062122645
|
|
],
|
|
"error_norm_m": 0.007329577051474933,
|
|
"predicted_m": [
|
|
0.1839918904792754,
|
|
-0.2657499110383315,
|
|
-0.027036200764427018
|
|
],
|
|
"observed_m": [
|
|
0.18664780839225412,
|
|
-0.27257756326573884,
|
|
-0.02680824275380579
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 96,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.0003330489368492118,
|
|
0.006534855641922105,
|
|
0.0016518584152897288
|
|
],
|
|
"error_norm_m": 0.0067486217910963904,
|
|
"predicted_m": [
|
|
0.3690898694722732,
|
|
-0.181100244069962,
|
|
-0.027412172640893313
|
|
],
|
|
"observed_m": [
|
|
0.3694229184091224,
|
|
-0.1876350997118841,
|
|
-0.02906403105618304
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 97,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.0002234266098899429,
|
|
-0.001703688491849431,
|
|
0.008865359330947977
|
|
],
|
|
"error_norm_m": 0.009030341632191633,
|
|
"predicted_m": [
|
|
0.30085497208872897,
|
|
-0.35302984583077157,
|
|
-0.019975801386937803
|
|
],
|
|
"observed_m": [
|
|
0.300631545478839,
|
|
-0.35132615733892214,
|
|
-0.02884116071788578
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 102,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.006605472273244595,
|
|
0.005727217418135866,
|
|
0.015832561515091527
|
|
],
|
|
"error_norm_m": 0.01808599699868269,
|
|
"predicted_m": [
|
|
0.6483081027262264,
|
|
-0.22182697671650253,
|
|
-0.019245290342345872
|
|
],
|
|
"observed_m": [
|
|
0.654913574999471,
|
|
-0.2275541941346384,
|
|
-0.0350778518574374
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 103,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.0004628579451216863,
|
|
0.011151957883560049,
|
|
-0.005196230324720625
|
|
],
|
|
"error_norm_m": 0.012311832182969584,
|
|
"predicted_m": [
|
|
0.10510726012716916,
|
|
-0.17829043906142777,
|
|
-0.033282348035566865
|
|
],
|
|
"observed_m": [
|
|
0.10557011807229084,
|
|
-0.18944239694498782,
|
|
-0.02808611771084624
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 105,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.0007442236148308412,
|
|
0.003659016775769186,
|
|
0.009758098129132975
|
|
],
|
|
"error_norm_m": 0.010448097992075911,
|
|
"predicted_m": [
|
|
0.5227951312590223,
|
|
-0.2631094373451257,
|
|
-0.019826184411018216
|
|
],
|
|
"observed_m": [
|
|
0.5235393548738532,
|
|
-0.2667684541208949,
|
|
-0.02958428254015119
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 114,
|
|
"link": "Arm2",
|
|
"error_m": [
|
|
-0.014782037951953764,
|
|
0.1628706212016688,
|
|
-0.056772314865493
|
|
],
|
|
"error_norm_m": 0.17311396140062527,
|
|
"predicted_m": [
|
|
0.25533097100129737,
|
|
-0.11781772333346427,
|
|
0.19866687076756162
|
|
],
|
|
"observed_m": [
|
|
0.27011300895325113,
|
|
-0.2806883445351331,
|
|
0.2554391856330546
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 115,
|
|
"link": "Arm2",
|
|
"error_m": [
|
|
-0.06721826018371904,
|
|
0.1446860864842704,
|
|
-0.03236082057013592
|
|
],
|
|
"error_norm_m": 0.16278691849234217,
|
|
"predicted_m": [
|
|
0.2358772311823024,
|
|
-0.073679718013855,
|
|
0.18754758601309227
|
|
],
|
|
"observed_m": [
|
|
0.30309549136602143,
|
|
-0.2183658044981254,
|
|
0.2199084065832282
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 120,
|
|
"link": "Arm2",
|
|
"error_m": [
|
|
-0.01817078385619042,
|
|
0.09414906378804294,
|
|
-0.1482526394575604
|
|
],
|
|
"error_norm_m": 0.17655896664923806,
|
|
"predicted_m": [
|
|
0.2566065135491158,
|
|
-0.1343859057684713,
|
|
0.13066783899512674
|
|
],
|
|
"observed_m": [
|
|
0.2747772974053062,
|
|
-0.22853496955651423,
|
|
0.27892047845268714
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 205,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.014332872658958107,
|
|
0.019444247927015365,
|
|
-0.032248762424642204
|
|
],
|
|
"error_norm_m": 0.04029258857440367,
|
|
"predicted_m": [
|
|
0.7501638786079469,
|
|
-0.08912197428897047,
|
|
0.0037251112701953155
|
|
],
|
|
"observed_m": [
|
|
0.7358310059489888,
|
|
-0.10856622221598583,
|
|
0.03597387369483752
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 206,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.0030432648939281437,
|
|
-0.0007510465654346253,
|
|
-0.006402658259601998
|
|
],
|
|
"error_norm_m": 0.007128784254507659,
|
|
"predicted_m": [
|
|
0.651512240319729,
|
|
-0.007713180188276315,
|
|
-0.002635903281069312
|
|
],
|
|
"observed_m": [
|
|
0.6484689754258008,
|
|
-0.006962133622841689,
|
|
0.0037667549785326865
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 207,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.002108795921038853,
|
|
-0.005278021166740238,
|
|
-0.003292708202213847
|
|
],
|
|
"error_norm_m": 0.006568596119268898,
|
|
"predicted_m": [
|
|
0.7514753582778212,
|
|
-0.009238601096298147,
|
|
-0.00038909684750553994
|
|
],
|
|
"observed_m": [
|
|
0.7493665623567823,
|
|
-0.0039605799295579095,
|
|
0.002903611354708307
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 208,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.0005659718848211592,
|
|
0.005974973451685045,
|
|
-0.010586207674555946
|
|
],
|
|
"error_norm_m": 0.012169158756938638,
|
|
"predicted_m": [
|
|
0.35031140677557776,
|
|
-0.08302029065688313,
|
|
-0.005262114464059768
|
|
],
|
|
"observed_m": [
|
|
0.3497454348907566,
|
|
-0.08899526410856817,
|
|
0.005324093210496179
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 210,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.0035239332237271027,
|
|
0.008874902306851047,
|
|
-0.019692754042329164
|
|
],
|
|
"error_norm_m": 0.0218857615378837,
|
|
"predicted_m": [
|
|
0.0215806622250132,
|
|
-0.0080884501168228,
|
|
-0.01627650779780846
|
|
],
|
|
"observed_m": [
|
|
0.018056729001286097,
|
|
-0.016963352423673847,
|
|
0.003416246244520705
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 211,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.0018608685919185297,
|
|
0.007536852132166777,
|
|
-0.016705736727285002
|
|
],
|
|
"error_norm_m": 0.018421417197921956,
|
|
"predicted_m": [
|
|
0.25165976848735977,
|
|
-0.0016114965561889781,
|
|
-0.011623129015324394
|
|
],
|
|
"observed_m": [
|
|
0.24979889989544124,
|
|
-0.009148348688355755,
|
|
0.005082607711960607
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 214,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.0015684750862626218,
|
|
0.00574582775206614,
|
|
-0.013908941678217828
|
|
],
|
|
"error_norm_m": 0.01513054226591714,
|
|
"predicted_m": [
|
|
0.35162288644545203,
|
|
-0.0031369174642108125,
|
|
-0.009376322581760623
|
|
],
|
|
"observed_m": [
|
|
0.3500544113591894,
|
|
-0.008882745216276952,
|
|
0.004532619096457205
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 215,
|
|
"link": "Board",
|
|
"error_m": [
|
|
0.000845131230164442,
|
|
0.007216838764547803,
|
|
-0.011914373933465288
|
|
],
|
|
"error_norm_m": 0.013955261186237836,
|
|
"predicted_m": [
|
|
0.25034828881748544,
|
|
-0.0814948697488613,
|
|
-0.007508920897623539
|
|
],
|
|
"observed_m": [
|
|
0.249503157587321,
|
|
-0.08871170851340911,
|
|
0.004405453035841749
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 217,
|
|
"link": "Board",
|
|
"error_m": [
|
|
-0.004014614981723508,
|
|
0.017577259273614684,
|
|
-0.004377445959401687
|
|
],
|
|
"error_norm_m": 0.01855368454379977,
|
|
"predicted_m": [
|
|
0.6502007606498547,
|
|
-0.08759655338094864,
|
|
0.0014783048366315433
|
|
],
|
|
"observed_m": [
|
|
0.6542153756315782,
|
|
-0.10517381265456333,
|
|
0.0058557507960332305
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 218,
|
|
"link": "Arm2",
|
|
"error_m": [
|
|
0.04950680404494656,
|
|
0.1345840460010035,
|
|
-0.16638870705675796
|
|
],
|
|
"error_norm_m": 0.21965652942893496,
|
|
"predicted_m": [
|
|
0.2833888700976032,
|
|
-0.1339754609325824,
|
|
0.13107022281846548
|
|
],
|
|
"observed_m": [
|
|
0.23388206605265666,
|
|
-0.2685595069335859,
|
|
0.29745892987522343
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 219,
|
|
"link": "Arm2",
|
|
"error_m": [
|
|
0.04476113409704152,
|
|
0.2314446600378962,
|
|
-0.02210347790619588
|
|
],
|
|
"error_norm_m": 0.23676729825138515,
|
|
"predicted_m": [
|
|
0.2814391122030808,
|
|
-0.10864981063907166,
|
|
0.2350115999563302
|
|
],
|
|
"observed_m": [
|
|
0.2366779781060393,
|
|
-0.34009447067696785,
|
|
0.2571150778625261
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 243,
|
|
"link": "Arm1",
|
|
"error_m": [
|
|
-0.00018028307531864352,
|
|
-0.012541878970393217,
|
|
-0.3052342790434493
|
|
],
|
|
"error_norm_m": 0.3054918924182269,
|
|
"predicted_m": [
|
|
0.18126860236063563,
|
|
-0.16266377614189548,
|
|
0.00832619273972722
|
|
],
|
|
"observed_m": [
|
|
0.18144888543595428,
|
|
-0.15012189717150226,
|
|
0.31356047178317653
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 246,
|
|
"link": "Ellbow",
|
|
"error_m": [
|
|
0.025566209128707024,
|
|
0.09948415914479554,
|
|
-0.3351022580626137
|
|
],
|
|
"error_norm_m": 0.3504914440162874,
|
|
"predicted_m": [
|
|
0.27237933182351887,
|
|
-0.09527455654199339,
|
|
0.006138344269945348
|
|
],
|
|
"observed_m": [
|
|
0.24681312269481184,
|
|
-0.19475871568678893,
|
|
0.34124060233255904
|
|
]
|
|
},
|
|
{
|
|
"marker_id": 247,
|
|
"link": "Ellbow",
|
|
"error_m": [
|
|
-0.0007444969131721602,
|
|
0.04915574282119581,
|
|
-0.3126655907735418
|
|
],
|
|
"error_norm_m": 0.31650689247112007,
|
|
"predicted_m": [
|
|
0.23489316258933635,
|
|
-0.09470252370148677,
|
|
0.005295791857361229
|
|
],
|
|
"observed_m": [
|
|
0.2356376595025085,
|
|
-0.14385826652268258,
|
|
0.317961382630903
|
|
]
|
|
}
|
|
],
|
|
"stage_idx": 2,
|
|
"num_active_links": 5
|
|
}
|
|
],
|
|
"markers": [
|
|
{
|
|
"marker_id": 40,
|
|
"link": "FingerA",
|
|
"observed_position_m": [
|
|
0.2710032327553874,
|
|
-0.37105364411720365,
|
|
0.24053356389733796
|
|
],
|
|
"predicted_position_m": [
|
|
0.2566110521159071,
|
|
-0.07700427474146507,
|
|
0.3194837106794734
|
|
],
|
|
"error_m": [
|
|
-0.014392180639480279,
|
|
0.29404936937573856,
|
|
0.07895014678213544
|
|
],
|
|
"error_norm_m": 0.30480369448343253
|
|
},
|
|
{
|
|
"marker_id": 42,
|
|
"link": "FingerA",
|
|
"observed_position_m": [
|
|
0.2870415300851357,
|
|
-0.3180461147228875,
|
|
0.20905277320173554
|
|
],
|
|
"predicted_position_m": [
|
|
0.272787193498394,
|
|
-0.06831317410110509,
|
|
0.3341403548939538
|
|
],
|
|
"error_m": [
|
|
-0.014254336586741745,
|
|
0.24973294062178242,
|
|
0.12508758169221823
|
|
],
|
|
"error_norm_m": 0.27967236337675233
|
|
},
|
|
{
|
|
"marker_id": 44,
|
|
"link": "FingerB",
|
|
"observed_position_m": [
|
|
0.3060059381865538,
|
|
-0.2646984952147587,
|
|
0.22392474325241385
|
|
],
|
|
"predicted_position_m": [
|
|
0.24056029259064393,
|
|
-0.06635004369310933,
|
|
0.294145192975678
|
|
],
|
|
"error_m": [
|
|
-0.06544564559590987,
|
|
0.19834845152164937,
|
|
0.07022044972326413
|
|
],
|
|
"error_norm_m": 0.2203546058239741
|
|
},
|
|
{
|
|
"marker_id": 46,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.5341701997490569,
|
|
0.18837245320091334,
|
|
-0.0245034030274792
|
|
],
|
|
"predicted_position_m": [
|
|
0.5420655315117168,
|
|
0.18774100566056906,
|
|
-0.04278882179590794
|
|
],
|
|
"error_m": [
|
|
0.007895331762659885,
|
|
-0.0006314475403442765,
|
|
-0.018285418768428742
|
|
],
|
|
"error_norm_m": 0.019927155571618317
|
|
},
|
|
{
|
|
"marker_id": 47,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.34408631118363,
|
|
-0.2892451956149662,
|
|
-0.029408139050865853
|
|
],
|
|
"predicted_position_m": [
|
|
0.34191911988364,
|
|
-0.28061479516913906,
|
|
-0.02284067547682586
|
|
],
|
|
"error_m": [
|
|
-0.00216719129998999,
|
|
0.008630400445827136,
|
|
0.006567463574039992
|
|
],
|
|
"error_norm_m": 0.011059480448123576
|
|
},
|
|
{
|
|
"marker_id": 51,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.16544807647801382,
|
|
-0.17395164475220837,
|
|
-0.029443459679383267
|
|
],
|
|
"predicted_position_m": [
|
|
0.16743059040785033,
|
|
-0.16363035886570018,
|
|
-0.03269111933196293
|
|
],
|
|
"error_m": [
|
|
0.0019825139298365047,
|
|
0.010321285886508186,
|
|
-0.0032476596525796604
|
|
],
|
|
"error_norm_m": 0.011000299861913887
|
|
},
|
|
{
|
|
"marker_id": 53,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.4818730624618475,
|
|
0.21995672101230213,
|
|
-0.031914051636294086
|
|
],
|
|
"predicted_position_m": [
|
|
0.4920634878794713,
|
|
0.2152716630703021,
|
|
-0.04530082004171401
|
|
],
|
|
"error_m": [
|
|
0.010190425417623772,
|
|
-0.004685057942000026,
|
|
-0.013386768405419927
|
|
],
|
|
"error_norm_m": 0.01746425224429604
|
|
},
|
|
{
|
|
"marker_id": 55,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.28247224954395894,
|
|
-0.26169296635671396,
|
|
-0.028444579425681404
|
|
],
|
|
"predicted_position_m": [
|
|
0.2818242253683257,
|
|
-0.2557666927064896,
|
|
-0.025432423381026713
|
|
],
|
|
"error_m": [
|
|
-0.000648024175633255,
|
|
0.005926273650224356,
|
|
0.0030121560446546916
|
|
],
|
|
"error_norm_m": 0.0066793516711503124
|
|
},
|
|
{
|
|
"marker_id": 56,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.5319478990003119,
|
|
0.19615989469866074,
|
|
-0.08839852315212664
|
|
],
|
|
"predicted_position_m": [
|
|
0.5037746388264569,
|
|
0.17157557112637584,
|
|
-0.04278084140591921
|
|
],
|
|
"error_m": [
|
|
-0.02817326017385502,
|
|
-0.024584323572284905,
|
|
0.04561768174620743
|
|
],
|
|
"error_norm_m": 0.05898384899469341
|
|
},
|
|
{
|
|
"marker_id": 58,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.05263773316346281,
|
|
-0.2195902347522931,
|
|
-0.025837246052479043
|
|
],
|
|
"predicted_position_m": [
|
|
0.049009411644326,
|
|
-0.20779768176560154,
|
|
-0.03296862268918871
|
|
],
|
|
"error_m": [
|
|
-0.0036283215191368137,
|
|
0.011792552986691573,
|
|
-0.007131376636709666
|
|
],
|
|
"error_norm_m": 0.014250808949837483
|
|
},
|
|
{
|
|
"marker_id": 61,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
-0.010468475497631675,
|
|
0.3662280815277259,
|
|
-0.06404559133632555
|
|
],
|
|
"predicted_position_m": [
|
|
-0.01439283208295973,
|
|
0.34644084776416645,
|
|
-0.06308558759315597
|
|
],
|
|
"error_m": [
|
|
-0.0039243565853280555,
|
|
-0.019787233763559453,
|
|
0.0009600037431695824
|
|
],
|
|
"error_norm_m": 0.020195464882231715
|
|
},
|
|
{
|
|
"marker_id": 62,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.40559138862811783,
|
|
-0.17953646039262217,
|
|
-0.02809930470879158
|
|
],
|
|
"predicted_position_m": [
|
|
0.40419370849303327,
|
|
-0.17025967833482727,
|
|
-0.02721312353440715
|
|
],
|
|
"error_m": [
|
|
-0.001397680135084567,
|
|
0.009276782057794891,
|
|
0.0008861811743844303
|
|
],
|
|
"error_norm_m": 0.009423243188078538
|
|
},
|
|
{
|
|
"marker_id": 63,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.7926500687950983,
|
|
-0.24446677578818987,
|
|
-0.04113907432021252
|
|
],
|
|
"predicted_position_m": [
|
|
0.7757554261997703,
|
|
-0.23690592122668272,
|
|
-0.015699620886694507
|
|
],
|
|
"error_m": [
|
|
-0.016894642595327913,
|
|
0.007560854561507152,
|
|
0.025439453433518014
|
|
],
|
|
"error_norm_m": 0.03146047140651683
|
|
},
|
|
{
|
|
"marker_id": 64,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
-0.017282178971859352,
|
|
-0.19073077328091026,
|
|
-0.025430604301005477
|
|
],
|
|
"predicted_position_m": [
|
|
-0.021834431673870613,
|
|
-0.176872701518174,
|
|
-0.03610860049214109
|
|
],
|
|
"error_m": [
|
|
-0.004552252702011261,
|
|
0.013858071762736263,
|
|
-0.010677996191135613
|
|
],
|
|
"error_norm_m": 0.01807729958544759
|
|
},
|
|
{
|
|
"marker_id": 66,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.21263301706049903,
|
|
-0.3569197662886917,
|
|
-0.026198373904699056
|
|
],
|
|
"predicted_position_m": [
|
|
0.20623150165506418,
|
|
-0.35514160775885684,
|
|
-0.02191819801185144
|
|
],
|
|
"error_m": [
|
|
-0.006401515405434849,
|
|
0.0017781585298348723,
|
|
0.004280175892847616
|
|
],
|
|
"error_norm_m": 0.007903236863270524
|
|
},
|
|
{
|
|
"marker_id": 68,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.568908318504846,
|
|
0.168783134033783,
|
|
-0.014878715051728992
|
|
],
|
|
"predicted_position_m": [
|
|
0.5788292540408758,
|
|
0.17239787079977498,
|
|
-0.04119592555242797
|
|
],
|
|
"error_m": [
|
|
0.009920935536029796,
|
|
0.0036147367659919716,
|
|
-0.026317210500698983
|
|
],
|
|
"error_norm_m": 0.028356425239010184
|
|
},
|
|
{
|
|
"marker_id": 69,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.015276397339812184,
|
|
-0.2803025489116465,
|
|
-0.022472302322351357
|
|
],
|
|
"predicted_position_m": [
|
|
0.005510649546115061,
|
|
-0.2701576935695941,
|
|
-0.03067798440933005
|
|
],
|
|
"error_m": [
|
|
-0.009765747793697124,
|
|
0.010144855342052395,
|
|
-0.008205682086978694
|
|
],
|
|
"error_norm_m": 0.016297887543906795
|
|
},
|
|
{
|
|
"marker_id": 72,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.4344645786320449,
|
|
0.20076059834646234,
|
|
-0.033282529150906466
|
|
],
|
|
"predicted_position_m": [
|
|
0.4465264092455869,
|
|
0.1980681929781142,
|
|
-0.04539614201517998
|
|
],
|
|
"error_m": [
|
|
0.01206183061354199,
|
|
-0.0026924053683481386,
|
|
-0.012113612864273517
|
|
],
|
|
"error_norm_m": 0.01730538705267182
|
|
},
|
|
{
|
|
"marker_id": 73,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.2280285942240238,
|
|
0.326927327318932,
|
|
-0.021927544696064564
|
|
],
|
|
"predicted_position_m": [
|
|
0.22962253010294684,
|
|
0.3400004979286803,
|
|
-0.05746012660960818
|
|
],
|
|
"error_m": [
|
|
0.0015939358789230362,
|
|
0.01307317060974833,
|
|
-0.03553258191354361
|
|
],
|
|
"error_norm_m": 0.037894759516592685
|
|
},
|
|
{
|
|
"marker_id": 75,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
-0.01897376105846116,
|
|
0.2210651602764422,
|
|
-0.061160214612028016
|
|
],
|
|
"predicted_position_m": [
|
|
-0.019987203644106936,
|
|
0.20544680077663746,
|
|
-0.05589513413636127
|
|
],
|
|
"error_m": [
|
|
-0.0010134425856457747,
|
|
-0.015618359499804751,
|
|
0.005265080475666747
|
|
],
|
|
"error_norm_m": 0.016513064275136487
|
|
},
|
|
{
|
|
"marker_id": 79,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.3116125652513936,
|
|
-0.15945590072703794,
|
|
-0.029713543177476754
|
|
],
|
|
"predicted_position_m": [
|
|
0.3120899194987721,
|
|
-0.15288350019892974,
|
|
-0.03011150002654553
|
|
],
|
|
"error_m": [
|
|
0.00047735424737849197,
|
|
0.006572400528108202,
|
|
-0.000397956849068775
|
|
],
|
|
"error_norm_m": 0.006601718369719206
|
|
},
|
|
{
|
|
"marker_id": 82,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.21932045877576087,
|
|
0.4268343329675195,
|
|
-0.21261636270120143
|
|
],
|
|
"predicted_position_m": [
|
|
0.22646544327444398,
|
|
0.304221993790752,
|
|
-0.055673161470176646
|
|
],
|
|
"error_m": [
|
|
0.007144984498683116,
|
|
-0.1226123391767675,
|
|
0.1569432012310248
|
|
],
|
|
"error_norm_m": 0.19928874763650617
|
|
},
|
|
{
|
|
"marker_id": 83,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.056510878799190804,
|
|
0.3622085541805799,
|
|
-0.05601896829781385
|
|
],
|
|
"predicted_position_m": [
|
|
0.05221818580454903,
|
|
0.348810280462645,
|
|
-0.06176400343867677
|
|
],
|
|
"error_m": [
|
|
-0.0042926929946417725,
|
|
-0.013398273717934894,
|
|
-0.005745035140862921
|
|
],
|
|
"error_norm_m": 0.015196920100359194
|
|
},
|
|
{
|
|
"marker_id": 84,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.39654902460231006,
|
|
0.27302023311414586,
|
|
-0.03621211493070194
|
|
],
|
|
"predicted_position_m": [
|
|
0.41408958781511274,
|
|
0.26258576175293025,
|
|
-0.04944533142473166
|
|
],
|
|
"error_m": [
|
|
0.017540563212802673,
|
|
-0.010434471361215614,
|
|
-0.013233216494029719
|
|
],
|
|
"error_norm_m": 0.02432421775079757
|
|
},
|
|
{
|
|
"marker_id": 85,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.5020405503500432,
|
|
-0.31022845087045625,
|
|
-0.03030813015906365
|
|
],
|
|
"predicted_position_m": [
|
|
0.5017803060025984,
|
|
-0.3092325977374013,
|
|
-0.017890003926044614
|
|
],
|
|
"error_m": [
|
|
-0.00026024434744487124,
|
|
0.000995853133054947,
|
|
0.012418126233019036
|
|
],
|
|
"error_norm_m": 0.012460710642743773
|
|
},
|
|
{
|
|
"marker_id": 86,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.3649367159727088,
|
|
0.29161338660716574,
|
|
-0.027589353466630048
|
|
],
|
|
"predicted_position_m": [
|
|
0.370056694732192,
|
|
0.29680713079718124,
|
|
-0.05217486022752074
|
|
],
|
|
"error_m": [
|
|
0.005119978759483168,
|
|
0.0051937441900155035,
|
|
-0.024585506760890694
|
|
],
|
|
"error_norm_m": 0.025644420521795393
|
|
},
|
|
{
|
|
"marker_id": 92,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.6484004610823835,
|
|
-0.19081836450327513,
|
|
-0.027227519273113107
|
|
],
|
|
"predicted_position_m": [
|
|
0.6443353751026841,
|
|
-0.18365243834182884,
|
|
-0.021311120710433118
|
|
],
|
|
"error_m": [
|
|
-0.0040650859796993455,
|
|
0.00716592616144629,
|
|
0.005916398562679989
|
|
],
|
|
"error_norm_m": 0.010142938120984983
|
|
},
|
|
{
|
|
"marker_id": 95,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.18664780839225412,
|
|
-0.27257756326573884,
|
|
-0.02680824275380579
|
|
],
|
|
"predicted_position_m": [
|
|
0.1839918904792754,
|
|
-0.2657499110383315,
|
|
-0.027036200764427018
|
|
],
|
|
"error_m": [
|
|
-0.002655917912978728,
|
|
0.006827652227407333,
|
|
-0.00022795801062122645
|
|
],
|
|
"error_norm_m": 0.007329577051474933
|
|
},
|
|
{
|
|
"marker_id": 96,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.3694229184091224,
|
|
-0.1876350997118841,
|
|
-0.02906403105618304
|
|
],
|
|
"predicted_position_m": [
|
|
0.3690898694722732,
|
|
-0.181100244069962,
|
|
-0.027412172640893313
|
|
],
|
|
"error_m": [
|
|
-0.0003330489368492118,
|
|
0.006534855641922105,
|
|
0.0016518584152897288
|
|
],
|
|
"error_norm_m": 0.0067486217910963904
|
|
},
|
|
{
|
|
"marker_id": 97,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.300631545478839,
|
|
-0.35132615733892214,
|
|
-0.02884116071788578
|
|
],
|
|
"predicted_position_m": [
|
|
0.30085497208872897,
|
|
-0.35302984583077157,
|
|
-0.019975801386937803
|
|
],
|
|
"error_m": [
|
|
0.0002234266098899429,
|
|
-0.001703688491849431,
|
|
0.008865359330947977
|
|
],
|
|
"error_norm_m": 0.009030341632191633
|
|
},
|
|
{
|
|
"marker_id": 102,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.654913574999471,
|
|
-0.2275541941346384,
|
|
-0.0350778518574374
|
|
],
|
|
"predicted_position_m": [
|
|
0.6483081027262264,
|
|
-0.22182697671650253,
|
|
-0.019245290342345872
|
|
],
|
|
"error_m": [
|
|
-0.006605472273244595,
|
|
0.005727217418135866,
|
|
0.015832561515091527
|
|
],
|
|
"error_norm_m": 0.01808599699868269
|
|
},
|
|
{
|
|
"marker_id": 103,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.10557011807229084,
|
|
-0.18944239694498782,
|
|
-0.02808611771084624
|
|
],
|
|
"predicted_position_m": [
|
|
0.10510726012716916,
|
|
-0.17829043906142777,
|
|
-0.033282348035566865
|
|
],
|
|
"error_m": [
|
|
-0.0004628579451216863,
|
|
0.011151957883560049,
|
|
-0.005196230324720625
|
|
],
|
|
"error_norm_m": 0.012311832182969584
|
|
},
|
|
{
|
|
"marker_id": 105,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.5235393548738532,
|
|
-0.2667684541208949,
|
|
-0.02958428254015119
|
|
],
|
|
"predicted_position_m": [
|
|
0.5227951312590223,
|
|
-0.2631094373451257,
|
|
-0.019826184411018216
|
|
],
|
|
"error_m": [
|
|
-0.0007442236148308412,
|
|
0.003659016775769186,
|
|
0.009758098129132975
|
|
],
|
|
"error_norm_m": 0.010448097992075911
|
|
},
|
|
{
|
|
"marker_id": 114,
|
|
"link": "Arm2",
|
|
"observed_position_m": [
|
|
0.27011300895325113,
|
|
-0.2806883445351331,
|
|
0.2554391856330546
|
|
],
|
|
"predicted_position_m": [
|
|
0.25533097100129737,
|
|
-0.11781772333346427,
|
|
0.19866687076756162
|
|
],
|
|
"error_m": [
|
|
-0.014782037951953764,
|
|
0.1628706212016688,
|
|
-0.056772314865493
|
|
],
|
|
"error_norm_m": 0.17311396140062527
|
|
},
|
|
{
|
|
"marker_id": 115,
|
|
"link": "Arm2",
|
|
"observed_position_m": [
|
|
0.30309549136602143,
|
|
-0.2183658044981254,
|
|
0.2199084065832282
|
|
],
|
|
"predicted_position_m": [
|
|
0.2358772311823024,
|
|
-0.073679718013855,
|
|
0.18754758601309227
|
|
],
|
|
"error_m": [
|
|
-0.06721826018371904,
|
|
0.1446860864842704,
|
|
-0.03236082057013592
|
|
],
|
|
"error_norm_m": 0.16278691849234217
|
|
},
|
|
{
|
|
"marker_id": 120,
|
|
"link": "Arm2",
|
|
"observed_position_m": [
|
|
0.2747772974053062,
|
|
-0.22853496955651423,
|
|
0.27892047845268714
|
|
],
|
|
"predicted_position_m": [
|
|
0.2566065135491158,
|
|
-0.1343859057684713,
|
|
0.13066783899512674
|
|
],
|
|
"error_m": [
|
|
-0.01817078385619042,
|
|
0.09414906378804294,
|
|
-0.1482526394575604
|
|
],
|
|
"error_norm_m": 0.17655896664923806
|
|
},
|
|
{
|
|
"marker_id": 205,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.7358310059489888,
|
|
-0.10856622221598583,
|
|
0.03597387369483752
|
|
],
|
|
"predicted_position_m": [
|
|
0.7501638786079469,
|
|
-0.08912197428897047,
|
|
0.0037251112701953155
|
|
],
|
|
"error_m": [
|
|
0.014332872658958107,
|
|
0.019444247927015365,
|
|
-0.032248762424642204
|
|
],
|
|
"error_norm_m": 0.04029258857440367
|
|
},
|
|
{
|
|
"marker_id": 206,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.6484689754258008,
|
|
-0.006962133622841689,
|
|
0.0037667549785326865
|
|
],
|
|
"predicted_position_m": [
|
|
0.651512240319729,
|
|
-0.007713180188276315,
|
|
-0.002635903281069312
|
|
],
|
|
"error_m": [
|
|
0.0030432648939281437,
|
|
-0.0007510465654346253,
|
|
-0.006402658259601998
|
|
],
|
|
"error_norm_m": 0.007128784254507659
|
|
},
|
|
{
|
|
"marker_id": 207,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.7493665623567823,
|
|
-0.0039605799295579095,
|
|
0.002903611354708307
|
|
],
|
|
"predicted_position_m": [
|
|
0.7514753582778212,
|
|
-0.009238601096298147,
|
|
-0.00038909684750553994
|
|
],
|
|
"error_m": [
|
|
0.002108795921038853,
|
|
-0.005278021166740238,
|
|
-0.003292708202213847
|
|
],
|
|
"error_norm_m": 0.006568596119268898
|
|
},
|
|
{
|
|
"marker_id": 208,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.3497454348907566,
|
|
-0.08899526410856817,
|
|
0.005324093210496179
|
|
],
|
|
"predicted_position_m": [
|
|
0.35031140677557776,
|
|
-0.08302029065688313,
|
|
-0.005262114464059768
|
|
],
|
|
"error_m": [
|
|
0.0005659718848211592,
|
|
0.005974973451685045,
|
|
-0.010586207674555946
|
|
],
|
|
"error_norm_m": 0.012169158756938638
|
|
},
|
|
{
|
|
"marker_id": 210,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.018056729001286097,
|
|
-0.016963352423673847,
|
|
0.003416246244520705
|
|
],
|
|
"predicted_position_m": [
|
|
0.0215806622250132,
|
|
-0.0080884501168228,
|
|
-0.01627650779780846
|
|
],
|
|
"error_m": [
|
|
0.0035239332237271027,
|
|
0.008874902306851047,
|
|
-0.019692754042329164
|
|
],
|
|
"error_norm_m": 0.0218857615378837
|
|
},
|
|
{
|
|
"marker_id": 211,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.24979889989544124,
|
|
-0.009148348688355755,
|
|
0.005082607711960607
|
|
],
|
|
"predicted_position_m": [
|
|
0.25165976848735977,
|
|
-0.0016114965561889781,
|
|
-0.011623129015324394
|
|
],
|
|
"error_m": [
|
|
0.0018608685919185297,
|
|
0.007536852132166777,
|
|
-0.016705736727285002
|
|
],
|
|
"error_norm_m": 0.018421417197921956
|
|
},
|
|
{
|
|
"marker_id": 214,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.3500544113591894,
|
|
-0.008882745216276952,
|
|
0.004532619096457205
|
|
],
|
|
"predicted_position_m": [
|
|
0.35162288644545203,
|
|
-0.0031369174642108125,
|
|
-0.009376322581760623
|
|
],
|
|
"error_m": [
|
|
0.0015684750862626218,
|
|
0.00574582775206614,
|
|
-0.013908941678217828
|
|
],
|
|
"error_norm_m": 0.01513054226591714
|
|
},
|
|
{
|
|
"marker_id": 215,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.249503157587321,
|
|
-0.08871170851340911,
|
|
0.004405453035841749
|
|
],
|
|
"predicted_position_m": [
|
|
0.25034828881748544,
|
|
-0.0814948697488613,
|
|
-0.007508920897623539
|
|
],
|
|
"error_m": [
|
|
0.000845131230164442,
|
|
0.007216838764547803,
|
|
-0.011914373933465288
|
|
],
|
|
"error_norm_m": 0.013955261186237836
|
|
},
|
|
{
|
|
"marker_id": 217,
|
|
"link": "Board",
|
|
"observed_position_m": [
|
|
0.6542153756315782,
|
|
-0.10517381265456333,
|
|
0.0058557507960332305
|
|
],
|
|
"predicted_position_m": [
|
|
0.6502007606498547,
|
|
-0.08759655338094864,
|
|
0.0014783048366315433
|
|
],
|
|
"error_m": [
|
|
-0.004014614981723508,
|
|
0.017577259273614684,
|
|
-0.004377445959401687
|
|
],
|
|
"error_norm_m": 0.01855368454379977
|
|
},
|
|
{
|
|
"marker_id": 218,
|
|
"link": "Arm2",
|
|
"observed_position_m": [
|
|
0.23388206605265666,
|
|
-0.2685595069335859,
|
|
0.29745892987522343
|
|
],
|
|
"predicted_position_m": [
|
|
0.2833888700976032,
|
|
-0.1339754609325824,
|
|
0.13107022281846548
|
|
],
|
|
"error_m": [
|
|
0.04950680404494656,
|
|
0.1345840460010035,
|
|
-0.16638870705675796
|
|
],
|
|
"error_norm_m": 0.21965652942893496
|
|
},
|
|
{
|
|
"marker_id": 219,
|
|
"link": "Arm2",
|
|
"observed_position_m": [
|
|
0.2366779781060393,
|
|
-0.34009447067696785,
|
|
0.2571150778625261
|
|
],
|
|
"predicted_position_m": [
|
|
0.2814391122030808,
|
|
-0.10864981063907166,
|
|
0.2350115999563302
|
|
],
|
|
"error_m": [
|
|
0.04476113409704152,
|
|
0.2314446600378962,
|
|
-0.02210347790619588
|
|
],
|
|
"error_norm_m": 0.23676729825138515
|
|
},
|
|
{
|
|
"marker_id": 243,
|
|
"link": "Arm1",
|
|
"observed_position_m": [
|
|
0.18144888543595428,
|
|
-0.15012189717150226,
|
|
0.31356047178317653
|
|
],
|
|
"predicted_position_m": [
|
|
0.18126860236063563,
|
|
-0.16266377614189548,
|
|
0.00832619273972722
|
|
],
|
|
"error_m": [
|
|
-0.00018028307531864352,
|
|
-0.012541878970393217,
|
|
-0.3052342790434493
|
|
],
|
|
"error_norm_m": 0.3054918924182269
|
|
},
|
|
{
|
|
"marker_id": 246,
|
|
"link": "Ellbow",
|
|
"observed_position_m": [
|
|
0.24681312269481184,
|
|
-0.19475871568678893,
|
|
0.34124060233255904
|
|
],
|
|
"predicted_position_m": [
|
|
0.27237933182351887,
|
|
-0.09527455654199339,
|
|
0.006138344269945348
|
|
],
|
|
"error_m": [
|
|
0.025566209128707024,
|
|
0.09948415914479554,
|
|
-0.3351022580626137
|
|
],
|
|
"error_norm_m": 0.3504914440162874
|
|
},
|
|
{
|
|
"marker_id": 247,
|
|
"link": "Ellbow",
|
|
"observed_position_m": [
|
|
0.2356376595025085,
|
|
-0.14385826652268258,
|
|
0.317961382630903
|
|
],
|
|
"predicted_position_m": [
|
|
0.23489316258933635,
|
|
-0.09470252370148677,
|
|
0.005295791857361229
|
|
],
|
|
"error_m": [
|
|
-0.0007444969131721602,
|
|
0.04915574282119581,
|
|
-0.3126655907735418
|
|
],
|
|
"error_norm_m": 0.31650689247112007
|
|
}
|
|
]
|
|
} |