{ "schema_version": "1.0", "method": "deterministic_geometric_sequential_prefix", "created_utc": "2026-05-31T15:26:02Z", "root_pose": { "translation_m": [ -0.00046214795569454736, -0.00017020638219900075, 2.78037095616801e-05 ], "rotation_matrix": [ [ 0.9999987338759255, -0.0015265195690963864, 0.00044942691365565705 ], [ 0.001526096918607417, 0.9999983944018295, 0.0009392667123096465 ], [ -0.0004508600010735703, -0.0009385796540533794, 0.9999994578965994 ] ], "euler_xyz_deg": [ -0.05377666627542511, 0.025832376087957656, 0.08743895539169366 ] }, "movements": { "x": { "value_m": 0.062193217768473155, "value_mm": 62.193217768473154, "joint_type": "linear", "link": "Base" }, "y": { "value_rad": 0.2785909012460954, "value_deg": 15.962082852147175, "joint_type": "revolute", "link": "Arm1" }, "z": { "value_rad": -0.5275290928597367, "value_deg": -30.225190591227804, "joint_type": "revolute", "link": "Ellbow" }, "a": { "value_rad": -1.6690886156018152, "value_deg": -95.63173330731742, "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.00046214795569454736, -0.00017020638219900075, 2.78037095616801e-05 ], "rotation_matrix": [ [ 0.9999987338759255, -0.0015265195690963864, 0.00044942691365565705 ], [ 0.001526096918607417, 0.9999983944018295, 0.0009392667123096465 ], [ -0.0004508600010735703, -0.0009385796540533794, 0.9999994578965994 ] ] }, "Base": { "translation_m": [ 0.06173818189900462, -6.026523680739439e-05, 0.015999754601677435 ], "rotation_matrix": [ [ 0.9999987338759255, -0.0015265195690963864, 0.00044942691365565705 ], [ 0.001526096918607417, 0.9999983944018295, 0.0009392667123096465 ], [ -0.0004508600010735703, -0.0009385796540533794, 0.9999994578965994 ] ] }, "Arm1": { "translation_m": [ 0.17159340272300852, 0.10814969902169094, 0.06084876900426855 ], "rotation_matrix": [ [ 0.9999987338758484, -0.0015912558418221285, 1.2304122026090454e-05 ], [ 0.0015260969186072992, 0.9611840533447328, 0.27590376333756744 ], [ -0.0004508600010735355, -0.275903395231888, 0.9611852647771006 ] ] }, "Ellbow": { "translation_m": [ 0.17199121668346407, -0.13214631431449225, 0.12982461781224056 ], "rotation_matrix": [ [ 0.9999987338755765, -0.001368736383471783, 0.0008116694266209518 ], [ 0.0015260969186068841, 0.9694044268166506, -0.24546431165409138 ], [ -0.00045086000107341293, 0.24546523955202806, 0.969405288254746 ] ] }, "Arm2": { "translation_m": [ 0.26199110273226595, -0.13200896559181763, 0.12978404041214395 ], "rotation_matrix": [ [ -0.09894171956302104, -0.001368736383468777, 0.9950922885280268 ], [ 0.2441297426203538, 0.9694044268145217, 0.02560714813528309 ], [ -0.9646819190258483, 0.245465239551489, -0.09558039168026557 ] ] }, "Hand": { "translation_m": [ 0.2623332868281331, -0.37436007229544804, 0.06841773052427169 ], "rotation_matrix": [ [ -0.09894171956302104, -0.001368736383468777, 0.9950922885280268 ], [ 0.2441297426203538, 0.9694044268145217, 0.02560714813528309 ], [ -0.9646819190258483, 0.245465239551489, -0.09558039168026557 ] ] }, "Palm": { "translation_m": [ 0.2623332868281331, -0.37436007229544804, 0.06841773052427169 ], "rotation_matrix": [ [ -0.09894171956302104, -0.001368736383468777, 0.9950922885280268 ], [ 0.2441297426203538, 0.9694044268145217, 0.02560714813528309 ], [ -0.9646819190258483, 0.245465239551489, -0.09558039168026557 ] ] }, "FingerA": { "translation_m": [ 0.2619854257233024, -0.4073127082634749, 0.05596771946386618 ], "rotation_matrix": [ [ -0.09894171956302104, -0.001368736383468777, 0.9950922885280268 ], [ 0.2441297426203538, 0.9694044268145217, 0.02560714813528309 ], [ -0.9646819190258483, 0.245465239551489, -0.09558039168026557 ] ] }, "FingerB": { "translation_m": [ 0.2627769594798066, -0.40926574620443773, 0.06368517481607297 ], "rotation_matrix": [ [ -0.09894171956302104, -0.001368736383468777, 0.9950922885280268 ], [ 0.2441297426203538, 0.9694044268145217, 0.02560714813528309 ], [ -0.9646819190258483, 0.245465239551489, -0.09558039168026557 ] ] } }, "stage_reports": [ { "method": "deterministic_geometric_prefix", "active_links": [ "Board", "Base", "Arm1" ], "active_observations": 45, "joint_updates": [ { "pass": 0, "updates": [ { "link": "Base", "joint_variable": "x", "joint_type": "linear", "old": 0.0, "new": 0.04825529566378554, "info": { "reason": "weighted_projection", "used_markers": 3, "axis_world": [ 0.9999987338749258, 0.001526096918605891, -0.00045086000107311954 ], "per_marker": [ { "marker_id": 198, "q_i": 0.024425878174431717, "weight": 1.0 }, { "marker_id": 229, "q_i": 0.059984792133436104, "weight": 1.0 }, { "marker_id": 243, "q_i": 0.06035521668348879, "weight": 1.0 } ] } }, { "link": "Arm1", "joint_variable": "y", "joint_type": "revolute", "old": 0.0, "new": 0.09284449797145955, "info": { "reason": "2d_alignment+normal_tiebreak", "used_markers": 3, "axis_world": [ -0.9999987338749258, -0.001526096918605891, 0.00045086000107311954 ], "axis_id": 0, "theta_rad": 0.0928444979714596, "theta_alt_rad": -3.048748155618334, "score_theta": 0.007335579008519118, "score_theta_alt": 0.87919416514466, "best_score": 0.007335579008519118, "per_marker": [ { "marker_id": 198, "weight": 1.0 }, { "marker_id": 229, "weight": 1.0 }, { "marker_id": 243, "weight": 1.0 } ] } } ] }, { "pass": 1, "updates": [ { "link": "Base", "joint_variable": "x", "joint_type": "linear", "old": 0.04825529566378554, "new": 0.04825529566378553, "info": { "reason": "weighted_projection", "used_markers": 3, "axis_world": [ 0.9999987338749258, 0.001526096918605891, -0.00045086000107311954 ], "per_marker": [ { "marker_id": 198, "q_i": 0.02442587817443171, "weight": 1.0 }, { "marker_id": 229, "q_i": 0.0599847921334361, "weight": 1.0 }, { "marker_id": 243, "q_i": 0.06035521668348878, "weight": 1.0 } ] } }, { "link": "Arm1", "joint_variable": "y", "joint_type": "revolute", "old": 0.09284449797145955, "new": 0.09284449797145955, "info": { "reason": "2d_alignment+normal_tiebreak", "used_markers": 3, "axis_world": [ -0.9999987338749258, -0.001526096918605891, 0.00045086000107311954 ], "axis_id": 0, "theta_rad": 0.0928444979714596, "theta_alt_rad": -3.048748155618334, "score_theta": 0.007335579008519118, "score_theta_alt": 0.87919416514466, "best_score": 0.007335579008519118, "per_marker": [ { "marker_id": 198, "weight": 1.0 }, { "marker_id": 229, "weight": 1.0 }, { "marker_id": 243, "weight": 1.0 } ] } } ] } ], "root_link": "Board", "root_pose": { "reason": "kabsch", "used_markers": [ 210, 211, 214, 208, 206, 205, 217, 46, 47, 48, 51, 53, 54, 55, 56, 57, 58, 59, 61, 62, 63, 64, 66, 68, 69, 71, 72, 75, 76, 79, 82, 83, 84, 85, 86, 92, 95, 96, 97, 102, 103, 105 ] }, "marker_stats": { "num_markers_used": 45, "mean_error_m": 0.0062934177212923565, "rms_error_m": 0.013026734619185366, "median_error_m": 0.0030394028927430753, "worst_error_m": 0.053336052775682506 }, "marker_reports": [ { "marker_id": 46, "link": "Board", "error_m": [ 0.00247848233341863, 0.002480551242752732, -0.0037562209106966615 ], "error_norm_m": 0.00513859948574952, "predicted_m": [ 0.5359518253592175, 0.186062925371616, -0.027688212773239337 ], "observed_m": [ 0.5334733430257989, 0.18358237412886327, -0.023931991862542676 ] }, { "marker_id": 47, "link": "Board", "error_m": [ 8.622522667534049e-07, -0.0008018281583023756, -0.00011322576502810142 ], "error_norm_m": 0.0008097834357355984, "predicted_m": [ 0.3441925557690014, -0.28621005995305304, -0.027158440415112586 ], "observed_m": [ 0.3441916935167346, -0.28540823179475067, -0.027045214650084484 ] }, { "marker_id": 48, "link": "Board", "error_m": [ 0.001222503786411866, -0.00034436356996364603, -0.0006783978837431315 ], "error_norm_m": 0.001439904672114309, "predicted_m": [ 0.6887042960787745, -0.31986432572912415, -0.02728166299850684 ], "observed_m": [ 0.6874817922923626, -0.3195199621591605, -0.02660326511476371 ] }, { "marker_id": 51, "link": "Board", "error_m": [ -0.0010260852575597057, 0.00115368172715552, -0.0010107131683654638 ], "error_norm_m": 0.001845365435912699, "predicted_m": [ 0.16758805372139304, -0.17201949300916958, -0.027186325012326124 ], "observed_m": [ 0.16861413897895275, -0.1731731747363251, -0.02617561184396066 ] }, { "marker_id": 53, "link": "Board", "error_m": [ -0.0002309238554006332, 0.0016196361291773986, -0.0021780679962964122 ], "error_norm_m": 0.002724064465907609, "predicted_m": [ 0.4854509785233864, 0.21278587549107209, -0.027690616312313798 ], "observed_m": [ 0.48568190237878706, 0.2111662393618947, -0.025512548316017385 ] }, { "marker_id": 54, "link": "Board", "error_m": [ 0.0013273086982619198, -0.0008833898753587421, -0.0007052468733528376 ], "error_norm_m": 0.0017434159586117248, "predicted_m": [ 0.34229980143762323, -0.3302629803764141, -0.027116212295749426 ], "observed_m": [ 0.3409724927393613, -0.32937959050105536, -0.026410965422396588 ] }, { "marker_id": 55, "link": "Board", "error_m": [ 0.00015464224124767112, -0.00040737140962726626, 4.432470429710858e-05 ], "error_norm_m": 0.00043798443758977896, "predicted_m": [ 0.2836460569732936, -0.26234244254773015, -0.02715364724495874 ], "observed_m": [ 0.2834914147320459, -0.2619350711381029, -0.02719797194925585 ] }, { "marker_id": 56, "link": "Board", "error_m": [ 0.002556545333326221, 0.0023022017103751236, -0.003549407389282104 ], "error_norm_m": 0.004943111325035744, "predicted_m": [ 0.49794747324308974, 0.16923491483168265, -0.027655326586600037 ], "observed_m": [ 0.4953909279097635, 0.16693271312130753, -0.024105919197317933 ] }, { "marker_id": 57, "link": "Board", "error_m": [ 0.0002982253734815643, 0.00040862735301733233, -0.00016043637050819348 ], "error_norm_m": 0.0005307113302012803, "predicted_m": [ 0.6029405488431328, -0.3633252410570794, -0.027202297028204564 ], "observed_m": [ 0.6026423234696512, -0.36373386841009675, -0.02704186065769637 ] }, { "marker_id": 58, "link": "Board", "error_m": [ -0.0019953638476404023, 0.002995337372694057, -0.0015399655384435024 ], "error_norm_m": 0.00391471796178494, "predicted_m": [ 0.04994846845262338, -0.21822905597177505, -0.02709005146012368 ], "observed_m": [ 0.05194383230026378, -0.2212243933444691, -0.025550085921680177 ] }, { "marker_id": 59, "link": "Board", "error_m": [ 0.0015083415703128766, 8.844730424206748e-05, -0.00022845699277860773 ], "error_norm_m": 0.0015281066114348986, "predicted_m": [ 0.6261603071598917, -0.2779897436515538, -0.027292885453720384 ], "observed_m": [ 0.6246519655895788, -0.2780781909557959, -0.027064428460941776 ] }, { "marker_id": 61, "link": "Board", "error_m": [ 0.002317168880300112, -0.009041164839785842, 0.0034940530228994814 ], "error_norm_m": 0.00996595905103187, "predicted_m": [ -0.02340703999082524, 0.3355993973356062, -0.02757727641501216 ], "observed_m": [ -0.02572420887112535, 0.344640562175392, -0.031071329437911643 ] }, { "marker_id": 62, "link": "Board", "error_m": [ 0.00022906225585306306, -0.0020322998492257327, 0.0007121030769661092 ], "error_norm_m": 0.002165595296089283, "predicted_m": [ 0.4044923638656985, -0.17467795580024498, -0.02729029923602521 ], "observed_m": [ 0.4042633016098454, -0.17264565595101924, -0.02800240231299132 ] }, { "marker_id": 63, "link": "Board", "error_m": [ 0.0017975538906517263, -0.0016599731341800372, 0.0003579334200452394 ], "error_norm_m": 0.002472817649803951, "predicted_m": [ 0.7772850860009493, -0.2351590814569117, -0.02740103447054537 ], "observed_m": [ 0.7754875321102975, -0.23349910832273166, -0.02775896789059061 ] }, { "marker_id": 64, "link": "Board", "error_m": [ -0.0018049655116158213, 0.0034585745773775267, -0.0019042493400182187 ], "error_norm_m": 0.004341175434644921, "predicted_m": [ -0.02145705360148727, -0.1884580062231602, -0.027085922850510185 ], "observed_m": [ -0.01965208808987145, -0.19191658080053772, -0.025181673510491966 ] }, { "marker_id": 66, "link": "Board", "error_m": [ 0.0010150037218127628, 0.0016560925901293877, 0.0002942349360347471 ], "error_norm_m": 0.001964548146510692, "predicted_m": [ 0.2098297948231209, -0.3631051663333437, -0.02702582908849886 ], "observed_m": [ 0.20881479110130813, -0.3647612589234731, -0.027320064024533606 ] }, { "marker_id": 68, "link": "Board", "error_m": [ 0.002296459000075579, 0.002003700948126602, -0.003196399181546579 ], "error_norm_m": 0.004416504178232283, "predicted_m": [ 0.572994370976927, 0.17131944524239573, -0.02769101263159909 ], "observed_m": [ 0.5706979119768514, 0.16931574429426913, -0.02449461345005251 ] }, { "marker_id": 69, "link": "Board", "error_m": [ -0.0027030804757261547, 0.0034613824966199247, -0.0020951137947462853 ], "error_norm_m": 0.004865934099337443, "predicted_m": [ 0.0075648456223840425, -0.2813937832556329, -0.027011674551107305 ], "observed_m": [ 0.010267926098110197, -0.28485516575225284, -0.02491656075636102 ] }, { "marker_id": 71, "link": "Board", "error_m": [ 0.002340371150828302, -0.00208329024796039, -0.002769954907047758 ], "error_norm_m": 0.004182114963502822, "predicted_m": [ 0.749708180235857, -0.2830612011927827, -0.027343647769272693 ], "observed_m": [ 0.7473678090850286, -0.28097791094482233, -0.024573692862224935 ] }, { "marker_id": 72, "link": "Board", "error_m": [ -0.000853438340772561, 0.0030842027285443996, -0.003184448295048794 ], "error_norm_m": 0.004514573558609995, "predicted_m": [ 0.4402183910588402, 0.19479683311685514, -0.02765339104126457 ], "observed_m": [ 0.44107182939961276, 0.19171263038831074, -0.024468942746215777 ] }, { "marker_id": 75, "link": "Board", "error_m": [ 0.001957623091231764, -0.0019278901142832094, 0.0006942250988448279 ], "error_norm_m": 0.002833901365245595, "predicted_m": [ -0.02647141494880341, 0.19434461852845472, -0.0274432232180736 ], "observed_m": [ -0.028429038040035173, 0.19627250864273793, -0.028137448316918428 ] }, { "marker_id": 76, "link": "Board", "error_m": [ 0.0022496021647839815, -0.0013624322648640164, -0.0015234954441256804 ], "error_norm_m": 0.0030394028927430753, "predicted_m": [ 0.6844800916645605, 0.1676495806923791, -0.02773767035864721 ], "observed_m": [ 0.6822304894997765, 0.1690120129572431, -0.02621417491452153 ] }, { "marker_id": 79, "link": "Board", "error_m": [ -3.2644454626862274e-05, -0.00032889767771107636, -0.0004293674395318449 ], "error_norm_m": 0.0005418447572430288, "predicted_m": [ 0.3120680718076531, -0.15882899282903906, -0.027263647660594328 ], "observed_m": [ 0.31210071626228, -0.15850009515132799, -0.026834280221062483 ] }, { "marker_id": 82, "link": "Board", "error_m": [ -0.0016063483957248215, -0.0019448955386594524, 0.0004559909894188627 ], "error_norm_m": 0.0025633769927921922, "predicted_m": [ 0.21823156252909226, 0.2973781337892367, -0.027649975385221594 ], "observed_m": [ 0.21983791092481708, 0.2993230293278962, -0.028105966374640457 ] }, { "marker_id": 83, "link": "Board", "error_m": [ 0.0023473643195766336, -0.009390926996671933, 0.00466884006141147 ], "error_norm_m": 0.010746985466849943, "predicted_m": [ 0.04316770080929464, 0.3390909994254693, -0.02761047645891088 ], "observed_m": [ 0.04082033648971801, 0.3484819264221412, -0.03227931652032235 ] }, { "marker_id": 84, "link": "Board", "error_m": [ -0.0016925204087820944, 0.0026534383956161034, -0.0026765572223701045 ], "error_norm_m": 0.004131503263715913, "predicted_m": [ 0.40662058356961767, 0.25884560595123907, -0.027698450187053428 ], "observed_m": [ 0.40831310397839976, 0.25619216755562296, -0.025021892964683323 ] }, { "marker_id": 85, "link": "Board", "error_m": [ 0.001308871363822628, -0.00040202731324173735, -0.0005277034864782162 ], "error_norm_m": 0.001467392645909247, "predicted_m": [ 0.5045823628239121, -0.31217530822942635, -0.027206135643551992 ], "observed_m": [ 0.5032734914600895, -0.3117732809161846, -0.026678432157073776 ] }, { "marker_id": 86, "link": "Board", "error_m": [ -0.0012797745658206794, 0.0032209456420222438, -0.0035178219050914818 ], "error_norm_m": 0.004938358505022196, "predicted_m": [ 0.36196936424642545, 0.2923674880966266, -0.0277098687215852 ], "observed_m": [ 0.36324913881224613, 0.28914654245460436, -0.024192046816493718 ] }, { "marker_id": 92, "link": "Board", "error_m": [ 0.00042903246025560726, 0.0008769406715817551, 0.00015952561792148892 ], "error_norm_m": 0.0009892129276351334, "predicted_m": [ 0.6448969278027353, -0.18405108172345475, -0.027389539705852808 ], "observed_m": [ 0.6444678953424797, -0.1849280223950365, -0.027549065323774297 ] }, { "marker_id": 95, "link": "Board", "error_m": [ -0.0009572559327626629, 0.0011652592815823981, -0.0013464831664510638 ], "error_norm_m": 0.002021678765694324, "predicted_m": [ 0.18598372035814206, -0.27398149324641674, -0.027098822959828805 ], "observed_m": [ 0.18694097629090473, -0.27514675252799914, -0.02575233979337774 ] }, { "marker_id": 96, "link": "Board", "error_m": [ -0.0002241252283569084, -0.0007436603001124142, 0.00020477377243741449 ], "error_norm_m": 0.0008032403487298011, "predicted_m": [ 0.3695797951493044, -0.1861212440778488, -0.027263860273928044 ], "observed_m": [ 0.3698039203776613, -0.1853775837777364, -0.02746863404636546 ] }, { "marker_id": 97, "link": "Board", "error_m": [ 0.0011343088744122931, -0.0006360036375622213, -0.0003257724968691311 ], "error_norm_m": 0.0013406285724536864, "predicted_m": [ 0.30442424063811746, -0.35940080328077295, -0.027071821788168846 ], "observed_m": [ 0.30328993176370517, -0.35876479964321073, -0.026746049291299714 ] }, { "marker_id": 102, "link": "Board", "error_m": [ -0.00011679865515434873, 0.000798845574683682, -0.0005578100567627184 ], "error_norm_m": 0.00098129925989129, "predicted_m": [ 0.6495551739653214, -0.22220400040800298, -0.02735579746225907 ], "observed_m": [ 0.6496719726204757, -0.22300284598268666, -0.02679798740549635 ] }, { "marker_id": 103, "link": "Board", "error_m": [ -0.0010910444459660135, 0.0014077448646367674, -0.0009806084762537769 ], "error_norm_m": 0.0020331543401043684, "predicted_m": [ 0.10552199183590182, -0.1877442232713465, -0.02714366111486661 ], "observed_m": [ 0.10661303628186783, -0.18915196813598326, -0.026163052638612832 ] }, { "marker_id": 105, "link": "Board", "error_m": [ 0.0014403492478269886, -0.00045720635970131207, -0.00018752901785983392 ], "error_norm_m": 0.001522764178593183, "predicted_m": [ 0.5247713540122755, -0.26564446416617027, -0.027258914021087224 ], "observed_m": [ 0.5233310047644485, -0.26518725780646896, -0.02707138500322739 ] }, { "marker_id": 198, "link": "Arm1", "error_m": [ 0.02383335353746574, 0.007474876188730786, 0.033964551488457576 ], "error_norm_m": 0.042160328185283036, "predicted_m": [ 0.15791606495974195, -0.047890651702550406, 0.11068454982649235 ], "observed_m": [ 0.1340827114222762, -0.05536552789128119, 0.07671999833803478 ] }, { "marker_id": 205, "link": "Board", "error_m": [ -0.006395818565922973, -0.002733018913535626, 0.009679113250394951 ], "error_norm_m": 0.011918939584708011, "predicted_m": [ 0.7496744240405424, -0.0890252074093944, 7.413071499028628e-05 ], "observed_m": [ 0.7560702426064654, -0.08629218849585878, -0.009604982535404665 ] }, { "marker_id": 206, "link": "Board", "error_m": [ -0.0014881792652856607, 1.4057368443648466e-05, 0.00323139336615946 ], "error_norm_m": 0.0035576366062448107, "predicted_m": [ 0.6495524290874222, -0.009177945549108781, 4.413034277337299e-05 ], "observed_m": [ 0.6510406083527078, -0.00919200291755243, -0.003187263023386087 ] }, { "marker_id": 208, "link": "Board", "error_m": [ -0.0008496576928241351, -0.0013676740350954814, 0.003630398282259455 ], "error_norm_m": 0.003971428225346896, "predicted_m": [ 0.3496749304901722, -0.08963564617683736, 0.0002544747154197144 ], "observed_m": [ 0.3505245881829963, -0.08826797214174188, -0.0033759235668397404 ] }, { "marker_id": 210, "link": "Board", "error_m": [ -0.00025861804113453193, 0.0023805563621476476, 0.0028815862683752554 ], "error_norm_m": 0.003746661354679755, "predicted_m": [ 0.01956849194127999, -0.02013937055184975, 0.0003375579399902561 ], "observed_m": [ 0.01982710998241452, -0.022519926913997398, -0.002544028328384999 ] }, { "marker_id": 211, "link": "Board", "error_m": [ -0.004533518798538971, 0.0026669382590026915, 0.0017103444337853591 ], "error_norm_m": 0.005530879718111678, "predicted_m": [ 0.24955293553705188, -0.009788384316551749, 0.00022447434320280112 ], "observed_m": [ 0.25408645433559085, -0.01245532257555444, -0.001485870090582558 ] }, { "marker_id": 214, "link": "Board", "error_m": [ -5.1240843096100885e-05, -0.0013616926196595037, 0.003205085665592703 ], "error_norm_m": 0.0034827297538316377, "predicted_m": [ 0.34955280892464446, -0.009635774624691007, 0.00017938834309544406 ], "observed_m": [ 0.34960404976774057, -0.008274082005031503, -0.003025697322497259 ] }, { "marker_id": 217, "link": "Board", "error_m": [ -0.001218279427446456, 1.284425557357416e-05, 0.003719527151852844 ], "error_norm_m": 0.00391398160082684, "predicted_m": [ 0.6496745506529499, -0.08917781710125514, 0.00011921671509764334 ], "observed_m": [ 0.6508928300803963, -0.08919066135682871, -0.0036003104367552004 ] }, { "marker_id": 229, "link": "Arm1", "error_m": [ -0.011705946031395437, -6.847656979408479e-05, 0.05203557114282341 ], "error_norm_m": 0.053336052775682506, "predicted_m": [ 0.1580566100227748, -0.13749504460669237, 0.11911265871077119 ], "observed_m": [ 0.16976255605417023, -0.1374265680368983, 0.06707708756794778 ] }, { "marker_id": 243, "link": "Arm1", "error_m": [ -0.012085713044976965, 0.004249893357450546, 0.04593227599492125 ], "error_norm_m": 0.04768542787297654, "predicted_m": [ 0.1581005576317442, -0.17561881579473437, 0.08754406452272659 ], "observed_m": [ 0.17018627067672115, -0.17986870915218492, 0.04161178852780534 ] } ], "stage_idx": 0, "num_active_links": 3 }, { "method": "deterministic_geometric_prefix", "active_links": [ "Board", "Base", "Arm1", "Ellbow" ], "active_observations": 47, "joint_updates": [ { "pass": 0, "updates": [ { "link": "Base", "joint_variable": "x", "joint_type": "linear", "old": 0.04825529566378553, "new": 0.0429243518347913, "info": { "reason": "weighted_projection", "used_markers": 5, "axis_world": [ 0.9999987338749258, 0.001526096918605891, -0.00045086000107311954 ], "per_marker": [ { "marker_id": 198, "q_i": 0.02442587817443171, "weight": 1.0 }, { "marker_id": 229, "q_i": 0.0599847921334361, "weight": 1.0 }, { "marker_id": 243, "q_i": 0.06035521668348878, "weight": 1.0 }, { "marker_id": 244, "q_i": 0.02446360613378397, "weight": 1.0 }, { "marker_id": 245, "q_i": 0.045392266048815896, "weight": 1.0 } ] } }, { "link": "Arm1", "joint_variable": "y", "joint_type": "revolute", "old": 0.09284449797145955, "new": 0.14689012289555903, "info": { "reason": "2d_alignment+normal_tiebreak", "used_markers": 5, "axis_world": [ -0.9999987338749258, -0.001526096918605891, 0.00045086000107311954 ], "axis_id": 0, "theta_rad": 0.14689012289555883, "theta_alt_rad": -2.9947025306942336, "score_theta": 0.03961164919806339, "score_theta_alt": 1.2254701763027116, "best_score": 0.03961164919806339, "per_marker": [ { "marker_id": 198, "weight": 1.0 }, { "marker_id": 229, "weight": 1.0 }, { "marker_id": 243, "weight": 1.0 }, { "marker_id": 244, "weight": 1.0 }, { "marker_id": 245, "weight": 1.0 } ] } }, { "link": "Ellbow", "joint_variable": "z", "joint_type": "revolute", "old": 0.0, "new": 0.6992753576681694, "info": { "reason": "2d_alignment+normal_tiebreak", "used_markers": 1, "axis_world": [ -0.9999987338749258, -0.001526096918605891, 0.00045086000107311954 ], "axis_id": 0, "theta_rad": 0.6992753576681693, "theta_alt_rad": -2.442317295921624, "score_theta": 0.049105356314042614, "score_theta_alt": 0.11796328451100642, "best_score": 0.049105356314042614, "per_marker": [ { "marker_id": 245, "weight": 1.0 } ] } } ] }, { "pass": 1, "updates": [ { "link": "Base", "joint_variable": "x", "joint_type": "linear", "old": 0.0429243518347913, "new": 0.04292435183481204, "info": { "reason": "weighted_projection", "used_markers": 5, "axis_world": [ 0.9999987338749258, 0.001526096918605891, -0.00045086000107311954 ], "per_marker": [ { "marker_id": 198, "q_i": 0.024425878174431724, "weight": 1.0 }, { "marker_id": 229, "q_i": 0.0599847921334361, "weight": 1.0 }, { "marker_id": 243, "q_i": 0.06035521668348879, "weight": 1.0 }, { "marker_id": 244, "q_i": 0.024463606133844268, "weight": 1.0 }, { "marker_id": 245, "q_i": 0.04539226604885928, "weight": 1.0 } ] } }, { "link": "Arm1", "joint_variable": "y", "joint_type": "revolute", "old": 0.14689012289555903, "new": 0.1554982571438961, "info": { "reason": "2d_alignment+normal_tiebreak", "used_markers": 5, "axis_world": [ -0.9999987338749258, -0.001526096918605891, 0.00045086000107311954 ], "axis_id": 0, "theta_rad": 0.15549825714389606, "theta_alt_rad": -2.986094396445897, "score_theta": 0.045683286025764554, "score_theta_alt": 1.241926754314132, "best_score": 0.045683286025764554, "per_marker": [ { "marker_id": 198, "weight": 1.0 }, { "marker_id": 229, "weight": 1.0 }, { "marker_id": 243, "weight": 1.0 }, { "marker_id": 244, "weight": 1.0 }, { "marker_id": 245, "weight": 1.0 } ] } }, { "link": "Ellbow", "joint_variable": "z", "joint_type": "revolute", "old": 0.6992753576681694, "new": 0.6954265464120719, "info": { "reason": "2d_alignment+normal_tiebreak", "used_markers": 1, "axis_world": [ -0.9999987338749258, -0.001526096918605891, 0.00045086000107311954 ], "axis_id": 0, "theta_rad": 0.6954265464120718, "theta_alt_rad": -2.4461661071777208, "score_theta": 0.049905665348934355, "score_theta_alt": 0.11856436763800583, "best_score": 0.049905665348934355, "per_marker": [ { "marker_id": 245, "weight": 1.0 } ] } } ] } ], "root_link": "Board", "root_pose": { "reason": "kabsch", "used_markers": [ 210, 211, 214, 208, 206, 205, 217, 46, 47, 48, 51, 53, 54, 55, 56, 57, 58, 59, 61, 62, 63, 64, 66, 68, 69, 71, 72, 75, 76, 79, 82, 83, 84, 85, 86, 92, 95, 96, 97, 102, 103, 105 ] }, "marker_stats": { "num_markers_used": 47, "mean_error_m": 0.012313434520440758, "rms_error_m": 0.031001953470983074, "median_error_m": 0.0034827297538316377, "worst_error_m": 0.14321913143029869 }, "marker_reports": [ { "marker_id": 46, "link": "Board", "error_m": [ 0.00247848233341863, 0.002480551242752732, -0.0037562209106966615 ], "error_norm_m": 0.00513859948574952, "predicted_m": [ 0.5359518253592175, 0.186062925371616, -0.027688212773239337 ], "observed_m": [ 0.5334733430257989, 0.18358237412886327, -0.023931991862542676 ] }, { "marker_id": 47, "link": "Board", "error_m": [ 8.622522667534049e-07, -0.0008018281583023756, -0.00011322576502810142 ], "error_norm_m": 0.0008097834357355984, "predicted_m": [ 0.3441925557690014, -0.28621005995305304, -0.027158440415112586 ], "observed_m": [ 0.3441916935167346, -0.28540823179475067, -0.027045214650084484 ] }, { "marker_id": 48, "link": "Board", "error_m": [ 0.001222503786411866, -0.00034436356996364603, -0.0006783978837431315 ], "error_norm_m": 0.001439904672114309, "predicted_m": [ 0.6887042960787745, -0.31986432572912415, -0.02728166299850684 ], "observed_m": [ 0.6874817922923626, -0.3195199621591605, -0.02660326511476371 ] }, { "marker_id": 51, "link": "Board", "error_m": [ -0.0010260852575597057, 0.00115368172715552, -0.0010107131683654638 ], "error_norm_m": 0.001845365435912699, "predicted_m": [ 0.16758805372139304, -0.17201949300916958, -0.027186325012326124 ], "observed_m": [ 0.16861413897895275, -0.1731731747363251, -0.02617561184396066 ] }, { "marker_id": 53, "link": "Board", "error_m": [ -0.0002309238554006332, 0.0016196361291773986, -0.0021780679962964122 ], "error_norm_m": 0.002724064465907609, "predicted_m": [ 0.4854509785233864, 0.21278587549107209, -0.027690616312313798 ], "observed_m": [ 0.48568190237878706, 0.2111662393618947, -0.025512548316017385 ] }, { "marker_id": 54, "link": "Board", "error_m": [ 0.0013273086982619198, -0.0008833898753587421, -0.0007052468733528376 ], "error_norm_m": 0.0017434159586117248, "predicted_m": [ 0.34229980143762323, -0.3302629803764141, -0.027116212295749426 ], "observed_m": [ 0.3409724927393613, -0.32937959050105536, -0.026410965422396588 ] }, { "marker_id": 55, "link": "Board", "error_m": [ 0.00015464224124767112, -0.00040737140962726626, 4.432470429710858e-05 ], "error_norm_m": 0.00043798443758977896, "predicted_m": [ 0.2836460569732936, -0.26234244254773015, -0.02715364724495874 ], "observed_m": [ 0.2834914147320459, -0.2619350711381029, -0.02719797194925585 ] }, { "marker_id": 56, "link": "Board", "error_m": [ 0.002556545333326221, 0.0023022017103751236, -0.003549407389282104 ], "error_norm_m": 0.004943111325035744, "predicted_m": [ 0.49794747324308974, 0.16923491483168265, -0.027655326586600037 ], "observed_m": [ 0.4953909279097635, 0.16693271312130753, -0.024105919197317933 ] }, { "marker_id": 57, "link": "Board", "error_m": [ 0.0002982253734815643, 0.00040862735301733233, -0.00016043637050819348 ], "error_norm_m": 0.0005307113302012803, "predicted_m": [ 0.6029405488431328, -0.3633252410570794, -0.027202297028204564 ], "observed_m": [ 0.6026423234696512, -0.36373386841009675, -0.02704186065769637 ] }, { "marker_id": 58, "link": "Board", "error_m": [ -0.0019953638476404023, 0.002995337372694057, -0.0015399655384435024 ], "error_norm_m": 0.00391471796178494, "predicted_m": [ 0.04994846845262338, -0.21822905597177505, -0.02709005146012368 ], "observed_m": [ 0.05194383230026378, -0.2212243933444691, -0.025550085921680177 ] }, { "marker_id": 59, "link": "Board", "error_m": [ 0.0015083415703128766, 8.844730424206748e-05, -0.00022845699277860773 ], "error_norm_m": 0.0015281066114348986, "predicted_m": [ 0.6261603071598917, -0.2779897436515538, -0.027292885453720384 ], "observed_m": [ 0.6246519655895788, -0.2780781909557959, -0.027064428460941776 ] }, { "marker_id": 61, "link": "Board", "error_m": [ 0.002317168880300112, -0.009041164839785842, 0.0034940530228994814 ], "error_norm_m": 0.00996595905103187, "predicted_m": [ -0.02340703999082524, 0.3355993973356062, -0.02757727641501216 ], "observed_m": [ -0.02572420887112535, 0.344640562175392, -0.031071329437911643 ] }, { "marker_id": 62, "link": "Board", "error_m": [ 0.00022906225585306306, -0.0020322998492257327, 0.0007121030769661092 ], "error_norm_m": 0.002165595296089283, "predicted_m": [ 0.4044923638656985, -0.17467795580024498, -0.02729029923602521 ], "observed_m": [ 0.4042633016098454, -0.17264565595101924, -0.02800240231299132 ] }, { "marker_id": 63, "link": "Board", "error_m": [ 0.0017975538906517263, -0.0016599731341800372, 0.0003579334200452394 ], "error_norm_m": 0.002472817649803951, "predicted_m": [ 0.7772850860009493, -0.2351590814569117, -0.02740103447054537 ], "observed_m": [ 0.7754875321102975, -0.23349910832273166, -0.02775896789059061 ] }, { "marker_id": 64, "link": "Board", "error_m": [ -0.0018049655116158213, 0.0034585745773775267, -0.0019042493400182187 ], "error_norm_m": 0.004341175434644921, "predicted_m": [ -0.02145705360148727, -0.1884580062231602, -0.027085922850510185 ], "observed_m": [ -0.01965208808987145, -0.19191658080053772, -0.025181673510491966 ] }, { "marker_id": 66, "link": "Board", "error_m": [ 0.0010150037218127628, 0.0016560925901293877, 0.0002942349360347471 ], "error_norm_m": 0.001964548146510692, "predicted_m": [ 0.2098297948231209, -0.3631051663333437, -0.02702582908849886 ], "observed_m": [ 0.20881479110130813, -0.3647612589234731, -0.027320064024533606 ] }, { "marker_id": 68, "link": "Board", "error_m": [ 0.002296459000075579, 0.002003700948126602, -0.003196399181546579 ], "error_norm_m": 0.004416504178232283, "predicted_m": [ 0.572994370976927, 0.17131944524239573, -0.02769101263159909 ], "observed_m": [ 0.5706979119768514, 0.16931574429426913, -0.02449461345005251 ] }, { "marker_id": 69, "link": "Board", "error_m": [ -0.0027030804757261547, 0.0034613824966199247, -0.0020951137947462853 ], "error_norm_m": 0.004865934099337443, "predicted_m": [ 0.0075648456223840425, -0.2813937832556329, -0.027011674551107305 ], "observed_m": [ 0.010267926098110197, -0.28485516575225284, -0.02491656075636102 ] }, { "marker_id": 71, "link": "Board", "error_m": [ 0.002340371150828302, -0.00208329024796039, -0.002769954907047758 ], "error_norm_m": 0.004182114963502822, "predicted_m": [ 0.749708180235857, -0.2830612011927827, -0.027343647769272693 ], "observed_m": [ 0.7473678090850286, -0.28097791094482233, -0.024573692862224935 ] }, { "marker_id": 72, "link": "Board", "error_m": [ -0.000853438340772561, 0.0030842027285443996, -0.003184448295048794 ], "error_norm_m": 0.004514573558609995, "predicted_m": [ 0.4402183910588402, 0.19479683311685514, -0.02765339104126457 ], "observed_m": [ 0.44107182939961276, 0.19171263038831074, -0.024468942746215777 ] }, { "marker_id": 75, "link": "Board", "error_m": [ 0.001957623091231764, -0.0019278901142832094, 0.0006942250988448279 ], "error_norm_m": 0.002833901365245595, "predicted_m": [ -0.02647141494880341, 0.19434461852845472, -0.0274432232180736 ], "observed_m": [ -0.028429038040035173, 0.19627250864273793, -0.028137448316918428 ] }, { "marker_id": 76, "link": "Board", "error_m": [ 0.0022496021647839815, -0.0013624322648640164, -0.0015234954441256804 ], "error_norm_m": 0.0030394028927430753, "predicted_m": [ 0.6844800916645605, 0.1676495806923791, -0.02773767035864721 ], "observed_m": [ 0.6822304894997765, 0.1690120129572431, -0.02621417491452153 ] }, { "marker_id": 79, "link": "Board", "error_m": [ -3.2644454626862274e-05, -0.00032889767771107636, -0.0004293674395318449 ], "error_norm_m": 0.0005418447572430288, "predicted_m": [ 0.3120680718076531, -0.15882899282903906, -0.027263647660594328 ], "observed_m": [ 0.31210071626228, -0.15850009515132799, -0.026834280221062483 ] }, { "marker_id": 82, "link": "Board", "error_m": [ -0.0016063483957248215, -0.0019448955386594524, 0.0004559909894188627 ], "error_norm_m": 0.0025633769927921922, "predicted_m": [ 0.21823156252909226, 0.2973781337892367, -0.027649975385221594 ], "observed_m": [ 0.21983791092481708, 0.2993230293278962, -0.028105966374640457 ] }, { "marker_id": 83, "link": "Board", "error_m": [ 0.0023473643195766336, -0.009390926996671933, 0.00466884006141147 ], "error_norm_m": 0.010746985466849943, "predicted_m": [ 0.04316770080929464, 0.3390909994254693, -0.02761047645891088 ], "observed_m": [ 0.04082033648971801, 0.3484819264221412, -0.03227931652032235 ] }, { "marker_id": 84, "link": "Board", "error_m": [ -0.0016925204087820944, 0.0026534383956161034, -0.0026765572223701045 ], "error_norm_m": 0.004131503263715913, "predicted_m": [ 0.40662058356961767, 0.25884560595123907, -0.027698450187053428 ], "observed_m": [ 0.40831310397839976, 0.25619216755562296, -0.025021892964683323 ] }, { "marker_id": 85, "link": "Board", "error_m": [ 0.001308871363822628, -0.00040202731324173735, -0.0005277034864782162 ], "error_norm_m": 0.001467392645909247, "predicted_m": [ 0.5045823628239121, -0.31217530822942635, -0.027206135643551992 ], "observed_m": [ 0.5032734914600895, -0.3117732809161846, -0.026678432157073776 ] }, { "marker_id": 86, "link": "Board", "error_m": [ -0.0012797745658206794, 0.0032209456420222438, -0.0035178219050914818 ], "error_norm_m": 0.004938358505022196, "predicted_m": [ 0.36196936424642545, 0.2923674880966266, -0.0277098687215852 ], "observed_m": [ 0.36324913881224613, 0.28914654245460436, -0.024192046816493718 ] }, { "marker_id": 92, "link": "Board", "error_m": [ 0.00042903246025560726, 0.0008769406715817551, 0.00015952561792148892 ], "error_norm_m": 0.0009892129276351334, "predicted_m": [ 0.6448969278027353, -0.18405108172345475, -0.027389539705852808 ], "observed_m": [ 0.6444678953424797, -0.1849280223950365, -0.027549065323774297 ] }, { "marker_id": 95, "link": "Board", "error_m": [ -0.0009572559327626629, 0.0011652592815823981, -0.0013464831664510638 ], "error_norm_m": 0.002021678765694324, "predicted_m": [ 0.18598372035814206, -0.27398149324641674, -0.027098822959828805 ], "observed_m": [ 0.18694097629090473, -0.27514675252799914, -0.02575233979337774 ] }, { "marker_id": 96, "link": "Board", "error_m": [ -0.0002241252283569084, -0.0007436603001124142, 0.00020477377243741449 ], "error_norm_m": 0.0008032403487298011, "predicted_m": [ 0.3695797951493044, -0.1861212440778488, -0.027263860273928044 ], "observed_m": [ 0.3698039203776613, -0.1853775837777364, -0.02746863404636546 ] }, { "marker_id": 97, "link": "Board", "error_m": [ 0.0011343088744122931, -0.0006360036375622213, -0.0003257724968691311 ], "error_norm_m": 0.0013406285724536864, "predicted_m": [ 0.30442424063811746, -0.35940080328077295, -0.027071821788168846 ], "observed_m": [ 0.30328993176370517, -0.35876479964321073, -0.026746049291299714 ] }, { "marker_id": 102, "link": "Board", "error_m": [ -0.00011679865515434873, 0.000798845574683682, -0.0005578100567627184 ], "error_norm_m": 0.00098129925989129, "predicted_m": [ 0.6495551739653214, -0.22220400040800298, -0.02735579746225907 ], "observed_m": [ 0.6496719726204757, -0.22300284598268666, -0.02679798740549635 ] }, { "marker_id": 103, "link": "Board", "error_m": [ -0.0010910444459660135, 0.0014077448646367674, -0.0009806084762537769 ], "error_norm_m": 0.0020331543401043684, "predicted_m": [ 0.10552199183590182, -0.1877442232713465, -0.02714366111486661 ], "observed_m": [ 0.10661303628186783, -0.18915196813598326, -0.026163052638612832 ] }, { "marker_id": 105, "link": "Board", "error_m": [ 0.0014403492478269886, -0.00045720635970131207, -0.00018752901785983392 ], "error_norm_m": 0.001522764178593183, "predicted_m": [ 0.5247713540122755, -0.26564446416617027, -0.027258914021087224 ], "observed_m": [ 0.5233310047644485, -0.26518725780646896, -0.02707138500322739 ] }, { "marker_id": 198, "link": "Arm1", "error_m": [ 0.018501548188510936, 0.010892832964351389, 0.04363798455701247 ], "error_norm_m": 0.048633679601271296, "predicted_m": [ 0.15258425961078714, -0.044472694926929804, 0.12035798289504725 ], "observed_m": [ 0.1340827114222762, -0.05536552789128119, 0.07671999833803478 ] }, { "marker_id": 205, "link": "Board", "error_m": [ -0.006395818565922973, -0.002733018913535626, 0.009679113250394951 ], "error_norm_m": 0.011918939584708011, "predicted_m": [ 0.7496744240405424, -0.0890252074093944, 7.413071499028628e-05 ], "observed_m": [ 0.7560702426064654, -0.08629218849585878, -0.009604982535404665 ] }, { "marker_id": 206, "link": "Board", "error_m": [ -0.0014881792652856607, 1.4057368443648466e-05, 0.00323139336615946 ], "error_norm_m": 0.0035576366062448107, "predicted_m": [ 0.6495524290874222, -0.009177945549108781, 4.413034277337299e-05 ], "observed_m": [ 0.6510406083527078, -0.00919200291755243, -0.003187263023386087 ] }, { "marker_id": 208, "link": "Board", "error_m": [ -0.0008496576928241351, -0.0013676740350954814, 0.003630398282259455 ], "error_norm_m": 0.003971428225346896, "predicted_m": [ 0.3496749304901722, -0.08963564617683736, 0.0002544747154197144 ], "observed_m": [ 0.3505245881829963, -0.08826797214174188, -0.0033759235668397404 ] }, { "marker_id": 210, "link": "Board", "error_m": [ -0.00025861804113453193, 0.0023805563621476476, 0.0028815862683752554 ], "error_norm_m": 0.003746661354679755, "predicted_m": [ 0.01956849194127999, -0.02013937055184975, 0.0003375579399902561 ], "observed_m": [ 0.01982710998241452, -0.022519926913997398, -0.002544028328384999 ] }, { "marker_id": 211, "link": "Board", "error_m": [ -0.004533518798538971, 0.0026669382590026915, 0.0017103444337853591 ], "error_norm_m": 0.005530879718111678, "predicted_m": [ 0.24955293553705188, -0.009788384316551749, 0.00022447434320280112 ], "observed_m": [ 0.25408645433559085, -0.01245532257555444, -0.001485870090582558 ] }, { "marker_id": 214, "link": "Board", "error_m": [ -5.1240843096100885e-05, -0.0013616926196595037, 0.003205085665592703 ], "error_norm_m": 0.0034827297538316377, "predicted_m": [ 0.34955280892464446, -0.009635774624691007, 0.00017938834309544406 ], "observed_m": [ 0.34960404976774057, -0.008274082005031503, -0.003025697322497259 ] }, { "marker_id": 217, "link": "Board", "error_m": [ -0.001218279427446456, 1.284425557357416e-05, 0.003719527151852844 ], "error_norm_m": 0.00391398160082684, "predicted_m": [ 0.6496745506529499, -0.08917781710125514, 0.00011921671509764334 ], "observed_m": [ 0.6508928300803963, -0.08919066135682871, -0.0036003104367552004 ] }, { "marker_id": 229, "link": "Arm1", "error_m": [ -0.017036302981130486, 0.004053004008007455, 0.06730285349178783 ], "error_norm_m": 0.06954377433595949, "predicted_m": [ 0.15272625307303975, -0.13337356402889083, 0.1343799410597356 ], "observed_m": [ 0.16976255605417023, -0.1374265680368983, 0.06707708756794778 ] }, { "marker_id": 243, "link": "Arm1", "error_m": [ -0.017412063526779598, 0.006469583194072842, 0.06364853555889184 ], "error_norm_m": 0.06630363143717814, "predicted_m": [ 0.15277420714994155, -0.17339912595811208, 0.10526032408669718 ], "observed_m": [ 0.17018627067672115, -0.17986870915218492, 0.04161178852780534 ] }, { "marker_id": 244, "link": "Ellbow", "error_m": [ 0.01866390240884047, -0.10479940252471366, 0.09581473574031028 ], "error_norm_m": 0.14321913143029869, "predicted_m": [ 0.27771882920460633, -0.13863580363696804, 0.09975098285585088 ], "observed_m": [ 0.25905492679576586, -0.033836401112254375, 0.003936247115540596 ] }, { "marker_id": 245, "link": "Ellbow", "error_m": [ -0.002307313586044829, -0.08370882295209664, 0.07287355851062963 ], "error_norm_m": 0.11100921703179412, "predicted_m": [ 0.2427486750971574, -0.16502701378196416, 0.07671639258856668 ], "observed_m": [ 0.24505598868320222, -0.08131819082986752, 0.0038428340779370477 ] } ], "stage_idx": 1, "num_active_links": 4 }, { "method": "deterministic_geometric_prefix", "active_links": [ "Board", "Base", "Arm1", "Ellbow", "Arm2" ], "active_observations": 49, "joint_updates": [ { "pass": 0, "updates": [ { "link": "Base", "joint_variable": "x", "joint_type": "linear", "old": 0.04292435183481204, "new": 0.0678998391597064, "info": { "reason": "weighted_projection", "used_markers": 7, "axis_world": [ 0.9999987338749258, 0.001526096918605891, -0.00045086000107311954 ], "per_marker": [ { "marker_id": 198, "q_i": 0.024425878174431707, "weight": 1.0 }, { "marker_id": 229, "q_i": 0.059984792133436104, "weight": 1.0 }, { "marker_id": 243, "q_i": 0.0603552166834888, "weight": 1.0 }, { "marker_id": 244, "q_i": 0.024463606133843973, "weight": 1.0 }, { "marker_id": 245, "q_i": 0.04539226604885906, "weight": 1.0 }, { "marker_id": 113, "q_i": 0.09429308962526577, "weight": 1.0 }, { "marker_id": 124, "q_i": 0.16638402531861943, "weight": 1.0 } ] } }, { "link": "Arm1", "joint_variable": "y", "joint_type": "revolute", "old": 0.1554982571438961, "new": 0.006781583053992346, "info": { "reason": "2d_alignment+normal_tiebreak", "used_markers": 7, "axis_world": [ -0.9999987338749258, -0.001526096918605891, 0.00045086000107311954 ], "axis_id": 0, "theta_rad": 0.006781583053992442, "theta_alt_rad": -3.1348110705358003, "score_theta": 0.04663752247750124, "score_theta_alt": 2.54767919920977, "best_score": 0.04663752247750124, "per_marker": [ { "marker_id": 198, "weight": 1.0 }, { "marker_id": 229, "weight": 1.0 }, { "marker_id": 243, "weight": 1.0 }, { "marker_id": 244, "weight": 1.0 }, { "marker_id": 245, "weight": 1.0 }, { "marker_id": 113, "weight": 1.0 }, { "marker_id": 124, "weight": 1.0 } ] } }, { "link": "Ellbow", "joint_variable": "z", "joint_type": "revolute", "old": 0.6954265464120719, "new": 2.189603926369063, "info": { "reason": "2d_alignment+normal_tiebreak", "used_markers": 3, "axis_world": [ -0.9999987338749258, -0.001526096918605891, 0.00045086000107311954 ], "axis_id": 0, "theta_rad": -0.9519887272207297, "theta_alt_rad": 2.189603926369063, "score_theta": 0.26070781545286537, "score_theta_alt": 0.21965483136667047, "best_score": 0.21965483136667047, "per_marker": [ { "marker_id": 245, "weight": 1.0 }, { "marker_id": 113, "weight": 1.0 }, { "marker_id": 124, "weight": 1.0 } ] } }, { "link": "Arm2", "joint_variable": "a", "joint_type": "revolute", "old": 0.0, "new": 2.3869309684736937, "info": { "reason": "2d_alignment+normal_tiebreak", "used_markers": 2, "axis_world": [ -0.000529578003088855, 0.5863354232806356, 0.8100682014197672 ], "axis_id": 2, "theta_rad": 2.386930968473694, "theta_alt_rad": -0.7546616851160994, "score_theta": 0.10616423063273733, "score_theta_alt": 0.184580617039787, "best_score": 0.10616423063273733, "per_marker": [ { "marker_id": 113, "weight": 1.0 }, { "marker_id": 124, "weight": 1.0 } ] } } ] }, { "pass": 1, "updates": [ { "link": "Base", "joint_variable": "x", "joint_type": "linear", "old": 0.0678998391597064, "new": 0.062193217768473155, "info": { "reason": "weighted_projection", "used_markers": 7, "axis_world": [ 0.9999987338749258, 0.001526096918605891, -0.00045086000107311954 ], "per_marker": [ { "marker_id": 198, "q_i": 0.02442587817443172, "weight": 1.0 }, { "marker_id": 229, "q_i": 0.059984792133436104, "weight": 1.0 }, { "marker_id": 243, "q_i": 0.06035521668348879, "weight": 1.0 }, { "marker_id": 244, "q_i": 0.024463606134177904, "weight": 1.0 }, { "marker_id": 245, "q_i": 0.04539226604909952, "weight": 1.0 }, { "marker_id": 113, "q_i": 0.11484435695564668, "weight": 1.0 }, { "marker_id": 124, "q_i": 0.10588640824903132, "weight": 1.0 } ] } }, { "link": "Arm1", "joint_variable": "y", "joint_type": "revolute", "old": 0.006781583053992346, "new": 0.2785909012460954, "info": { "reason": "2d_alignment+normal_tiebreak", "used_markers": 7, "axis_world": [ -0.9999987338749258, -0.001526096918605891, 0.00045086000107311954 ], "axis_id": 0, "theta_rad": 0.2785909012460956, "theta_alt_rad": -2.8630017523436972, "score_theta": 0.21356862401978716, "score_theta_alt": 1.8892529951757335, "best_score": 0.21356862401978716, "per_marker": [ { "marker_id": 198, "weight": 1.0 }, { "marker_id": 229, "weight": 1.0 }, { "marker_id": 243, "weight": 1.0 }, { "marker_id": 244, "weight": 1.0 }, { "marker_id": 245, "weight": 1.0 }, { "marker_id": 113, "weight": 1.0 }, { "marker_id": 124, "weight": 1.0 } ] } }, { "link": "Ellbow", "joint_variable": "z", "joint_type": "revolute", "old": 2.189603926369063, "new": -0.5275290928597367, "info": { "reason": "2d_alignment+normal_tiebreak", "used_markers": 3, "axis_world": [ -0.9999987338749258, -0.001526096918605891, 0.00045086000107311954 ], "axis_id": 0, "theta_rad": -0.5275290928597368, "theta_alt_rad": 2.614063560730056, "score_theta": 0.11738821861852987, "score_theta_alt": 0.3306229138097575, "best_score": 0.11738821861852987, "per_marker": [ { "marker_id": 245, "weight": 1.0 }, { "marker_id": 113, "weight": 1.0 }, { "marker_id": 124, "weight": 1.0 } ] } }, { "link": "Arm2", "joint_variable": "a", "joint_type": "revolute", "old": 2.3869309684736937, "new": -1.6690886156018152, "info": { "reason": "2d_alignment+normal_tiebreak", "used_markers": 2, "axis_world": [ 0.0013687363834708653, -0.9694044268160007, -0.24546523955186347 ], "axis_id": 1, "theta_rad": 1.472504037987978, "theta_alt_rad": -1.6690886156018152, "score_theta": 0.12595576502330336, "score_theta_alt": 0.11325952217697392, "best_score": 0.11325952217697392, "per_marker": [ { "marker_id": 113, "weight": 1.0 }, { "marker_id": 124, "weight": 1.0 } ] } } ] } ], "root_link": "Board", "root_pose": { "reason": "kabsch", "used_markers": [ 210, 211, 214, 208, 206, 205, 217, 46, 47, 48, 51, 53, 54, 55, 56, 57, 58, 59, 61, 62, 63, 64, 66, 68, 69, 71, 72, 75, 76, 79, 82, 83, 84, 85, 86, 92, 95, 96, 97, 102, 103, 105 ] }, "marker_stats": { "num_markers_used": 49, "mean_error_m": 0.020817237048520502, "rms_error_m": 0.04981184475348496, "median_error_m": 0.0035576366062448107, "worst_error_m": 0.1751467799075424 }, "marker_reports": [ { "marker_id": 46, "link": "Board", "error_m": [ 0.00247848233341863, 0.002480551242752732, -0.0037562209106966615 ], "error_norm_m": 0.00513859948574952, "predicted_m": [ 0.5359518253592175, 0.186062925371616, -0.027688212773239337 ], "observed_m": [ 0.5334733430257989, 0.18358237412886327, -0.023931991862542676 ] }, { "marker_id": 47, "link": "Board", "error_m": [ 8.622522667534049e-07, -0.0008018281583023756, -0.00011322576502810142 ], "error_norm_m": 0.0008097834357355984, "predicted_m": [ 0.3441925557690014, -0.28621005995305304, -0.027158440415112586 ], "observed_m": [ 0.3441916935167346, -0.28540823179475067, -0.027045214650084484 ] }, { "marker_id": 48, "link": "Board", "error_m": [ 0.001222503786411866, -0.00034436356996364603, -0.0006783978837431315 ], "error_norm_m": 0.001439904672114309, "predicted_m": [ 0.6887042960787745, -0.31986432572912415, -0.02728166299850684 ], "observed_m": [ 0.6874817922923626, -0.3195199621591605, -0.02660326511476371 ] }, { "marker_id": 51, "link": "Board", "error_m": [ -0.0010260852575597057, 0.00115368172715552, -0.0010107131683654638 ], "error_norm_m": 0.001845365435912699, "predicted_m": [ 0.16758805372139304, -0.17201949300916958, -0.027186325012326124 ], "observed_m": [ 0.16861413897895275, -0.1731731747363251, -0.02617561184396066 ] }, { "marker_id": 53, "link": "Board", "error_m": [ -0.0002309238554006332, 0.0016196361291773986, -0.0021780679962964122 ], "error_norm_m": 0.002724064465907609, "predicted_m": [ 0.4854509785233864, 0.21278587549107209, -0.027690616312313798 ], "observed_m": [ 0.48568190237878706, 0.2111662393618947, -0.025512548316017385 ] }, { "marker_id": 54, "link": "Board", "error_m": [ 0.0013273086982619198, -0.0008833898753587421, -0.0007052468733528376 ], "error_norm_m": 0.0017434159586117248, "predicted_m": [ 0.34229980143762323, -0.3302629803764141, -0.027116212295749426 ], "observed_m": [ 0.3409724927393613, -0.32937959050105536, -0.026410965422396588 ] }, { "marker_id": 55, "link": "Board", "error_m": [ 0.00015464224124767112, -0.00040737140962726626, 4.432470429710858e-05 ], "error_norm_m": 0.00043798443758977896, "predicted_m": [ 0.2836460569732936, -0.26234244254773015, -0.02715364724495874 ], "observed_m": [ 0.2834914147320459, -0.2619350711381029, -0.02719797194925585 ] }, { "marker_id": 56, "link": "Board", "error_m": [ 0.002556545333326221, 0.0023022017103751236, -0.003549407389282104 ], "error_norm_m": 0.004943111325035744, "predicted_m": [ 0.49794747324308974, 0.16923491483168265, -0.027655326586600037 ], "observed_m": [ 0.4953909279097635, 0.16693271312130753, -0.024105919197317933 ] }, { "marker_id": 57, "link": "Board", "error_m": [ 0.0002982253734815643, 0.00040862735301733233, -0.00016043637050819348 ], "error_norm_m": 0.0005307113302012803, "predicted_m": [ 0.6029405488431328, -0.3633252410570794, -0.027202297028204564 ], "observed_m": [ 0.6026423234696512, -0.36373386841009675, -0.02704186065769637 ] }, { "marker_id": 58, "link": "Board", "error_m": [ -0.0019953638476404023, 0.002995337372694057, -0.0015399655384435024 ], "error_norm_m": 0.00391471796178494, "predicted_m": [ 0.04994846845262338, -0.21822905597177505, -0.02709005146012368 ], "observed_m": [ 0.05194383230026378, -0.2212243933444691, -0.025550085921680177 ] }, { "marker_id": 59, "link": "Board", "error_m": [ 0.0015083415703128766, 8.844730424206748e-05, -0.00022845699277860773 ], "error_norm_m": 0.0015281066114348986, "predicted_m": [ 0.6261603071598917, -0.2779897436515538, -0.027292885453720384 ], "observed_m": [ 0.6246519655895788, -0.2780781909557959, -0.027064428460941776 ] }, { "marker_id": 61, "link": "Board", "error_m": [ 0.002317168880300112, -0.009041164839785842, 0.0034940530228994814 ], "error_norm_m": 0.00996595905103187, "predicted_m": [ -0.02340703999082524, 0.3355993973356062, -0.02757727641501216 ], "observed_m": [ -0.02572420887112535, 0.344640562175392, -0.031071329437911643 ] }, { "marker_id": 62, "link": "Board", "error_m": [ 0.00022906225585306306, -0.0020322998492257327, 0.0007121030769661092 ], "error_norm_m": 0.002165595296089283, "predicted_m": [ 0.4044923638656985, -0.17467795580024498, -0.02729029923602521 ], "observed_m": [ 0.4042633016098454, -0.17264565595101924, -0.02800240231299132 ] }, { "marker_id": 63, "link": "Board", "error_m": [ 0.0017975538906517263, -0.0016599731341800372, 0.0003579334200452394 ], "error_norm_m": 0.002472817649803951, "predicted_m": [ 0.7772850860009493, -0.2351590814569117, -0.02740103447054537 ], "observed_m": [ 0.7754875321102975, -0.23349910832273166, -0.02775896789059061 ] }, { "marker_id": 64, "link": "Board", "error_m": [ -0.0018049655116158213, 0.0034585745773775267, -0.0019042493400182187 ], "error_norm_m": 0.004341175434644921, "predicted_m": [ -0.02145705360148727, -0.1884580062231602, -0.027085922850510185 ], "observed_m": [ -0.01965208808987145, -0.19191658080053772, -0.025181673510491966 ] }, { "marker_id": 66, "link": "Board", "error_m": [ 0.0010150037218127628, 0.0016560925901293877, 0.0002942349360347471 ], "error_norm_m": 0.001964548146510692, "predicted_m": [ 0.2098297948231209, -0.3631051663333437, -0.02702582908849886 ], "observed_m": [ 0.20881479110130813, -0.3647612589234731, -0.027320064024533606 ] }, { "marker_id": 68, "link": "Board", "error_m": [ 0.002296459000075579, 0.002003700948126602, -0.003196399181546579 ], "error_norm_m": 0.004416504178232283, "predicted_m": [ 0.572994370976927, 0.17131944524239573, -0.02769101263159909 ], "observed_m": [ 0.5706979119768514, 0.16931574429426913, -0.02449461345005251 ] }, { "marker_id": 69, "link": "Board", "error_m": [ -0.0027030804757261547, 0.0034613824966199247, -0.0020951137947462853 ], "error_norm_m": 0.004865934099337443, "predicted_m": [ 0.0075648456223840425, -0.2813937832556329, -0.027011674551107305 ], "observed_m": [ 0.010267926098110197, -0.28485516575225284, -0.02491656075636102 ] }, { "marker_id": 71, "link": "Board", "error_m": [ 0.002340371150828302, -0.00208329024796039, -0.002769954907047758 ], "error_norm_m": 0.004182114963502822, "predicted_m": [ 0.749708180235857, -0.2830612011927827, -0.027343647769272693 ], "observed_m": [ 0.7473678090850286, -0.28097791094482233, -0.024573692862224935 ] }, { "marker_id": 72, "link": "Board", "error_m": [ -0.000853438340772561, 0.0030842027285443996, -0.003184448295048794 ], "error_norm_m": 0.004514573558609995, "predicted_m": [ 0.4402183910588402, 0.19479683311685514, -0.02765339104126457 ], "observed_m": [ 0.44107182939961276, 0.19171263038831074, -0.024468942746215777 ] }, { "marker_id": 75, "link": "Board", "error_m": [ 0.001957623091231764, -0.0019278901142832094, 0.0006942250988448279 ], "error_norm_m": 0.002833901365245595, "predicted_m": [ -0.02647141494880341, 0.19434461852845472, -0.0274432232180736 ], "observed_m": [ -0.028429038040035173, 0.19627250864273793, -0.028137448316918428 ] }, { "marker_id": 76, "link": "Board", "error_m": [ 0.0022496021647839815, -0.0013624322648640164, -0.0015234954441256804 ], "error_norm_m": 0.0030394028927430753, "predicted_m": [ 0.6844800916645605, 0.1676495806923791, -0.02773767035864721 ], "observed_m": [ 0.6822304894997765, 0.1690120129572431, -0.02621417491452153 ] }, { "marker_id": 79, "link": "Board", "error_m": [ -3.2644454626862274e-05, -0.00032889767771107636, -0.0004293674395318449 ], "error_norm_m": 0.0005418447572430288, "predicted_m": [ 0.3120680718076531, -0.15882899282903906, -0.027263647660594328 ], "observed_m": [ 0.31210071626228, -0.15850009515132799, -0.026834280221062483 ] }, { "marker_id": 82, "link": "Board", "error_m": [ -0.0016063483957248215, -0.0019448955386594524, 0.0004559909894188627 ], "error_norm_m": 0.0025633769927921922, "predicted_m": [ 0.21823156252909226, 0.2973781337892367, -0.027649975385221594 ], "observed_m": [ 0.21983791092481708, 0.2993230293278962, -0.028105966374640457 ] }, { "marker_id": 83, "link": "Board", "error_m": [ 0.0023473643195766336, -0.009390926996671933, 0.00466884006141147 ], "error_norm_m": 0.010746985466849943, "predicted_m": [ 0.04316770080929464, 0.3390909994254693, -0.02761047645891088 ], "observed_m": [ 0.04082033648971801, 0.3484819264221412, -0.03227931652032235 ] }, { "marker_id": 84, "link": "Board", "error_m": [ -0.0016925204087820944, 0.0026534383956161034, -0.0026765572223701045 ], "error_norm_m": 0.004131503263715913, "predicted_m": [ 0.40662058356961767, 0.25884560595123907, -0.027698450187053428 ], "observed_m": [ 0.40831310397839976, 0.25619216755562296, -0.025021892964683323 ] }, { "marker_id": 85, "link": "Board", "error_m": [ 0.001308871363822628, -0.00040202731324173735, -0.0005277034864782162 ], "error_norm_m": 0.001467392645909247, "predicted_m": [ 0.5045823628239121, -0.31217530822942635, -0.027206135643551992 ], "observed_m": [ 0.5032734914600895, -0.3117732809161846, -0.026678432157073776 ] }, { "marker_id": 86, "link": "Board", "error_m": [ -0.0012797745658206794, 0.0032209456420222438, -0.0035178219050914818 ], "error_norm_m": 0.004938358505022196, "predicted_m": [ 0.36196936424642545, 0.2923674880966266, -0.0277098687215852 ], "observed_m": [ 0.36324913881224613, 0.28914654245460436, -0.024192046816493718 ] }, { "marker_id": 92, "link": "Board", "error_m": [ 0.00042903246025560726, 0.0008769406715817551, 0.00015952561792148892 ], "error_norm_m": 0.0009892129276351334, "predicted_m": [ 0.6448969278027353, -0.18405108172345475, -0.027389539705852808 ], "observed_m": [ 0.6444678953424797, -0.1849280223950365, -0.027549065323774297 ] }, { "marker_id": 95, "link": "Board", "error_m": [ -0.0009572559327626629, 0.0011652592815823981, -0.0013464831664510638 ], "error_norm_m": 0.002021678765694324, "predicted_m": [ 0.18598372035814206, -0.27398149324641674, -0.027098822959828805 ], "observed_m": [ 0.18694097629090473, -0.27514675252799914, -0.02575233979337774 ] }, { "marker_id": 96, "link": "Board", "error_m": [ -0.0002241252283569084, -0.0007436603001124142, 0.00020477377243741449 ], "error_norm_m": 0.0008032403487298011, "predicted_m": [ 0.3695797951493044, -0.1861212440778488, -0.027263860273928044 ], "observed_m": [ 0.3698039203776613, -0.1853775837777364, -0.02746863404636546 ] }, { "marker_id": 97, "link": "Board", "error_m": [ 0.0011343088744122931, -0.0006360036375622213, -0.0003257724968691311 ], "error_norm_m": 0.0013406285724536864, "predicted_m": [ 0.30442424063811746, -0.35940080328077295, -0.027071821788168846 ], "observed_m": [ 0.30328993176370517, -0.35876479964321073, -0.026746049291299714 ] }, { "marker_id": 102, "link": "Board", "error_m": [ -0.00011679865515434873, 0.000798845574683682, -0.0005578100567627184 ], "error_norm_m": 0.00098129925989129, "predicted_m": [ 0.6495551739653214, -0.22220400040800298, -0.02735579746225907 ], "observed_m": [ 0.6496719726204757, -0.22300284598268666, -0.02679798740549635 ] }, { "marker_id": 103, "link": "Board", "error_m": [ -0.0010910444459660135, 0.0014077448646367674, -0.0009806084762537769 ], "error_norm_m": 0.0020331543401043684, "predicted_m": [ 0.10552199183590182, -0.1877442232713465, -0.02714366111486661 ], "observed_m": [ 0.10661303628186783, -0.18915196813598326, -0.026163052638612832 ] }, { "marker_id": 105, "link": "Board", "error_m": [ 0.0014403492478269886, -0.00045720635970131207, -0.00018752901785983392 ], "error_norm_m": 0.001522764178593183, "predicted_m": [ 0.5247713540122755, -0.26564446416617027, -0.027258914021087224 ], "observed_m": [ 0.5233310047644485, -0.26518725780646896, -0.02707138500322739 ] }, { "marker_id": 113, "link": "Arm2", "error_m": [ -0.0021586544434035737, -0.09653148879171947, -0.13594528297674044 ], "error_norm_m": 0.1667456388664421, "predicted_m": [ 0.2920929814098981, -0.3076723568280021, 0.08224195506336499 ], "observed_m": [ 0.29425163585330166, -0.21114086803628263, 0.21818723804010542 ] }, { "marker_id": 124, "link": "Arm2", "error_m": [ -0.06566113460958772, -0.10006908085821475, -0.12787176768135639 ], "error_norm_m": 0.1751467799075424, "predicted_m": [ 0.2657538161849513, -0.35285307605591026, 0.10979102011627255 ], "observed_m": [ 0.33141495079453903, -0.2527839951976955, 0.23766278779762892 ] }, { "marker_id": 198, "link": "Arm1", "error_m": [ 0.03776572287969476, 0.01938241009462975, 0.06191479817053436 ], "error_norm_m": 0.07506910068863427, "predicted_m": [ 0.17184843430197097, -0.03598311779665144, 0.13863479650856914 ], "observed_m": [ 0.1340827114222762, -0.05536552789128119, 0.07671999833803478 ] }, { "marker_id": 205, "link": "Board", "error_m": [ -0.006395818565922973, -0.002733018913535626, 0.009679113250394951 ], "error_norm_m": 0.011918939584708011, "predicted_m": [ 0.7496744240405424, -0.0890252074093944, 7.413071499028628e-05 ], "observed_m": [ 0.7560702426064654, -0.08629218849585878, -0.009604982535404665 ] }, { "marker_id": 206, "link": "Board", "error_m": [ -0.0014881792652856607, 1.4057368443648466e-05, 0.00323139336615946 ], "error_norm_m": 0.0035576366062448107, "predicted_m": [ 0.6495524290874222, -0.009177945549108781, 4.413034277337299e-05 ], "observed_m": [ 0.6510406083527078, -0.00919200291755243, -0.003187263023386087 ] }, { "marker_id": 208, "link": "Board", "error_m": [ -0.0008496576928241351, -0.0013676740350954814, 0.003630398282259455 ], "error_norm_m": 0.003971428225346896, "predicted_m": [ 0.3496749304901722, -0.08963564617683736, 0.0002544747154197144 ], "observed_m": [ 0.3505245881829963, -0.08826797214174188, -0.0033759235668397404 ] }, { "marker_id": 210, "link": "Board", "error_m": [ -0.00025861804113453193, 0.0023805563621476476, 0.0028815862683752554 ], "error_norm_m": 0.003746661354679755, "predicted_m": [ 0.01956849194127999, -0.02013937055184975, 0.0003375579399902561 ], "observed_m": [ 0.01982710998241452, -0.022519926913997398, -0.002544028328384999 ] }, { "marker_id": 211, "link": "Board", "error_m": [ -0.004533518798538971, 0.0026669382590026915, 0.0017103444337853591 ], "error_norm_m": 0.005530879718111678, "predicted_m": [ 0.24955293553705188, -0.009788384316551749, 0.00022447434320280112 ], "observed_m": [ 0.25408645433559085, -0.01245532257555444, -0.001485870090582558 ] }, { "marker_id": 214, "link": "Board", "error_m": [ -5.1240843096100885e-05, -0.0013616926196595037, 0.003205085665592703 ], "error_norm_m": 0.0034827297538316377, "predicted_m": [ 0.34955280892464446, -0.009635774624691007, 0.00017938834309544406 ], "observed_m": [ 0.34960404976774057, -0.008274082005031503, -0.003025697322497259 ] }, { "marker_id": 217, "link": "Board", "error_m": [ -0.001218279427446456, 1.284425557357416e-05, 0.003719527151852844 ], "error_norm_m": 0.00391398160082684, "predicted_m": [ 0.6496745506529499, -0.08917781710125514, 0.00011921671509764334 ], "observed_m": [ 0.6508928300803963, -0.08919066135682871, -0.0036003104367552004 ] }, { "marker_id": 229, "link": "Arm1", "error_m": [ 0.002229091273564743, 0.014936885439220893, 0.09638901451149129 ], "error_norm_m": 0.09756496047775948, "predicted_m": [ 0.17199164732773498, -0.1224896825976774, 0.16346610207943907 ], "observed_m": [ 0.16976255605417023, -0.1374265680368983, 0.06707708756794778 ] }, { "marker_id": 243, "link": "Arm1", "error_m": [ 0.001860639961206667, 0.014080952970627003, 0.0978694481175513 ], "error_norm_m": 0.09889471215621347, "predicted_m": [ 0.17204691063792782, -0.16578775618155792, 0.13948123664535664 ], "observed_m": [ 0.17018627067672115, -0.17986870915218492, 0.04161178852780534 ] }, { "marker_id": 244, "link": "Ellbow", "error_m": [ 0.037936131622145264, -0.09811915108741202, 0.12583201319656578 ], "error_norm_m": 0.16401284534349078, "predicted_m": [ 0.2969910584179111, -0.1319555521996664, 0.1297682603121064 ], "observed_m": [ 0.25905492679576586, -0.033836401112254375, 0.003936247115540596 ] }, { "marker_id": 245, "link": "Ellbow", "error_m": [ 0.01690670561913199, -0.04209952385405691, 0.09201202124529079 ], "error_norm_m": 0.10258858931320841, "predicted_m": [ 0.2619626943023342, -0.12341771468392443, 0.09585485532322784 ], "observed_m": [ 0.24505598868320222, -0.08131819082986752, 0.0038428340779370477 ] } ], "stage_idx": 2, "num_active_links": 5 } ], "markers": [ { "marker_id": 41, "link": "FingerA", "observed_position_m": [ 0.26528115191811324, -0.08363981243321626, 0.2343428250805548 ], "predicted_position_m": [ 0.2875134054080246, -0.408418538966646, 0.05151469895296328 ], "error_m": [ 0.02223225348991137, -0.3247787265334297, -0.1828281261275915 ], "error_norm_m": 0.3733652608468582 }, { "marker_id": 42, "link": "FingerA", "observed_position_m": [ 0.23690361615158803, -0.051399563635480296, 0.254431870457223 ], "predicted_position_m": [ 0.26066488527671516, -0.44269548191363284, 0.03274003120734733 ], "error_m": [ 0.023761269125127132, -0.3912959182781525, -0.22169183924987565 ], "error_norm_m": 0.45036026152578346 }, { "marker_id": 43, "link": "FingerB", "observed_position_m": [ 0.28273232786716923, -0.0675813782663145, 0.28148330441842223 ], "predicted_position_m": [ 0.2810131879215954, -0.43502312712631713, 0.06773576739741488 ], "error_m": [ -0.001719139945573822, -0.36744174886000264, -0.21374753702100735 ], "error_norm_m": 0.4250934060062525 }, { "marker_id": 46, "link": "Board", "observed_position_m": [ 0.5334733430257989, 0.18358237412886327, -0.023931991862542676 ], "predicted_position_m": [ 0.5359518253592175, 0.186062925371616, -0.027688212773239337 ], "error_m": [ 0.00247848233341863, 0.002480551242752732, -0.0037562209106966615 ], "error_norm_m": 0.00513859948574952 }, { "marker_id": 47, "link": "Board", "observed_position_m": [ 0.3441916935167346, -0.28540823179475067, -0.027045214650084484 ], "predicted_position_m": [ 0.3441925557690014, -0.28621005995305304, -0.027158440415112586 ], "error_m": [ 8.622522667534049e-07, -0.0008018281583023756, -0.00011322576502810142 ], "error_norm_m": 0.0008097834357355984 }, { "marker_id": 48, "link": "Board", "observed_position_m": [ 0.6874817922923626, -0.3195199621591605, -0.02660326511476371 ], "predicted_position_m": [ 0.6887042960787745, -0.31986432572912415, -0.02728166299850684 ], "error_m": [ 0.001222503786411866, -0.00034436356996364603, -0.0006783978837431315 ], "error_norm_m": 0.001439904672114309 }, { "marker_id": 51, "link": "Board", "observed_position_m": [ 0.16861413897895275, -0.1731731747363251, -0.02617561184396066 ], "predicted_position_m": [ 0.16758805372139304, -0.17201949300916958, -0.027186325012326124 ], "error_m": [ -0.0010260852575597057, 0.00115368172715552, -0.0010107131683654638 ], "error_norm_m": 0.001845365435912699 }, { "marker_id": 53, "link": "Board", "observed_position_m": [ 0.48568190237878706, 0.2111662393618947, -0.025512548316017385 ], "predicted_position_m": [ 0.4854509785233864, 0.21278587549107209, -0.027690616312313798 ], "error_m": [ -0.0002309238554006332, 0.0016196361291773986, -0.0021780679962964122 ], "error_norm_m": 0.002724064465907609 }, { "marker_id": 54, "link": "Board", "observed_position_m": [ 0.3409724927393613, -0.32937959050105536, -0.026410965422396588 ], "predicted_position_m": [ 0.34229980143762323, -0.3302629803764141, -0.027116212295749426 ], "error_m": [ 0.0013273086982619198, -0.0008833898753587421, -0.0007052468733528376 ], "error_norm_m": 0.0017434159586117248 }, { "marker_id": 55, "link": "Board", "observed_position_m": [ 0.2834914147320459, -0.2619350711381029, -0.02719797194925585 ], "predicted_position_m": [ 0.2836460569732936, -0.26234244254773015, -0.02715364724495874 ], "error_m": [ 0.00015464224124767112, -0.00040737140962726626, 4.432470429710858e-05 ], "error_norm_m": 0.00043798443758977896 }, { "marker_id": 56, "link": "Board", "observed_position_m": [ 0.4953909279097635, 0.16693271312130753, -0.024105919197317933 ], "predicted_position_m": [ 0.49794747324308974, 0.16923491483168265, -0.027655326586600037 ], "error_m": [ 0.002556545333326221, 0.0023022017103751236, -0.003549407389282104 ], "error_norm_m": 0.004943111325035744 }, { "marker_id": 57, "link": "Board", "observed_position_m": [ 0.6026423234696512, -0.36373386841009675, -0.02704186065769637 ], "predicted_position_m": [ 0.6029405488431328, -0.3633252410570794, -0.027202297028204564 ], "error_m": [ 0.0002982253734815643, 0.00040862735301733233, -0.00016043637050819348 ], "error_norm_m": 0.0005307113302012803 }, { "marker_id": 58, "link": "Board", "observed_position_m": [ 0.05194383230026378, -0.2212243933444691, -0.025550085921680177 ], "predicted_position_m": [ 0.04994846845262338, -0.21822905597177505, -0.02709005146012368 ], "error_m": [ -0.0019953638476404023, 0.002995337372694057, -0.0015399655384435024 ], "error_norm_m": 0.00391471796178494 }, { "marker_id": 59, "link": "Board", "observed_position_m": [ 0.6246519655895788, -0.2780781909557959, -0.027064428460941776 ], "predicted_position_m": [ 0.6261603071598917, -0.2779897436515538, -0.027292885453720384 ], "error_m": [ 0.0015083415703128766, 8.844730424206748e-05, -0.00022845699277860773 ], "error_norm_m": 0.0015281066114348986 }, { "marker_id": 61, "link": "Board", "observed_position_m": [ -0.02572420887112535, 0.344640562175392, -0.031071329437911643 ], "predicted_position_m": [ -0.02340703999082524, 0.3355993973356062, -0.02757727641501216 ], "error_m": [ 0.002317168880300112, -0.009041164839785842, 0.0034940530228994814 ], "error_norm_m": 0.00996595905103187 }, { "marker_id": 62, "link": "Board", "observed_position_m": [ 0.4042633016098454, -0.17264565595101924, -0.02800240231299132 ], "predicted_position_m": [ 0.4044923638656985, -0.17467795580024498, -0.02729029923602521 ], "error_m": [ 0.00022906225585306306, -0.0020322998492257327, 0.0007121030769661092 ], "error_norm_m": 0.002165595296089283 }, { "marker_id": 63, "link": "Board", "observed_position_m": [ 0.7754875321102975, -0.23349910832273166, -0.02775896789059061 ], "predicted_position_m": [ 0.7772850860009493, -0.2351590814569117, -0.02740103447054537 ], "error_m": [ 0.0017975538906517263, -0.0016599731341800372, 0.0003579334200452394 ], "error_norm_m": 0.002472817649803951 }, { "marker_id": 64, "link": "Board", "observed_position_m": [ -0.01965208808987145, -0.19191658080053772, -0.025181673510491966 ], "predicted_position_m": [ -0.02145705360148727, -0.1884580062231602, -0.027085922850510185 ], "error_m": [ -0.0018049655116158213, 0.0034585745773775267, -0.0019042493400182187 ], "error_norm_m": 0.004341175434644921 }, { "marker_id": 66, "link": "Board", "observed_position_m": [ 0.20881479110130813, -0.3647612589234731, -0.027320064024533606 ], "predicted_position_m": [ 0.2098297948231209, -0.3631051663333437, -0.02702582908849886 ], "error_m": [ 0.0010150037218127628, 0.0016560925901293877, 0.0002942349360347471 ], "error_norm_m": 0.001964548146510692 }, { "marker_id": 68, "link": "Board", "observed_position_m": [ 0.5706979119768514, 0.16931574429426913, -0.02449461345005251 ], "predicted_position_m": [ 0.572994370976927, 0.17131944524239573, -0.02769101263159909 ], "error_m": [ 0.002296459000075579, 0.002003700948126602, -0.003196399181546579 ], "error_norm_m": 0.004416504178232283 }, { "marker_id": 69, "link": "Board", "observed_position_m": [ 0.010267926098110197, -0.28485516575225284, -0.02491656075636102 ], "predicted_position_m": [ 0.0075648456223840425, -0.2813937832556329, -0.027011674551107305 ], "error_m": [ -0.0027030804757261547, 0.0034613824966199247, -0.0020951137947462853 ], "error_norm_m": 0.004865934099337443 }, { "marker_id": 71, "link": "Board", "observed_position_m": [ 0.7473678090850286, -0.28097791094482233, -0.024573692862224935 ], "predicted_position_m": [ 0.749708180235857, -0.2830612011927827, -0.027343647769272693 ], "error_m": [ 0.002340371150828302, -0.00208329024796039, -0.002769954907047758 ], "error_norm_m": 0.004182114963502822 }, { "marker_id": 72, "link": "Board", "observed_position_m": [ 0.44107182939961276, 0.19171263038831074, -0.024468942746215777 ], "predicted_position_m": [ 0.4402183910588402, 0.19479683311685514, -0.02765339104126457 ], "error_m": [ -0.000853438340772561, 0.0030842027285443996, -0.003184448295048794 ], "error_norm_m": 0.004514573558609995 }, { "marker_id": 75, "link": "Board", "observed_position_m": [ -0.028429038040035173, 0.19627250864273793, -0.028137448316918428 ], "predicted_position_m": [ -0.02647141494880341, 0.19434461852845472, -0.0274432232180736 ], "error_m": [ 0.001957623091231764, -0.0019278901142832094, 0.0006942250988448279 ], "error_norm_m": 0.002833901365245595 }, { "marker_id": 76, "link": "Board", "observed_position_m": [ 0.6822304894997765, 0.1690120129572431, -0.02621417491452153 ], "predicted_position_m": [ 0.6844800916645605, 0.1676495806923791, -0.02773767035864721 ], "error_m": [ 0.0022496021647839815, -0.0013624322648640164, -0.0015234954441256804 ], "error_norm_m": 0.0030394028927430753 }, { "marker_id": 79, "link": "Board", "observed_position_m": [ 0.31210071626228, -0.15850009515132799, -0.026834280221062483 ], "predicted_position_m": [ 0.3120680718076531, -0.15882899282903906, -0.027263647660594328 ], "error_m": [ -3.2644454626862274e-05, -0.00032889767771107636, -0.0004293674395318449 ], "error_norm_m": 0.0005418447572430288 }, { "marker_id": 82, "link": "Board", "observed_position_m": [ 0.21983791092481708, 0.2993230293278962, -0.028105966374640457 ], "predicted_position_m": [ 0.21823156252909226, 0.2973781337892367, -0.027649975385221594 ], "error_m": [ -0.0016063483957248215, -0.0019448955386594524, 0.0004559909894188627 ], "error_norm_m": 0.0025633769927921922 }, { "marker_id": 83, "link": "Board", "observed_position_m": [ 0.04082033648971801, 0.3484819264221412, -0.03227931652032235 ], "predicted_position_m": [ 0.04316770080929464, 0.3390909994254693, -0.02761047645891088 ], "error_m": [ 0.0023473643195766336, -0.009390926996671933, 0.00466884006141147 ], "error_norm_m": 0.010746985466849943 }, { "marker_id": 84, "link": "Board", "observed_position_m": [ 0.40831310397839976, 0.25619216755562296, -0.025021892964683323 ], "predicted_position_m": [ 0.40662058356961767, 0.25884560595123907, -0.027698450187053428 ], "error_m": [ -0.0016925204087820944, 0.0026534383956161034, -0.0026765572223701045 ], "error_norm_m": 0.004131503263715913 }, { "marker_id": 85, "link": "Board", "observed_position_m": [ 0.5032734914600895, -0.3117732809161846, -0.026678432157073776 ], "predicted_position_m": [ 0.5045823628239121, -0.31217530822942635, -0.027206135643551992 ], "error_m": [ 0.001308871363822628, -0.00040202731324173735, -0.0005277034864782162 ], "error_norm_m": 0.001467392645909247 }, { "marker_id": 86, "link": "Board", "observed_position_m": [ 0.36324913881224613, 0.28914654245460436, -0.024192046816493718 ], "predicted_position_m": [ 0.36196936424642545, 0.2923674880966266, -0.0277098687215852 ], "error_m": [ -0.0012797745658206794, 0.0032209456420222438, -0.0035178219050914818 ], "error_norm_m": 0.004938358505022196 }, { "marker_id": 92, "link": "Board", "observed_position_m": [ 0.6444678953424797, -0.1849280223950365, -0.027549065323774297 ], "predicted_position_m": [ 0.6448969278027353, -0.18405108172345475, -0.027389539705852808 ], "error_m": [ 0.00042903246025560726, 0.0008769406715817551, 0.00015952561792148892 ], "error_norm_m": 0.0009892129276351334 }, { "marker_id": 95, "link": "Board", "observed_position_m": [ 0.18694097629090473, -0.27514675252799914, -0.02575233979337774 ], "predicted_position_m": [ 0.18598372035814206, -0.27398149324641674, -0.027098822959828805 ], "error_m": [ -0.0009572559327626629, 0.0011652592815823981, -0.0013464831664510638 ], "error_norm_m": 0.002021678765694324 }, { "marker_id": 96, "link": "Board", "observed_position_m": [ 0.3698039203776613, -0.1853775837777364, -0.02746863404636546 ], "predicted_position_m": [ 0.3695797951493044, -0.1861212440778488, -0.027263860273928044 ], "error_m": [ -0.0002241252283569084, -0.0007436603001124142, 0.00020477377243741449 ], "error_norm_m": 0.0008032403487298011 }, { "marker_id": 97, "link": "Board", "observed_position_m": [ 0.30328993176370517, -0.35876479964321073, -0.026746049291299714 ], "predicted_position_m": [ 0.30442424063811746, -0.35940080328077295, -0.027071821788168846 ], "error_m": [ 0.0011343088744122931, -0.0006360036375622213, -0.0003257724968691311 ], "error_norm_m": 0.0013406285724536864 }, { "marker_id": 102, "link": "Board", "observed_position_m": [ 0.6496719726204757, -0.22300284598268666, -0.02679798740549635 ], "predicted_position_m": [ 0.6495551739653214, -0.22220400040800298, -0.02735579746225907 ], "error_m": [ -0.00011679865515434873, 0.000798845574683682, -0.0005578100567627184 ], "error_norm_m": 0.00098129925989129 }, { "marker_id": 103, "link": "Board", "observed_position_m": [ 0.10661303628186783, -0.18915196813598326, -0.026163052638612832 ], "predicted_position_m": [ 0.10552199183590182, -0.1877442232713465, -0.02714366111486661 ], "error_m": [ -0.0010910444459660135, 0.0014077448646367674, -0.0009806084762537769 ], "error_norm_m": 0.0020331543401043684 }, { "marker_id": 105, "link": "Board", "observed_position_m": [ 0.5233310047644485, -0.26518725780646896, -0.02707138500322739 ], "predicted_position_m": [ 0.5247713540122755, -0.26564446416617027, -0.027258914021087224 ], "error_m": [ 0.0014403492478269886, -0.00045720635970131207, -0.00018752901785983392 ], "error_norm_m": 0.001522764178593183 }, { "marker_id": 113, "link": "Arm2", "observed_position_m": [ 0.29425163585330166, -0.21114086803628263, 0.21818723804010542 ], "predicted_position_m": [ 0.2920929814098981, -0.3076723568280021, 0.08224195506336499 ], "error_m": [ -0.0021586544434035737, -0.09653148879171947, -0.13594528297674044 ], "error_norm_m": 0.1667456388664421 }, { "marker_id": 124, "link": "Arm2", "observed_position_m": [ 0.33141495079453903, -0.2527839951976955, 0.23766278779762892 ], "predicted_position_m": [ 0.2657538161849513, -0.35285307605591026, 0.10979102011627255 ], "error_m": [ -0.06566113460958772, -0.10006908085821475, -0.12787176768135639 ], "error_norm_m": 0.1751467799075424 }, { "marker_id": 198, "link": "Arm1", "observed_position_m": [ 0.1340827114222762, -0.05536552789128119, 0.07671999833803478 ], "predicted_position_m": [ 0.17184843430197097, -0.03598311779665144, 0.13863479650856914 ], "error_m": [ 0.03776572287969476, 0.01938241009462975, 0.06191479817053436 ], "error_norm_m": 0.07506910068863427 }, { "marker_id": 205, "link": "Board", "observed_position_m": [ 0.7560702426064654, -0.08629218849585878, -0.009604982535404665 ], "predicted_position_m": [ 0.7496744240405424, -0.0890252074093944, 7.413071499028628e-05 ], "error_m": [ -0.006395818565922973, -0.002733018913535626, 0.009679113250394951 ], "error_norm_m": 0.011918939584708011 }, { "marker_id": 206, "link": "Board", "observed_position_m": [ 0.6510406083527078, -0.00919200291755243, -0.003187263023386087 ], "predicted_position_m": [ 0.6495524290874222, -0.009177945549108781, 4.413034277337299e-05 ], "error_m": [ -0.0014881792652856607, 1.4057368443648466e-05, 0.00323139336615946 ], "error_norm_m": 0.0035576366062448107 }, { "marker_id": 208, "link": "Board", "observed_position_m": [ 0.3505245881829963, -0.08826797214174188, -0.0033759235668397404 ], "predicted_position_m": [ 0.3496749304901722, -0.08963564617683736, 0.0002544747154197144 ], "error_m": [ -0.0008496576928241351, -0.0013676740350954814, 0.003630398282259455 ], "error_norm_m": 0.003971428225346896 }, { "marker_id": 210, "link": "Board", "observed_position_m": [ 0.01982710998241452, -0.022519926913997398, -0.002544028328384999 ], "predicted_position_m": [ 0.01956849194127999, -0.02013937055184975, 0.0003375579399902561 ], "error_m": [ -0.00025861804113453193, 0.0023805563621476476, 0.0028815862683752554 ], "error_norm_m": 0.003746661354679755 }, { "marker_id": 211, "link": "Board", "observed_position_m": [ 0.25408645433559085, -0.01245532257555444, -0.001485870090582558 ], "predicted_position_m": [ 0.24955293553705188, -0.009788384316551749, 0.00022447434320280112 ], "error_m": [ -0.004533518798538971, 0.0026669382590026915, 0.0017103444337853591 ], "error_norm_m": 0.005530879718111678 }, { "marker_id": 214, "link": "Board", "observed_position_m": [ 0.34960404976774057, -0.008274082005031503, -0.003025697322497259 ], "predicted_position_m": [ 0.34955280892464446, -0.009635774624691007, 0.00017938834309544406 ], "error_m": [ -5.1240843096100885e-05, -0.0013616926196595037, 0.003205085665592703 ], "error_norm_m": 0.0034827297538316377 }, { "marker_id": 217, "link": "Board", "observed_position_m": [ 0.6508928300803963, -0.08919066135682871, -0.0036003104367552004 ], "predicted_position_m": [ 0.6496745506529499, -0.08917781710125514, 0.00011921671509764334 ], "error_m": [ -0.001218279427446456, 1.284425557357416e-05, 0.003719527151852844 ], "error_norm_m": 0.00391398160082684 }, { "marker_id": 229, "link": "Arm1", "observed_position_m": [ 0.16976255605417023, -0.1374265680368983, 0.06707708756794778 ], "predicted_position_m": [ 0.17199164732773498, -0.1224896825976774, 0.16346610207943907 ], "error_m": [ 0.002229091273564743, 0.014936885439220893, 0.09638901451149129 ], "error_norm_m": 0.09756496047775948 }, { "marker_id": 243, "link": "Arm1", "observed_position_m": [ 0.17018627067672115, -0.17986870915218492, 0.04161178852780534 ], "predicted_position_m": [ 0.17204691063792782, -0.16578775618155792, 0.13948123664535664 ], "error_m": [ 0.001860639961206667, 0.014080952970627003, 0.0978694481175513 ], "error_norm_m": 0.09889471215621347 }, { "marker_id": 244, "link": "Ellbow", "observed_position_m": [ 0.25905492679576586, -0.033836401112254375, 0.003936247115540596 ], "predicted_position_m": [ 0.2969910584179111, -0.1319555521996664, 0.1297682603121064 ], "error_m": [ 0.037936131622145264, -0.09811915108741202, 0.12583201319656578 ], "error_norm_m": 0.16401284534349078 }, { "marker_id": 245, "link": "Ellbow", "observed_position_m": [ 0.24505598868320222, -0.08131819082986752, 0.0038428340779370477 ], "predicted_position_m": [ 0.2619626943023342, -0.12341771468392443, 0.09585485532322784 ], "error_m": [ 0.01690670561913199, -0.04209952385405691, 0.09201202124529079 ], "error_norm_m": 0.10258858931320841 } ] }