ChK/appRobotRender
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity
Files
761919bb938e7c4bae9dbc82034e3bb3a225a076
appRobotRender/data/evaluations/Scene9/robot_state.json
chk 761919bb93 16MPixel Bilder + Arbeiten an Statistik
2026-05-31 17:39:25 +02:00

4785 lines
123 KiB
JSON
Raw Blame History

{
"schema_version": "1.0",
"method": "deterministic_geometric_sequential_prefix",
"created_utc": "2026-05-31T10:26:00Z",
"root_pose": {
"translation_m": [
0.0024599740249525714,
0.005016308983537485,
-0.001265594404518032
],
"rotation_matrix": [
[
0.9999616284181071,
0.008444232412078308,
0.0023316582895388815
],
[
-0.008489384628346494,
0.9997622066656643,
0.020086325488607042
],
[
-0.0021614902360092133,
-0.020105349088565403,
0.9997955305451142
]
],
"euler_xyz_deg": [
-1.152031962022381,
0.12384436441649664,
-0.4864128888732429
]
},
"movements": {
"x": {
"value_m": 0.05408348484325045,
"value_mm": 54.08348484325045,
"joint_type": "linear",
"link": "Base"
},
"y": {
"value_rad": 0.10830851353283366,
"value_deg": 6.20562071076693,
"joint_type": "revolute",
"link": "Arm1"
},
"z": {
"value_rad": 1.9912991164152878,
"value_deg": 114.09303511872598,
"joint_type": "revolute",
"link": "Ellbow"
},
"a": {
"value_rad": 2.373559574730061,
"value_deg": 135.99494605489903,
"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.0024599740249525714,
0.005016308983537485,
-0.001265594404518032
],
"rotation_matrix": [
[
0.9999616284181071,
0.008444232412078308,
0.0023316582895388815
],
[
-0.008489384628346494,
0.9997622066656643,
0.020086325488607042
],
[
-0.0021614902360092133,
-0.020105349088565403,
0.9997955305451142
]
]
},
"Base": {
"translation_m": [
0.05657869013191384,
0.004878554686479956,
0.014614233159785875
],
"rotation_matrix": [
[
0.9999616284181071,
0.008444232412078308,
0.0023316582895388815
],
[
-0.008489384628346494,
0.9997622066656643,
0.020086325488607042
],
[
-0.0021614902360092133,
-0.020105349088565403,
0.9997955305451142
]
]
},
"Arm1": {
"translation_m": [
0.16759137098143934,
0.11282292534424089,
0.057195890406789934
],
"rotation_matrix": [
[
0.9999616284180953,
0.008142707298373813,
0.003230790810525697
],
[
-0.008489384628346393,
0.9917326953674278,
0.12803980352947267
],
[
-0.0021614902360091877,
-0.12806231786551017,
0.9917637675892627
]
]
},
"Ellbow": {
"translation_m": [
0.16555569415684587,
-0.13511024849761605,
0.08921146987316747
],
"rotation_matrix": [
[
0.999961628415279,
-0.006273348461467673,
0.006114473852200264
],
[
-0.008489384628322483,
-0.5217300815517609,
0.853068374956507
],
[
-0.0021614902360031,
-0.8530875494938276,
-0.5217633188112073
]
]
},
"Arm2": {
"translation_m": [
0.255552240714221,
-0.13587429311416507,
0.08901693575192719
],
"rotation_matrix": [
[
-0.7150030648718144,
-0.006273348461446101,
-0.6990931714130618
],
[
0.5987514454475817,
-0.5217300815499668,
-0.6076960001316714
],
[
-0.3609256485671765,
-0.853087549490894,
0.37679478380549025
]
]
},
"Hand": {
"translation_m": [
0.25712057782958253,
-0.005441772726673372,
0.3022888231246507
],
"rotation_matrix": [
[
-0.7150030648718144,
-0.006273348461446101,
-0.6990931714130618
],
[
0.5987514454475817,
-0.5217300815499668,
-0.6076960001316714
],
[
-0.3609256485671765,
-0.853087549490894,
0.37679478380549025
]
]
},
"Palm": {
"translation_m": [
0.25712057782958253,
-0.005441772726673372,
0.3022888231246507
],
"rotation_matrix": [
[
-0.7150030648718144,
-0.006273348461446101,
-0.6990931714130618
],
[
0.5987514454475817,
-0.5217300815499668,
-0.6076960001316714
],
[
-0.3609256485671765,
-0.853087549490894,
0.37679478380549025
]
]
},
"FingerA": {
"translation_m": [
0.25448013276624587,
0.015213785909365795,
0.33070318476256333
],
"rotation_matrix": [
[
-0.7150030648718144,
-0.006273348461446101,
-0.6990931714130618
],
[
0.5987514454475817,
-0.5217300815499668,
-0.6076960001316714
],
[
-0.3609256485671765,
-0.853087549490894,
0.37679478380549025
]
]
},
"FingerB": {
"translation_m": [
0.2602001572852204,
0.01042377434578514,
0.3335905899511007
],
"rotation_matrix": [
[
-0.7150030648718144,
-0.006273348461446101,
-0.6990931714130618
],
[
0.5987514454475817,
-0.5217300815499668,
-0.6076960001316714
],
[
-0.3609256485671765,
-0.853087549490894,
0.37679478380549025
]
]
}
},
"stage_reports": [
{
"method": "deterministic_geometric_prefix",
"active_links": [
"Board",
"Base",
"Arm1"
],
"active_observations": 41,
"joint_updates": [
{
"pass": 0,
"updates": [
{
"link": "Base",
"joint_variable": "x",
"joint_type": "linear",
"old": 0.0,
"new": 0.04362662540805054,
"info": {
"reason": "weighted_projection",
"used_markers": 3,
"axis_world": [
0.9999616284171068,
-0.008489384628338002,
-0.002161490236007051
],
"per_marker": [
{
"marker_id": 198,
"q_i": 0.018477416253846937,
"weight": 1.0
},
{
"marker_id": 229,
"q_i": 0.05502944059138241,
"weight": 1.0
},
{
"marker_id": 243,
"q_i": 0.05737301937892227,
"weight": 1.0
}
]
}
},
{
"link": "Arm1",
"joint_variable": "y",
"joint_type": "revolute",
"old": 0.0,
"new": -0.04236508039060549,
"info": {
"reason": "2d_alignment+normal_tiebreak",
"used_markers": 3,
"axis_world": [
-0.9999616284171068,
0.008489384628338002,
0.002161490236007051
],
"axis_id": 0,
"theta_rad": -0.042365080390605284,
"theta_alt_rad": 3.0992275731991876,
"score_theta": 0.004726475944067662,
"score_theta_alt": 0.9302118285148774,
"best_score": 0.004726475944067662,
"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.04362662540805054,
"new": 0.04362662540805053,
"info": {
"reason": "weighted_projection",
"used_markers": 3,
"axis_world": [
0.9999616284171068,
-0.008489384628338002,
-0.002161490236007051
],
"per_marker": [
{
"marker_id": 198,
"q_i": 0.01847741625384694,
"weight": 1.0
},
{
"marker_id": 229,
"q_i": 0.05502944059138241,
"weight": 1.0
},
{
"marker_id": 243,
"q_i": 0.057373019378922266,
"weight": 1.0
}
]
}
},
{
"link": "Arm1",
"joint_variable": "y",
"joint_type": "revolute",
"old": -0.04236508039060549,
"new": -0.04236508039060549,
"info": {
"reason": "2d_alignment+normal_tiebreak",
"used_markers": 3,
"axis_world": [
-0.9999616284171068,
0.008489384628338002,
0.002161490236007051
],
"axis_id": 0,
"theta_rad": -0.04236508039060527,
"theta_alt_rad": 3.0992275731991876,
"score_theta": 0.004726475944067662,
"score_theta_alt": 0.9302118285148774,
"best_score": 0.004726475944067662,
"per_marker": [
{
"marker_id": 198,
"weight": 1.0
},
{
"marker_id": 229,
"weight": 1.0
},
{
"marker_id": 243,
"weight": 1.0
}
]
}
}
]
}
],
"root_link": "Board",
"root_pose": {
"reason": "kabsch",
"used_markers": [
210,
211,
214,
208,
206,
205,
207,
217,
46,
47,
51,
53,
54,
55,
56,
58,
60,
61,
62,
63,
64,
66,
68,
69,
72,
75,
79,
83,
84,
85,
86,
92,
95,
96,
97,
102,
103,
105
]
},
"marker_stats": {
"num_markers_used": 41,
"mean_error_m": 0.012104686557881932,
"rms_error_m": 0.01674241741984034,
"median_error_m": 0.007047035175658761,
"worst_error_m": 0.05957290626617817
},
"marker_reports": [
{
"marker_id": 46,
"link": "Board",
"error_m": [
-0.013071464442725,
-0.012453648346596069,
0.016511727974226224
],
"error_norm_m": 0.024466174619522028,
"predicted_m": [
0.5406516238004262,
0.18530751827789943,
-0.033448441747951724
],
"observed_m": [
0.5537230882431512,
0.1977611666244955,
-0.04996016972217795
]
},
{
"marker_id": 47,
"link": "Board",
"error_m": [
0.0008721910810426392,
0.003837784471127148,
0.004571018690541762
],
"error_norm_m": 0.006031875230635755,
"predicted_m": [
0.3441935007486563,
-0.2849262112708967,
-0.02354307544450357
],
"observed_m": [
0.34332130966761365,
-0.2887639957420238,
-0.028114094135045332
]
},
{
"marker_id": 51,
"link": "Board",
"error_m": [
0.0023129226144513737,
-0.002152002975723405,
0.007277318284625859
],
"error_norm_m": 0.007933479012621942,
"predicted_m": [
0.1687367974887361,
-0.16899564696596553,
-0.02546298197884166
],
"observed_m": [
0.16642387487428473,
-0.16684364399024212,
-0.03274030026346752
]
},
{
"marker_id": 53,
"link": "Board",
"error_m": [
0.0009220742534559734,
-0.00011407742484240146,
-0.004083807032116291
],
"error_norm_m": 0.0041881636146773845,
"predicted_m": [
0.4904198654590923,
0.2125295197648856,
-0.03387819630621625
],
"observed_m": [
0.4894977912056363,
0.212643597189728,
-0.029794389274099962
]
},
{
"marker_id": 54,
"link": "Board",
"error_m": [
0.0026876126029042324,
-0.0015720752606889765,
-0.015421576774879476
],
"error_norm_m": 0.015732759209752815,
"predicted_m": [
0.3418616075192047,
-0.3289490972806476,
-0.022653198296289687
],
"observed_m": [
0.33917399491630046,
-0.3273770220199586,
-0.007231621521410211
]
},
{
"marker_id": 55,
"link": "Board",
"error_m": [
-7.456189087357012e-05,
0.001625554336729007,
0.0037037111592386797
],
"error_norm_m": 0.004045424913194935,
"predicted_m": [
0.28388814642167004,
-0.26045821613532605,
-0.02389400783448468
],
"observed_m": [
0.2839627083125436,
-0.26208377047205506,
-0.02759771899372336
]
},
{
"marker_id": 56,
"link": "Board",
"error_m": [
-0.01265274504762759,
-0.013561492382301393,
0.018731716020361527
],
"error_norm_m": 0.026360637661918422,
"predicted_m": [
0.5024814732941351,
0.1688643573695323,
-0.033029073570061046
],
"observed_m": [
0.5151342183417627,
0.18242584975183368,
-0.05176078959042257
]
},
{
"marker_id": 58,
"link": "Board",
"error_m": [
0.0001723402364918747,
0.004035049643894895,
0.003616032508958065
],
"error_norm_m": 0.005420979421806723,
"predicted_m": [
0.05064262618971274,
-0.21401541587418343,
-0.02428310374461435
],
"observed_m": [
0.05047028595322087,
-0.21805046551807833,
-0.027899136253572415
]
},
{
"marker_id": 60,
"link": "Board",
"error_m": [
0.00463310817165119,
-0.0028117819517218257,
-0.005116707514237484
],
"error_norm_m": 0.0074533552753443845,
"predicted_m": [
0.4391362102742091,
0.28452301506431216,
-0.03520497641213836
],
"observed_m": [
0.43450310210255794,
0.287334797016034,
-0.030088268897900873
]
},
{
"marker_id": 61,
"link": "Board",
"error_m": [
-0.00691382558947783,
-0.02422789402762071,
0.02410168760212969
],
"error_norm_m": 0.034866648513529226,
"predicted_m": [
-0.017186993384537545,
0.34040842616559613,
-0.03526353116172124
],
"observed_m": [
-0.010273167795059716,
0.36463632019321685,
-0.05936521876385093
]
},
{
"marker_id": 62,
"link": "Board",
"error_m": [
0.0003521065756239006,
0.00559001598665565,
0.0026869724433836346
],
"error_norm_m": 0.006212252303566424,
"predicted_m": [
0.4056022056791012,
-0.17402606404855112,
-0.025914320861504775
],
"observed_m": [
0.4052500991034773,
-0.17961608003520677,
-0.02860129330488841
]
},
{
"marker_id": 63,
"link": "Board",
"error_m": [
-0.0158783209757567,
0.007330017205507022,
0.02254905104485634
],
"error_norm_m": 0.028536116278598967,
"predicted_m": [
0.7777723842017723,
-0.23822554041647467,
-0.02549247671060849
],
"observed_m": [
0.793650705177529,
-0.2455555576219817,
-0.04804152775546483
]
},
{
"marker_id": 64,
"link": "Board",
"error_m": [
-0.00024947886248814777,
0.0031103977521285964,
0.0015026763573656142
],
"error_norm_m": 0.0034633582133906677,
"predicted_m": [
-0.02046232194973048,
-0.18353671865193455,
-0.024729607632139067
],
"observed_m": [
-0.020212843087242333,
-0.18664711640406315,
-0.02623228398950468
]
},
{
"marker_id": 66,
"link": "Board",
"error_m": [
-0.002169221374189595,
-0.003326372415850598,
0.0022722362157080907
],
"error_norm_m": 0.004575295863564253,
"predicted_m": [
0.2090710727753069,
-0.36045632245526643,
-0.021710519015962968
],
"observed_m": [
0.2112402941494965,
-0.35712995003941583,
-0.02398275523167106
]
},
{
"marker_id": 68,
"link": "Board",
"error_m": [
0.0059047524653308425,
-0.0031911635951974715,
-0.00924057582361612
],
"error_norm_m": 0.011420939905285513,
"predicted_m": [
0.5775452286447659,
0.1701967606003062,
-0.033230900949978014
],
"observed_m": [
0.571640476179435,
0.17338792419550367,
-0.023990325126361893
]
},
{
"marker_id": 69,
"link": "Board",
"error_m": [
-0.010207407150906253,
-0.0032140932356206076,
-0.035567820288336355
],
"error_norm_m": 0.03714285121170729,
"predicted_m": [
0.0076314251493094145,
-0.2767397820557746,
-0.0229226361119002
],
"observed_m": [
0.017838832300215667,
-0.273525688820154,
0.012645184176436158
]
},
{
"marker_id": 72,
"link": "Board",
"error_m": [
0.0021786185837171512,
-0.004019668474775084,
-0.0011331688472769746
],
"error_norm_m": 0.004710433654862088,
"predicted_m": [
0.44501028151206423,
0.19499801056971586,
-0.03342007940246738
],
"observed_m": [
0.4428316629283471,
0.19901767904449094,
-0.0322869105551904
]
},
{
"marker_id": 75,
"link": "Board",
"error_m": [
0.0053490747346992,
0.0009851390679179728,
0.001306643558522634
],
"error_norm_m": 0.005593783772149608,
"predicted_m": [
-0.021659615353954997,
0.199219859655652,
-0.03241656091498727
],
"observed_m": [
-0.027008690088654197,
0.19823472058773403,
-0.033723204473509905
]
},
{
"marker_id": 79,
"link": "Board",
"error_m": [
0.0015068694512451186,
0.005282261789669174,
0.00288885743245252
],
"error_norm_m": 0.006206322777839621,
"predicted_m": [
0.31334077448953723,
-0.15725544722430798,
-0.026036083695623685
],
"observed_m": [
0.3118339050382921,
-0.16253770901397716,
-0.028924941128076205
]
},
{
"marker_id": 83,
"link": "Board",
"error_m": [
0.006775247566416467,
0.0036733811567694064,
-0.00797430575930876
],
"error_norm_m": 0.011089962175412757,
"predicted_m": [
0.04941907778341697,
0.3432323968176374,
-0.03547560031504497
],
"observed_m": [
0.0426438302170005,
0.339559015660868,
-0.027501294555736213
]
},
{
"marker_id": 84,
"link": "Board",
"error_m": [
0.004551836715352864,
-0.002718376770611375,
-0.004642404012657454
],
"error_norm_m": 0.007047035175658761,
"predicted_m": [
0.4120528422576719,
0.2593671624020346,
-0.03463642235613811
],
"observed_m": [
0.40750100554231905,
0.262085539172646,
-0.029994018343480658
]
},
{
"marker_id": 85,
"link": "Board",
"error_m": [
-0.000916708693676993,
0.002119426113185885,
0.005238579736888606
],
"error_norm_m": 0.005724948867724244,
"predicted_m": [
0.5043160245339793,
-0.3124912515327591,
-0.023362709204236345
],
"observed_m": [
0.5052327332276563,
-0.31461067764594497,
-0.02860128894112495
]
},
{
"marker_id": 86,
"link": "Board",
"error_m": [
0.005183414741022241,
-0.001869012826053451,
-0.006179467547496376
],
"error_norm_m": 0.008279300483250976,
"predicted_m": [
0.3677381953969461,
0.29332780147835846,
-0.03521535856749702
],
"observed_m": [
0.36255478065592384,
0.2951968143044119,
-0.02903589102000064
]
},
{
"marker_id": 92,
"link": "Board",
"error_m": [
-0.0017083594791625911,
0.00170303643189873,
0.0005736671286161663
],
"error_norm_m": 0.0024794997827936494,
"predicted_m": [
0.6459007347108364,
-0.1858045111122829,
-0.026238095399216402
],
"observed_m": [
0.647609094189999,
-0.18750754754418164,
-0.02681176252783257
]
},
{
"marker_id": 95,
"link": "Board",
"error_m": [
-0.0001476915772945231,
-0.002753779608665352,
0.003373259031671797
],
"error_norm_m": 0.004357062247645791,
"predicted_m": [
0.18611487032737448,
-0.2711162407994176,
-0.023451863007203685
],
"observed_m": [
0.186262561904669,
-0.26836246119075224,
-0.026825122038875483
]
},
{
"marker_id": 96,
"link": "Board",
"error_m": [
0.0008351041742055698,
0.0038425930321047963,
0.00430729768901832
],
"error_norm_m": 0.005832300881639977,
"predicted_m": [
0.3705773661912831,
-0.18511682137740493,
-0.025609820081442213
],
"observed_m": [
0.36974226201707755,
-0.18895941440950972,
-0.029917117770460532
]
},
{
"marker_id": 97,
"link": "Board",
"error_m": [
-0.002038430423908888,
-0.003770267341488054,
0.006702033713791033
],
"error_norm_m": 0.007955335965262584,
"predicted_m": [
0.30369750429104686,
-0.35770026478537825,
-0.021986571035044734
],
"observed_m": [
0.30573593471495575,
-0.3539299974438902,
-0.028688604748835767
]
},
{
"marker_id": 102,
"link": "Board",
"error_m": [
-0.0031069906188920804,
0.0012413262809079784,
0.005990918260924717
],
"error_norm_m": 0.006861878988341128,
"predicted_m": [
0.6501783262927148,
-0.22399448808793507,
-0.025480818133082388
],
"observed_m": [
0.6532853169116069,
-0.22523581436884305,
-0.031471736394007105
]
},
{
"marker_id": 103,
"link": "Board",
"error_m": [
0.0006442089868049922,
0.0031736767985359737,
0.0037423451148866915
],
"error_norm_m": 0.004948977328616706,
"predicted_m": [
0.10651719662765503,
-0.18409482436457583,
-0.025014528443833572
],
"observed_m": [
0.10587298764085004,
-0.1872685011631118,
-0.028756873558720263
]
},
{
"marker_id": 105,
"link": "Board",
"error_m": [
-0.0019246428729866594,
0.0025750219350123005,
0.0037087148619832193
],
"error_norm_m": 0.004908111050274641,
"predicted_m": [
0.5249679039328917,
-0.266174303855376,
-0.024341399729036185
],
"observed_m": [
0.5268925468058784,
-0.2687493257903883,
-0.028050114591019405
]
},
{
"marker_id": 198,
"link": "Arm1",
"error_m": [
0.025269418454218345,
0.026071053187655818,
-0.04723015813726311
],
"error_norm_m": 0.05957290626617817,
"predicted_m": [
0.15583826530737938,
-0.04782243093351786,
0.08864871099022203
],
"observed_m": [
0.13056884685316103,
-0.07389348412117368,
0.13587886912748515
]
},
{
"marker_id": 205,
"link": "Board",
"error_m": [
0.0032965571069566435,
0.0032027050878753044,
-0.01274684818948499
],
"error_norm_m": 0.01355015672990927,
"predicted_m": [
0.7516719139189326,
-0.09132330218998558,
-0.0007772920043905215
],
"observed_m": [
0.748375356811976,
-0.09452600727786088,
0.011969556185094469
]
},
{
"marker_id": 206,
"link": "Board",
"error_m": [
0.005307267981266461,
0.0032227200669935636,
-0.009488265709367758
],
"error_norm_m": 0.011339321153699776,
"predicted_m": [
0.6523512896700883,
-0.010493387193897797,
-0.0021695709078748326
],
"observed_m": [
0.6470440216888218,
-0.01371610726089136,
0.007318694801492925
]
},
{
"marker_id": 207,
"link": "Board",
"error_m": [
0.0054688122362741565,
0.0032042277659066944,
-0.015391001964001989
],
"error_norm_m": 0.0166450570532919,
"predicted_m": [
0.7523474525118989,
-0.011342325656732447,
-0.002385719931475754
],
"observed_m": [
0.7468786402756248,
-0.014546553422639141,
0.013005282032526235
]
},
{
"marker_id": 208,
"link": "Board",
"error_m": [
0.002959970495894637,
0.006205952039261331,
-0.0013024613557298882
],
"error_norm_m": 0.0069979762526996584,
"predicted_m": [
0.3516872625516899,
-0.087927548338647,
8.730409001316366e-05
],
"observed_m": [
0.3487272920557953,
-0.09413350037790832,
0.001389765445743052
]
},
{
"marker_id": 210,
"link": "Board",
"error_m": [
0.004170160093314321,
0.00224196415185921,
0.0001882955000761091
],
"error_norm_m": 0.004738364027535453,
"predicted_m": [
0.022291021442560007,
-0.01514269694469615,
-0.000606778568303374
],
"observed_m": [
0.018120861349245686,
-0.01738466109655536,
-0.0007950740683794831
]
},
{
"marker_id": 211,
"link": "Board",
"error_m": [
0.0016848423509987498,
0.004142719827073311,
-0.006240210835369596
],
"error_norm_m": 0.007677307638958428,
"predicted_m": [
0.2523666383028454,
-0.0070976333425592,
-0.0013049748134711472
],
"observed_m": [
0.25068179595184664,
-0.011240353169632511,
0.004935236021898448
]
},
{
"marker_id": 214,
"link": "Board",
"error_m": [
0.0015871867759205682,
0.006286868700762466,
-0.006347334273071395
],
"error_norm_m": 0.009073727585529039,
"predicted_m": [
0.3523628011446562,
-0.007946571805393848,
-0.0015211238370720684
],
"observed_m": [
0.3507756143687356,
-0.014233440506156315,
0.004826210435999327
]
},
{
"marker_id": 217,
"link": "Board",
"error_m": [
0.0017035690049225227,
0.0031238669959803844,
-0.0046688044032763675
],
"error_norm_m": 0.005870130059816479,
"predicted_m": [
0.651675751077122,
-0.09047436372715094,
-0.0005611429807896003
],
"observed_m": [
0.6499721820721994,
-0.09359823072313132,
0.004107661422486767
]
},
{
"marker_id": 229,
"link": "Arm1",
"error_m": [
-0.01133166813973846,
0.01402945348896742,
-0.02198463276753672
],
"error_norm_m": 0.028435125214278784,
"predicted_m": [
0.15507007867414319,
-0.13779685819771828,
0.08664563141726264
],
"observed_m": [
0.16640174681388165,
-0.1518263116866857,
0.10863026418479936
]
},
{
"marker_id": 243,
"link": "Arm1",
"error_m": [
-0.01377754229473685,
-0.0004475551338301298,
-0.0124081939170494
],
"error_norm_m": 0.01854681249067295,
"predicted_m": [
0.15470232178724008,
-0.17200732202397717,
0.050875407491987025
],
"observed_m": [
0.16847986408197693,
-0.17155976689014704,
0.06328360140903642
]
}
],
"stage_idx": 0,
"num_active_links": 3
},
{
"method": "deterministic_geometric_prefix",
"active_links": [
"Board",
"Base",
"Arm1",
"Ellbow"
],
"active_observations": 43,
"joint_updates": [
{
"pass": 0,
"updates": [
{
"link": "Base",
"joint_variable": "x",
"joint_type": "linear",
"old": 0.04362662540805053,
"new": 0.03757740731058722,
"info": {
"reason": "weighted_projection",
"used_markers": 5,
"axis_world": [
0.9999616284171068,
-0.008489384628338002,
-0.002161490236007051
],
"per_marker": [
{
"marker_id": 198,
"q_i": 0.01847741625384694,
"weight": 1.0
},
{
"marker_id": 229,
"q_i": 0.05502944059138241,
"weight": 1.0
},
{
"marker_id": 243,
"q_i": 0.057373019378922266,
"weight": 1.0
},
{
"marker_id": 244,
"q_i": 0.018265441772227296,
"weight": 1.0
},
{
"marker_id": 245,
"q_i": 0.038741718556557225,
"weight": 1.0
}
]
}
},
{
"link": "Arm1",
"joint_variable": "y",
"joint_type": "revolute",
"old": -0.04236508039060549,
"new": 0.04994223166754619,
"info": {
"reason": "2d_alignment+normal_tiebreak",
"used_markers": 5,
"axis_world": [
-0.9999616284171068,
0.008489384628338002,
0.002161490236007051
],
"axis_id": 0,
"theta_rad": 0.04994223166754602,
"theta_alt_rad": -3.091650421922247,
"score_theta": 0.02891273451311965,
"score_theta_alt": 1.2691341254439497,
"best_score": 0.02891273451311965,
"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.8658348685859414,
"info": {
"reason": "2d_alignment+normal_tiebreak",
"used_markers": 1,
"axis_world": [
-0.9999616284171068,
0.008489384628338002,
0.002161490236007051
],
"axis_id": 0,
"theta_rad": 0.8658348685859413,
"theta_alt_rad": -2.2757577850038517,
"score_theta": 0.05103363271936026,
"score_theta_alt": 0.10814887071839685,
"best_score": 0.05103363271936026,
"per_marker": [
{
"marker_id": 245,
"weight": 1.0
}
]
}
}
]
},
{
"pass": 1,
"updates": [
{
"link": "Base",
"joint_variable": "x",
"joint_type": "linear",
"old": 0.03757740731058722,
"new": 0.037577407310617525,
"info": {
"reason": "weighted_projection",
"used_markers": 5,
"axis_world": [
0.9999616284171068,
-0.008489384628338002,
-0.002161490236007051
],
"per_marker": [
{
"marker_id": 198,
"q_i": 0.018477416253846943,
"weight": 1.0
},
{
"marker_id": 229,
"q_i": 0.055029440591382414,
"weight": 1.0
},
{
"marker_id": 243,
"q_i": 0.05737301937892226,
"weight": 1.0
},
{
"marker_id": 244,
"q_i": 0.018265441772315368,
"weight": 1.0
},
{
"marker_id": 245,
"q_i": 0.038741718556620626,
"weight": 1.0
}
]
}
},
{
"link": "Arm1",
"joint_variable": "y",
"joint_type": "revolute",
"old": 0.04994223166754619,
"new": 0.0629039500755213,
"info": {
"reason": "2d_alignment+normal_tiebreak",
"used_markers": 5,
"axis_world": [
-0.9999616284171068,
0.008489384628338002,
0.002161490236007051
],
"axis_id": 0,
"theta_rad": 0.06290395007552124,
"theta_alt_rad": -3.0786887035142723,
"score_theta": 0.03536927002462712,
"score_theta_alt": 1.2893348683977335,
"best_score": 0.03536927002462712,
"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.8658348685859414,
"new": 0.8539759995705478,
"info": {
"reason": "2d_alignment+normal_tiebreak",
"used_markers": 1,
"axis_world": [
-0.9999616284171068,
0.008489384628338,
0.002161490236007051
],
"axis_id": 0,
"theta_rad": 0.8539759995705478,
"theta_alt_rad": -2.2876166540192457,
"score_theta": 0.051749684503961044,
"score_theta_alt": 0.1090570036119288,
"best_score": 0.051749684503961044,
"per_marker": [
{
"marker_id": 245,
"weight": 1.0
}
]
}
}
]
}
],
"root_link": "Board",
"root_pose": {
"reason": "kabsch",
"used_markers": [
210,
211,
214,
208,
206,
205,
207,
217,
46,
47,
51,
53,
54,
55,
56,
58,
60,
61,
62,
63,
64,
66,
68,
69,
72,
75,
79,
83,
84,
85,
86,
92,
95,
96,
97,
102,
103,
105
]
},
"marker_stats": {
"num_markers_used": 43,
"mean_error_m": 0.017160158284268312,
"rms_error_m": 0.031153676742377578,
"median_error_m": 0.0074533552753443845,
"worst_error_m": 0.13848630063452738
},
"marker_reports": [
{
"marker_id": 46,
"link": "Board",
"error_m": [
-0.013071464442725,
-0.012453648346596069,
0.016511727974226224
],
"error_norm_m": 0.024466174619522028,
"predicted_m": [
0.5406516238004262,
0.18530751827789943,
-0.033448441747951724
],
"observed_m": [
0.5537230882431512,
0.1977611666244955,
-0.04996016972217795
]
},
{
"marker_id": 47,
"link": "Board",
"error_m": [
0.0008721910810426392,
0.003837784471127148,
0.004571018690541762
],
"error_norm_m": 0.006031875230635755,
"predicted_m": [
0.3441935007486563,
-0.2849262112708967,
-0.02354307544450357
],
"observed_m": [
0.34332130966761365,
-0.2887639957420238,
-0.028114094135045332
]
},
{
"marker_id": 51,
"link": "Board",
"error_m": [
0.0023129226144513737,
-0.002152002975723405,
0.007277318284625859
],
"error_norm_m": 0.007933479012621942,
"predicted_m": [
0.1687367974887361,
-0.16899564696596553,
-0.02546298197884166
],
"observed_m": [
0.16642387487428473,
-0.16684364399024212,
-0.03274030026346752
]
},
{
"marker_id": 53,
"link": "Board",
"error_m": [
0.0009220742534559734,
-0.00011407742484240146,
-0.004083807032116291
],
"error_norm_m": 0.0041881636146773845,
"predicted_m": [
0.4904198654590923,
0.2125295197648856,
-0.03387819630621625
],
"observed_m": [
0.4894977912056363,
0.212643597189728,
-0.029794389274099962
]
},
{
"marker_id": 54,
"link": "Board",
"error_m": [
0.0026876126029042324,
-0.0015720752606889765,
-0.015421576774879476
],
"error_norm_m": 0.015732759209752815,
"predicted_m": [
0.3418616075192047,
-0.3289490972806476,
-0.022653198296289687
],
"observed_m": [
0.33917399491630046,
-0.3273770220199586,
-0.007231621521410211
]
},
{
"marker_id": 55,
"link": "Board",
"error_m": [
-7.456189087357012e-05,
0.001625554336729007,
0.0037037111592386797
],
"error_norm_m": 0.004045424913194935,
"predicted_m": [
0.28388814642167004,
-0.26045821613532605,
-0.02389400783448468
],
"observed_m": [
0.2839627083125436,
-0.26208377047205506,
-0.02759771899372336
]
},
{
"marker_id": 56,
"link": "Board",
"error_m": [
-0.01265274504762759,
-0.013561492382301393,
0.018731716020361527
],
"error_norm_m": 0.026360637661918422,
"predicted_m": [
0.5024814732941351,
0.1688643573695323,
-0.033029073570061046
],
"observed_m": [
0.5151342183417627,
0.18242584975183368,
-0.05176078959042257
]
},
{
"marker_id": 58,
"link": "Board",
"error_m": [
0.0001723402364918747,
0.004035049643894895,
0.003616032508958065
],
"error_norm_m": 0.005420979421806723,
"predicted_m": [
0.05064262618971274,
-0.21401541587418343,
-0.02428310374461435
],
"observed_m": [
0.05047028595322087,
-0.21805046551807833,
-0.027899136253572415
]
},
{
"marker_id": 60,
"link": "Board",
"error_m": [
0.00463310817165119,
-0.0028117819517218257,
-0.005116707514237484
],
"error_norm_m": 0.0074533552753443845,
"predicted_m": [
0.4391362102742091,
0.28452301506431216,
-0.03520497641213836
],
"observed_m": [
0.43450310210255794,
0.287334797016034,
-0.030088268897900873
]
},
{
"marker_id": 61,
"link": "Board",
"error_m": [
-0.00691382558947783,
-0.02422789402762071,
0.02410168760212969
],
"error_norm_m": 0.034866648513529226,
"predicted_m": [
-0.017186993384537545,
0.34040842616559613,
-0.03526353116172124
],
"observed_m": [
-0.010273167795059716,
0.36463632019321685,
-0.05936521876385093
]
},
{
"marker_id": 62,
"link": "Board",
"error_m": [
0.0003521065756239006,
0.00559001598665565,
0.0026869724433836346
],
"error_norm_m": 0.006212252303566424,
"predicted_m": [
0.4056022056791012,
-0.17402606404855112,
-0.025914320861504775
],
"observed_m": [
0.4052500991034773,
-0.17961608003520677,
-0.02860129330488841
]
},
{
"marker_id": 63,
"link": "Board",
"error_m": [
-0.0158783209757567,
0.007330017205507022,
0.02254905104485634
],
"error_norm_m": 0.028536116278598967,
"predicted_m": [
0.7777723842017723,
-0.23822554041647467,
-0.02549247671060849
],
"observed_m": [
0.793650705177529,
-0.2455555576219817,
-0.04804152775546483
]
},
{
"marker_id": 64,
"link": "Board",
"error_m": [
-0.00024947886248814777,
0.0031103977521285964,
0.0015026763573656142
],
"error_norm_m": 0.0034633582133906677,
"predicted_m": [
-0.02046232194973048,
-0.18353671865193455,
-0.024729607632139067
],
"observed_m": [
-0.020212843087242333,
-0.18664711640406315,
-0.02623228398950468
]
},
{
"marker_id": 66,
"link": "Board",
"error_m": [
-0.002169221374189595,
-0.003326372415850598,
0.0022722362157080907
],
"error_norm_m": 0.004575295863564253,
"predicted_m": [
0.2090710727753069,
-0.36045632245526643,
-0.021710519015962968
],
"observed_m": [
0.2112402941494965,
-0.35712995003941583,
-0.02398275523167106
]
},
{
"marker_id": 68,
"link": "Board",
"error_m": [
0.0059047524653308425,
-0.0031911635951974715,
-0.00924057582361612
],
"error_norm_m": 0.011420939905285513,
"predicted_m": [
0.5775452286447659,
0.1701967606003062,
-0.033230900949978014
],
"observed_m": [
0.571640476179435,
0.17338792419550367,
-0.023990325126361893
]
},
{
"marker_id": 69,
"link": "Board",
"error_m": [
-0.010207407150906253,
-0.0032140932356206076,
-0.035567820288336355
],
"error_norm_m": 0.03714285121170729,
"predicted_m": [
0.0076314251493094145,
-0.2767397820557746,
-0.0229226361119002
],
"observed_m": [
0.017838832300215667,
-0.273525688820154,
0.012645184176436158
]
},
{
"marker_id": 72,
"link": "Board",
"error_m": [
0.0021786185837171512,
-0.004019668474775084,
-0.0011331688472769746
],
"error_norm_m": 0.004710433654862088,
"predicted_m": [
0.44501028151206423,
0.19499801056971586,
-0.03342007940246738
],
"observed_m": [
0.4428316629283471,
0.19901767904449094,
-0.0322869105551904
]
},
{
"marker_id": 75,
"link": "Board",
"error_m": [
0.0053490747346992,
0.0009851390679179728,
0.001306643558522634
],
"error_norm_m": 0.005593783772149608,
"predicted_m": [
-0.021659615353954997,
0.199219859655652,
-0.03241656091498727
],
"observed_m": [
-0.027008690088654197,
0.19823472058773403,
-0.033723204473509905
]
},
{
"marker_id": 79,
"link": "Board",
"error_m": [
0.0015068694512451186,
0.005282261789669174,
0.00288885743245252
],
"error_norm_m": 0.006206322777839621,
"predicted_m": [
0.31334077448953723,
-0.15725544722430798,
-0.026036083695623685
],
"observed_m": [
0.3118339050382921,
-0.16253770901397716,
-0.028924941128076205
]
},
{
"marker_id": 83,
"link": "Board",
"error_m": [
0.006775247566416467,
0.0036733811567694064,
-0.00797430575930876
],
"error_norm_m": 0.011089962175412757,
"predicted_m": [
0.04941907778341697,
0.3432323968176374,
-0.03547560031504497
],
"observed_m": [
0.0426438302170005,
0.339559015660868,
-0.027501294555736213
]
},
{
"marker_id": 84,
"link": "Board",
"error_m": [
0.004551836715352864,
-0.002718376770611375,
-0.004642404012657454
],
"error_norm_m": 0.007047035175658761,
"predicted_m": [
0.4120528422576719,
0.2593671624020346,
-0.03463642235613811
],
"observed_m": [
0.40750100554231905,
0.262085539172646,
-0.029994018343480658
]
},
{
"marker_id": 85,
"link": "Board",
"error_m": [
-0.000916708693676993,
0.002119426113185885,
0.005238579736888606
],
"error_norm_m": 0.005724948867724244,
"predicted_m": [
0.5043160245339793,
-0.3124912515327591,
-0.023362709204236345
],
"observed_m": [
0.5052327332276563,
-0.31461067764594497,
-0.02860128894112495
]
},
{
"marker_id": 86,
"link": "Board",
"error_m": [
0.005183414741022241,
-0.001869012826053451,
-0.006179467547496376
],
"error_norm_m": 0.008279300483250976,
"predicted_m": [
0.3677381953969461,
0.29332780147835846,
-0.03521535856749702
],
"observed_m": [
0.36255478065592384,
0.2951968143044119,
-0.02903589102000064
]
},
{
"marker_id": 92,
"link": "Board",
"error_m": [
-0.0017083594791625911,
0.00170303643189873,
0.0005736671286161663
],
"error_norm_m": 0.0024794997827936494,
"predicted_m": [
0.6459007347108364,
-0.1858045111122829,
-0.026238095399216402
],
"observed_m": [
0.647609094189999,
-0.18750754754418164,
-0.02681176252783257
]
},
{
"marker_id": 95,
"link": "Board",
"error_m": [
-0.0001476915772945231,
-0.002753779608665352,
0.003373259031671797
],
"error_norm_m": 0.004357062247645791,
"predicted_m": [
0.18611487032737448,
-0.2711162407994176,
-0.023451863007203685
],
"observed_m": [
0.186262561904669,
-0.26836246119075224,
-0.026825122038875483
]
},
{
"marker_id": 96,
"link": "Board",
"error_m": [
0.0008351041742055698,
0.0038425930321047963,
0.00430729768901832
],
"error_norm_m": 0.005832300881639977,
"predicted_m": [
0.3705773661912831,
-0.18511682137740493,
-0.025609820081442213
],
"observed_m": [
0.36974226201707755,
-0.18895941440950972,
-0.029917117770460532
]
},
{
"marker_id": 97,
"link": "Board",
"error_m": [
-0.002038430423908888,
-0.003770267341488054,
0.006702033713791033
],
"error_norm_m": 0.007955335965262584,
"predicted_m": [
0.30369750429104686,
-0.35770026478537825,
-0.021986571035044734
],
"observed_m": [
0.30573593471495575,
-0.3539299974438902,
-0.028688604748835767
]
},
{
"marker_id": 102,
"link": "Board",
"error_m": [
-0.0031069906188920804,
0.0012413262809079784,
0.005990918260924717
],
"error_norm_m": 0.006861878988341128,
"predicted_m": [
0.6501783262927148,
-0.22399448808793507,
-0.025480818133082388
],
"observed_m": [
0.6532853169116069,
-0.22523581436884305,
-0.031471736394007105
]
},
{
"marker_id": 103,
"link": "Board",
"error_m": [
0.0006442089868049922,
0.0031736767985359737,
0.0037423451148866915
],
"error_norm_m": 0.004948977328616706,
"predicted_m": [
0.10651719662765503,
-0.18409482436457583,
-0.025014528443833572
],
"observed_m": [
0.10587298764085004,
-0.1872685011631118,
-0.028756873558720263
]
},
{
"marker_id": 105,
"link": "Board",
"error_m": [
-0.0019246428729866594,
0.0025750219350123005,
0.0037087148619832193
],
"error_norm_m": 0.004908111050274641,
"predicted_m": [
0.5249679039328917,
-0.266174303855376,
-0.024341399729036185
],
"observed_m": [
0.5268925468058784,
-0.2687493257903883,
-0.028050114591019405
]
},
{
"marker_id": 198,
"link": "Arm1",
"error_m": [
0.019292152268096857,
0.03031427831633545,
-0.03050146897641169
],
"error_norm_m": 0.04713260250288207,
"predicted_m": [
0.1498609991212579,
-0.04357920580483823,
0.10537740015107346
],
"observed_m": [
0.13056884685316103,
-0.07389348412117368,
0.13587886912748515
]
},
{
"marker_id": 205,
"link": "Board",
"error_m": [
0.0032965571069566435,
0.0032027050878753044,
-0.01274684818948499
],
"error_norm_m": 0.01355015672990927,
"predicted_m": [
0.7516719139189326,
-0.09132330218998558,
-0.0007772920043905215
],
"observed_m": [
0.748375356811976,
-0.09452600727786088,
0.011969556185094469
]
},
{
"marker_id": 206,
"link": "Board",
"error_m": [
0.005307267981266461,
0.0032227200669935636,
-0.009488265709367758
],
"error_norm_m": 0.011339321153699776,
"predicted_m": [
0.6523512896700883,
-0.010493387193897797,
-0.0021695709078748326
],
"observed_m": [
0.6470440216888218,
-0.01371610726089136,
0.007318694801492925
]
},
{
"marker_id": 207,
"link": "Board",
"error_m": [
0.0054688122362741565,
0.0032042277659066944,
-0.015391001964001989
],
"error_norm_m": 0.0166450570532919,
"predicted_m": [
0.7523474525118989,
-0.011342325656732447,
-0.002385719931475754
],
"observed_m": [
0.7468786402756248,
-0.014546553422639141,
0.013005282032526235
]
},
{
"marker_id": 208,
"link": "Board",
"error_m": [
0.002959970495894637,
0.006205952039261331,
-0.0013024613557298882
],
"error_norm_m": 0.0069979762526996584,
"predicted_m": [
0.3516872625516899,
-0.087927548338647,
8.730409001316366e-05
],
"observed_m": [
0.3487272920557953,
-0.09413350037790832,
0.001389765445743052
]
},
{
"marker_id": 210,
"link": "Board",
"error_m": [
0.004170160093314321,
0.00224196415185921,
0.0001882955000761091
],
"error_norm_m": 0.004738364027535453,
"predicted_m": [
0.022291021442560007,
-0.01514269694469615,
-0.000606778568303374
],
"observed_m": [
0.018120861349245686,
-0.01738466109655536,
-0.0007950740683794831
]
},
{
"marker_id": 211,
"link": "Board",
"error_m": [
0.0016848423509987498,
0.004142719827073311,
-0.006240210835369596
],
"error_norm_m": 0.007677307638958428,
"predicted_m": [
0.2523666383028454,
-0.0070976333425592,
-0.0013049748134711472
],
"observed_m": [
0.25068179595184664,
-0.011240353169632511,
0.004935236021898448
]
},
{
"marker_id": 214,
"link": "Board",
"error_m": [
0.0015871867759205682,
0.006286868700762466,
-0.006347334273071395
],
"error_norm_m": 0.009073727585529039,
"predicted_m": [
0.3523628011446562,
-0.007946571805393848,
-0.0015211238370720684
],
"observed_m": [
0.3507756143687356,
-0.014233440506156315,
0.004826210435999327
]
},
{
"marker_id": 217,
"link": "Board",
"error_m": [
0.0017035690049225227,
0.0031238669959803844,
-0.0046688044032763675
],
"error_norm_m": 0.005870130059816479,
"predicted_m": [
0.651675751077122,
-0.09047436372715094,
-0.0005611429807896003
],
"observed_m": [
0.6499721820721994,
-0.09359823072313132,
0.004107661422486767
]
},
{
"marker_id": 229,
"link": "Arm1",
"error_m": [
-0.017286033875764995,
0.018560107910301188,
0.004209504447997073
],
"error_norm_m": 0.025710007788676898,
"predicted_m": [
0.14911571293811665,
-0.1332662037763845,
0.11283976863279643
],
"observed_m": [
0.16640174681388165,
-0.1518263116866857,
0.10863026418479936
]
},
{
"marker_id": 243,
"link": "Arm1",
"error_m": [
-0.019754010182128884,
0.0005139917653710357,
0.017578800248631177
],
"error_norm_m": 0.026448049530954004,
"predicted_m": [
0.14872585389984805,
-0.171045775124776,
0.0808624016576676
],
"observed_m": [
0.16847986408197693,
-0.17155976689014704,
0.06328360140903642
]
},
{
"marker_id": 244,
"link": "Ellbow",
"error_m": [
0.018472521096691508,
-0.11716506346963601,
0.07148125159736049
],
"error_norm_m": 0.13848630063452738,
"predicted_m": [
0.27401089096769127,
-0.1372286712143839,
0.07769018319082992
],
"observed_m": [
0.25553836987099976,
-0.02006360774474789,
0.006208931593469432
]
},
{
"marker_id": 245,
"link": "Ellbow",
"error_m": [
-0.001885017660502114,
-0.09786944448990884,
0.050991335739857375
],
"error_norm_m": 0.11037254086446778,
"predicted_m": [
0.2387280130523592,
-0.16513234912878605,
0.05703822723363333
],
"observed_m": [
0.2406130307128613,
-0.06726290463887721,
0.006046891493775955
]
}
],
"stage_idx": 1,
"num_active_links": 4
},
{
"method": "deterministic_geometric_prefix",
"active_links": [
"Board",
"Base",
"Arm1",
"Ellbow",
"Arm2"
],
"active_observations": 45,
"joint_updates": [
{
"pass": 0,
"updates": [
{
"link": "Base",
"joint_variable": "x",
"joint_type": "linear",
"old": 0.037577407310617525,
"new": 0.05982604911054192,
"info": {
"reason": "weighted_projection",
"used_markers": 7,
"axis_world": [
0.9999616284171068,
-0.008489384628338002,
-0.002161490236007051
],
"per_marker": [
{
"marker_id": 198,
"q_i": 0.01847741625384694,
"weight": 1.0
},
{
"marker_id": 229,
"q_i": 0.05502944059138243,
"weight": 1.0
},
{
"marker_id": 243,
"q_i": 0.057373019378922266,
"weight": 1.0
},
{
"marker_id": 244,
"q_i": 0.018265441772313304,
"weight": 1.0
},
{
"marker_id": 245,
"q_i": 0.03874171855661917,
"weight": 1.0
},
{
"marker_id": 113,
"q_i": 0.07903330233853743,
"weight": 1.0
},
{
"marker_id": 124,
"q_i": 0.15186200488217189,
"weight": 1.0
}
]
}
},
{
"link": "Arm1",
"joint_variable": "y",
"joint_type": "revolute",
"old": 0.0629039500755213,
"new": -0.09350938312020762,
"info": {
"reason": "2d_alignment+normal_tiebreak",
"used_markers": 7,
"axis_world": [
-0.9999616284171068,
0.008489384628338002,
0.002161490236007051
],
"axis_id": 0,
"theta_rad": -0.09350938312020782,
"theta_alt_rad": 3.0480832704695855,
"score_theta": 0.07491204572703071,
"score_theta_alt": 2.6153424770335505,
"best_score": 0.07491204572703071,
"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.8539759995705478,
"new": 1.8840808197242849,
"info": {
"reason": "2d_alignment+normal_tiebreak",
"used_markers": 3,
"axis_world": [
-0.9999616284171068,
0.008489384628338002,
0.002161490236007051
],
"axis_id": 0,
"theta_rad": -1.2575118338655085,
"theta_alt_rad": 1.8840808197242849,
"score_theta": 0.4920753506580353,
"score_theta_alt": 0.15350153656020094,
"best_score": 0.15350153656020094,
"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.3924222908436192,
"info": {
"reason": "2d_alignment+normal_tiebreak",
"used_markers": 2,
"axis_world": [
0.004116502108577394,
0.23756148554648482,
0.9713637809766933
],
"axis_id": 2,
"theta_rad": 2.3924222908436192,
"theta_alt_rad": -0.7491703627461739,
"score_theta": 0.07691477417859664,
"score_theta_alt": 0.12502172818030396,
"best_score": 0.07691477417859664,
"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.05982604911054192,
"new": 0.05408348484325045,
"info": {
"reason": "weighted_projection",
"used_markers": 7,
"axis_world": [
0.9999616284171068,
-0.008489384628338002,
-0.002161490236007051
],
"per_marker": [
{
"marker_id": 198,
"q_i": 0.018477416253846943,
"weight": 1.0
},
{
"marker_id": 229,
"q_i": 0.055029440591382414,
"weight": 1.0
},
{
"marker_id": 243,
"q_i": 0.057373019378922266,
"weight": 1.0
},
{
"marker_id": 244,
"q_i": 0.01826544177255521,
"weight": 1.0
},
{
"marker_id": 245,
"q_i": 0.03874171855679333,
"weight": 1.0
},
{
"marker_id": 113,
"q_i": 0.09946424701353312,
"weight": 1.0
},
{
"marker_id": 124,
"q_i": 0.09123311033571992,
"weight": 1.0
}
]
}
},
{
"link": "Arm1",
"joint_variable": "y",
"joint_type": "revolute",
"old": -0.09350938312020762,
"new": 0.10830851353283366,
"info": {
"reason": "2d_alignment+normal_tiebreak",
"used_markers": 7,
"axis_world": [
-0.9999616284171068,
0.008489384628338002,
0.002161490236007051
],
"axis_id": 0,
"theta_rad": 0.10830851353283383,
"theta_alt_rad": -3.03328414005696,
"score_theta": 0.09672474731844032,
"score_theta_alt": 2.266871427513622,
"best_score": 0.09672474731844032,
"per_marker": [
{
"marker_id": 198,
"weight": 1.0
},
{
"marker_id": 229,
"weight": 1.0
},
{
"marker_id": 243,
"weight": 1.0
},
{
"marker_id": 244,
"weight": 1.0
},
{
"marker_id": 245,
"weight": 1.0
},
{
"marker_id": 113,
"weight": 1.0
},
{
"marker_id": 124,
"weight": 1.0
}
]
}
},
{
"link": "Ellbow",
"joint_variable": "z",
"joint_type": "revolute",
"old": 1.8840808197242849,
"new": 1.9912991164152878,
"info": {
"reason": "2d_alignment+normal_tiebreak",
"used_markers": 3,
"axis_world": [
-0.9999616284171068,
0.008489384628338002,
0.002161490236007051
],
"axis_id": 0,
"theta_rad": -1.1502935371745049,
"theta_alt_rad": 1.9912991164152878,
"score_theta": 0.3775106909876319,
"score_theta_alt": 0.18160113965174315,
"best_score": 0.18160113965174315,
"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.3924222908436192,
"new": 2.373559574730061,
"info": {
"reason": "2d_alignment+normal_tiebreak",
"used_markers": 2,
"axis_world": [
0.006273348461466701,
0.5217300815516801,
0.8530875494936955
],
"axis_id": 2,
"theta_rad": 2.3735595747300606,
"theta_alt_rad": -0.768033078859732,
"score_theta": 0.09496592662492377,
"score_theta_alt": 0.17091671231100486,
"best_score": 0.09496592662492377,
"per_marker": [
{
"marker_id": 113,
"weight": 1.0
},
{
"marker_id": 124,
"weight": 1.0
}
]
}
}
]
}
],
"root_link": "Board",
"root_pose": {
"reason": "kabsch",
"used_markers": [
210,
211,
214,
208,
206,
205,
207,
217,
46,
47,
51,
53,
54,
55,
56,
58,
60,
61,
62,
63,
64,
66,
68,
69,
72,
75,
79,
83,
84,
85,
86,
92,
95,
96,
97,
102,
103,
105
]
},
"marker_stats": {
"num_markers_used": 45,
"mean_error_m": 0.025396244420164686,
"rms_error_m": 0.05095182295267257,
"median_error_m": 0.007677307638958428,
"worst_error_m": 0.20177379793386727
},
"marker_reports": [
{
"marker_id": 46,
"link": "Board",
"error_m": [
-0.013071464442725,
-0.012453648346596069,
0.016511727974226224
],
"error_norm_m": 0.024466174619522028,
"predicted_m": [
0.5406516238004262,
0.18530751827789943,
-0.033448441747951724
],
"observed_m": [
0.5537230882431512,
0.1977611666244955,
-0.04996016972217795
]
},
{
"marker_id": 47,
"link": "Board",
"error_m": [
0.0008721910810426392,
0.003837784471127148,
0.004571018690541762
],
"error_norm_m": 0.006031875230635755,
"predicted_m": [
0.3441935007486563,
-0.2849262112708967,
-0.02354307544450357
],
"observed_m": [
0.34332130966761365,
-0.2887639957420238,
-0.028114094135045332
]
},
{
"marker_id": 51,
"link": "Board",
"error_m": [
0.0023129226144513737,
-0.002152002975723405,
0.007277318284625859
],
"error_norm_m": 0.007933479012621942,
"predicted_m": [
0.1687367974887361,
-0.16899564696596553,
-0.02546298197884166
],
"observed_m": [
0.16642387487428473,
-0.16684364399024212,
-0.03274030026346752
]
},
{
"marker_id": 53,
"link": "Board",
"error_m": [
0.0009220742534559734,
-0.00011407742484240146,
-0.004083807032116291
],
"error_norm_m": 0.0041881636146773845,
"predicted_m": [
0.4904198654590923,
0.2125295197648856,
-0.03387819630621625
],
"observed_m": [
0.4894977912056363,
0.212643597189728,
-0.029794389274099962
]
},
{
"marker_id": 54,
"link": "Board",
"error_m": [
0.0026876126029042324,
-0.0015720752606889765,
-0.015421576774879476
],
"error_norm_m": 0.015732759209752815,
"predicted_m": [
0.3418616075192047,
-0.3289490972806476,
-0.022653198296289687
],
"observed_m": [
0.33917399491630046,
-0.3273770220199586,
-0.007231621521410211
]
},
{
"marker_id": 55,
"link": "Board",
"error_m": [
-7.456189087357012e-05,
0.001625554336729007,
0.0037037111592386797
],
"error_norm_m": 0.004045424913194935,
"predicted_m": [
0.28388814642167004,
-0.26045821613532605,
-0.02389400783448468
],
"observed_m": [
0.2839627083125436,
-0.26208377047205506,
-0.02759771899372336
]
},
{
"marker_id": 56,
"link": "Board",
"error_m": [
-0.01265274504762759,
-0.013561492382301393,
0.018731716020361527
],
"error_norm_m": 0.026360637661918422,
"predicted_m": [
0.5024814732941351,
0.1688643573695323,
-0.033029073570061046
],
"observed_m": [
0.5151342183417627,
0.18242584975183368,
-0.05176078959042257
]
},
{
"marker_id": 58,
"link": "Board",
"error_m": [
0.0001723402364918747,
0.004035049643894895,
0.003616032508958065
],
"error_norm_m": 0.005420979421806723,
"predicted_m": [
0.05064262618971274,
-0.21401541587418343,
-0.02428310374461435
],
"observed_m": [
0.05047028595322087,
-0.21805046551807833,
-0.027899136253572415
]
},
{
"marker_id": 60,
"link": "Board",
"error_m": [
0.00463310817165119,
-0.0028117819517218257,
-0.005116707514237484
],
"error_norm_m": 0.0074533552753443845,
"predicted_m": [
0.4391362102742091,
0.28452301506431216,
-0.03520497641213836
],
"observed_m": [
0.43450310210255794,
0.287334797016034,
-0.030088268897900873
]
},
{
"marker_id": 61,
"link": "Board",
"error_m": [
-0.00691382558947783,
-0.02422789402762071,
0.02410168760212969
],
"error_norm_m": 0.034866648513529226,
"predicted_m": [
-0.017186993384537545,
0.34040842616559613,
-0.03526353116172124
],
"observed_m": [
-0.010273167795059716,
0.36463632019321685,
-0.05936521876385093
]
},
{
"marker_id": 62,
"link": "Board",
"error_m": [
0.0003521065756239006,
0.00559001598665565,
0.0026869724433836346
],
"error_norm_m": 0.006212252303566424,
"predicted_m": [
0.4056022056791012,
-0.17402606404855112,
-0.025914320861504775
],
"observed_m": [
0.4052500991034773,
-0.17961608003520677,
-0.02860129330488841
]
},
{
"marker_id": 63,
"link": "Board",
"error_m": [
-0.0158783209757567,
0.007330017205507022,
0.02254905104485634
],
"error_norm_m": 0.028536116278598967,
"predicted_m": [
0.7777723842017723,
-0.23822554041647467,
-0.02549247671060849
],
"observed_m": [
0.793650705177529,
-0.2455555576219817,
-0.04804152775546483
]
},
{
"marker_id": 64,
"link": "Board",
"error_m": [
-0.00024947886248814777,
0.0031103977521285964,
0.0015026763573656142
],
"error_norm_m": 0.0034633582133906677,
"predicted_m": [
-0.02046232194973048,
-0.18353671865193455,
-0.024729607632139067
],
"observed_m": [
-0.020212843087242333,
-0.18664711640406315,
-0.02623228398950468
]
},
{
"marker_id": 66,
"link": "Board",
"error_m": [
-0.002169221374189595,
-0.003326372415850598,
0.0022722362157080907
],
"error_norm_m": 0.004575295863564253,
"predicted_m": [
0.2090710727753069,
-0.36045632245526643,
-0.021710519015962968
],
"observed_m": [
0.2112402941494965,
-0.35712995003941583,
-0.02398275523167106
]
},
{
"marker_id": 68,
"link": "Board",
"error_m": [
0.0059047524653308425,
-0.0031911635951974715,
-0.00924057582361612
],
"error_norm_m": 0.011420939905285513,
"predicted_m": [
0.5775452286447659,
0.1701967606003062,
-0.033230900949978014
],
"observed_m": [
0.571640476179435,
0.17338792419550367,
-0.023990325126361893
]
},
{
"marker_id": 69,
"link": "Board",
"error_m": [
-0.010207407150906253,
-0.0032140932356206076,
-0.035567820288336355
],
"error_norm_m": 0.03714285121170729,
"predicted_m": [
0.0076314251493094145,
-0.2767397820557746,
-0.0229226361119002
],
"observed_m": [
0.017838832300215667,
-0.273525688820154,
0.012645184176436158
]
},
{
"marker_id": 72,
"link": "Board",
"error_m": [
0.0021786185837171512,
-0.004019668474775084,
-0.0011331688472769746
],
"error_norm_m": 0.004710433654862088,
"predicted_m": [
0.44501028151206423,
0.19499801056971586,
-0.03342007940246738
],
"observed_m": [
0.4428316629283471,
0.19901767904449094,
-0.0322869105551904
]
},
{
"marker_id": 75,
"link": "Board",
"error_m": [
0.0053490747346992,
0.0009851390679179728,
0.001306643558522634
],
"error_norm_m": 0.005593783772149608,
"predicted_m": [
-0.021659615353954997,
0.199219859655652,
-0.03241656091498727
],
"observed_m": [
-0.027008690088654197,
0.19823472058773403,
-0.033723204473509905
]
},
{
"marker_id": 79,
"link": "Board",
"error_m": [
0.0015068694512451186,
0.005282261789669174,
0.00288885743245252
],
"error_norm_m": 0.006206322777839621,
"predicted_m": [
0.31334077448953723,
-0.15725544722430798,
-0.026036083695623685
],
"observed_m": [
0.3118339050382921,
-0.16253770901397716,
-0.028924941128076205
]
},
{
"marker_id": 83,
"link": "Board",
"error_m": [
0.006775247566416467,
0.0036733811567694064,
-0.00797430575930876
],
"error_norm_m": 0.011089962175412757,
"predicted_m": [
0.04941907778341697,
0.3432323968176374,
-0.03547560031504497
],
"observed_m": [
0.0426438302170005,
0.339559015660868,
-0.027501294555736213
]
},
{
"marker_id": 84,
"link": "Board",
"error_m": [
0.004551836715352864,
-0.002718376770611375,
-0.004642404012657454
],
"error_norm_m": 0.007047035175658761,
"predicted_m": [
0.4120528422576719,
0.2593671624020346,
-0.03463642235613811
],
"observed_m": [
0.40750100554231905,
0.262085539172646,
-0.029994018343480658
]
},
{
"marker_id": 85,
"link": "Board",
"error_m": [
-0.000916708693676993,
0.002119426113185885,
0.005238579736888606
],
"error_norm_m": 0.005724948867724244,
"predicted_m": [
0.5043160245339793,
-0.3124912515327591,
-0.023362709204236345
],
"observed_m": [
0.5052327332276563,
-0.31461067764594497,
-0.02860128894112495
]
},
{
"marker_id": 86,
"link": "Board",
"error_m": [
0.005183414741022241,
-0.001869012826053451,
-0.006179467547496376
],
"error_norm_m": 0.008279300483250976,
"predicted_m": [
0.3677381953969461,
0.29332780147835846,
-0.03521535856749702
],
"observed_m": [
0.36255478065592384,
0.2951968143044119,
-0.02903589102000064
]
},
{
"marker_id": 92,
"link": "Board",
"error_m": [
-0.0017083594791625911,
0.00170303643189873,
0.0005736671286161663
],
"error_norm_m": 0.0024794997827936494,
"predicted_m": [
0.6459007347108364,
-0.1858045111122829,
-0.026238095399216402
],
"observed_m": [
0.647609094189999,
-0.18750754754418164,
-0.02681176252783257
]
},
{
"marker_id": 95,
"link": "Board",
"error_m": [
-0.0001476915772945231,
-0.002753779608665352,
0.003373259031671797
],
"error_norm_m": 0.004357062247645791,
"predicted_m": [
0.18611487032737448,
-0.2711162407994176,
-0.023451863007203685
],
"observed_m": [
0.186262561904669,
-0.26836246119075224,
-0.026825122038875483
]
},
{
"marker_id": 96,
"link": "Board",
"error_m": [
0.0008351041742055698,
0.0038425930321047963,
0.00430729768901832
],
"error_norm_m": 0.005832300881639977,
"predicted_m": [
0.3705773661912831,
-0.18511682137740493,
-0.025609820081442213
],
"observed_m": [
0.36974226201707755,
-0.18895941440950972,
-0.029917117770460532
]
},
{
"marker_id": 97,
"link": "Board",
"error_m": [
-0.002038430423908888,
-0.003770267341488054,
0.006702033713791033
],
"error_norm_m": 0.007955335965262584,
"predicted_m": [
0.30369750429104686,
-0.35770026478537825,
-0.021986571035044734
],
"observed_m": [
0.30573593471495575,
-0.3539299974438902,
-0.028688604748835767
]
},
{
"marker_id": 102,
"link": "Board",
"error_m": [
-0.0031069906188920804,
0.0012413262809079784,
0.005990918260924717
],
"error_norm_m": 0.006861878988341128,
"predicted_m": [
0.6501783262927148,
-0.22399448808793507,
-0.025480818133082388
],
"observed_m": [
0.6532853169116069,
-0.22523581436884305,
-0.031471736394007105
]
},
{
"marker_id": 103,
"link": "Board",
"error_m": [
0.0006442089868049922,
0.0031736767985359737,
0.0037423451148866915
],
"error_norm_m": 0.004948977328616706,
"predicted_m": [
0.10651719662765503,
-0.18409482436457583,
-0.025014528443833572
],
"observed_m": [
0.10587298764085004,
-0.1872685011631118,
-0.028756873558720263
]
},
{
"marker_id": 105,
"link": "Board",
"error_m": [
-0.0019246428729866594,
0.0025750219350123005,
0.0037087148619832193
],
"error_norm_m": 0.004908111050274641,
"predicted_m": [
0.5249679039328917,
-0.266174303855376,
-0.024341399729036185
],
"observed_m": [
0.5268925468058784,
-0.2687493257903883,
-0.028050114591019405
]
},
{
"marker_id": 113,
"link": "Arm2",
"error_m": [
-0.04469518194079192,
0.13957129050326852,
-0.040189499388485705
],
"error_norm_m": 0.15196381241126244,
"predicted_m": [
0.23572119499181232,
-0.05915029827602125,
0.25558271327343457
],
"observed_m": [
0.28041637693260424,
-0.19872158877928978,
0.2957722126619203
]
},
{
"marker_id": 124,
"link": "Arm2",
"error_m": [
-0.03599982125294121,
0.1964345845787417,
-0.028812018044395316
],
"error_norm_m": 0.20177379793386727,
"predicted_m": [
0.2819512112977912,
-0.042571705845387706,
0.28847550679028416
],
"observed_m": [
0.3179510325507324,
-0.2390062904241294,
0.3172875248346795
]
},
{
"marker_id": 198,
"link": "Arm1",
"error_m": [
0.035832768638906914,
0.03252057133015765,
-0.02348127599658939
],
"error_norm_m": 0.05378610592334518,
"predicted_m": [
0.16640161549206794,
-0.04137291279101603,
0.11239759313089576
],
"observed_m": [
0.13056884685316103,
-0.07389348412117368,
0.13587886912748515
]
},
{
"marker_id": 205,
"link": "Board",
"error_m": [
0.0032965571069566435,
0.0032027050878753044,
-0.01274684818948499
],
"error_norm_m": 0.01355015672990927,
"predicted_m": [
0.7516719139189326,
-0.09132330218998558,
-0.0007772920043905215
],
"observed_m": [
0.748375356811976,
-0.09452600727786088,
0.011969556185094469
]
},
{
"marker_id": 206,
"link": "Board",
"error_m": [
0.005307267981266461,
0.0032227200669935636,
-0.009488265709367758
],
"error_norm_m": 0.011339321153699776,
"predicted_m": [
0.6523512896700883,
-0.010493387193897797,
-0.0021695709078748326
],
"observed_m": [
0.6470440216888218,
-0.01371610726089136,
0.007318694801492925
]
},
{
"marker_id": 207,
"link": "Board",
"error_m": [
0.0054688122362741565,
0.0032042277659066944,
-0.015391001964001989
],
"error_norm_m": 0.0166450570532919,
"predicted_m": [
0.7523474525118989,
-0.011342325656732447,
-0.002385719931475754
],
"observed_m": [
0.7468786402756248,
-0.014546553422639141,
0.013005282032526235
]
},
{
"marker_id": 208,
"link": "Board",
"error_m": [
0.002959970495894637,
0.006205952039261331,
-0.0013024613557298882
],
"error_norm_m": 0.0069979762526996584,
"predicted_m": [
0.3516872625516899,
-0.087927548338647,
8.730409001316366e-05
],
"observed_m": [
0.3487272920557953,
-0.09413350037790832,
0.001389765445743052
]
},
{
"marker_id": 210,
"link": "Board",
"error_m": [
0.004170160093314321,
0.00224196415185921,
0.0001882955000761091
],
"error_norm_m": 0.004738364027535453,
"predicted_m": [
0.022291021442560007,
-0.01514269694469615,
-0.000606778568303374
],
"observed_m": [
0.018120861349245686,
-0.01738466109655536,
-0.0007950740683794831
]
},
{
"marker_id": 211,
"link": "Board",
"error_m": [
0.0016848423509987498,
0.004142719827073311,
-0.006240210835369596
],
"error_norm_m": 0.007677307638958428,
"predicted_m": [
0.2523666383028454,
-0.0070976333425592,
-0.0013049748134711472
],
"observed_m": [
0.25068179595184664,
-0.011240353169632511,
0.004935236021898448
]
},
{
"marker_id": 214,
"link": "Board",
"error_m": [
0.0015871867759205682,
0.006286868700762466,
-0.006347334273071395
],
"error_norm_m": 0.009073727585529039,
"predicted_m": [
0.3523628011446562,
-0.007946571805393848,
-0.0015211238370720684
],
"observed_m": [
0.3507756143687356,
-0.014233440506156315,
0.004826210435999327
]
},
{
"marker_id": 217,
"link": "Board",
"error_m": [
0.0017035690049225227,
0.0031238669959803844,
-0.0046688044032763675
],
"error_norm_m": 0.005870130059816479,
"predicted_m": [
0.651675751077122,
-0.09047436372715094,
-0.0005611429807896003
],
"observed_m": [
0.6499721820721994,
-0.09359823072313132,
0.004107661422486767
]
},
{
"marker_id": 229,
"link": "Arm1",
"error_m": [
-0.0007329749786673667,
0.0211974563126012,
0.015292937553992303
],
"error_norm_m": 0.026148486485345512,
"predicted_m": [
0.16566877183521428,
-0.1306288553740845,
0.12392320173879166
],
"observed_m": [
0.16640174681388165,
-0.1518263116866857,
0.10863026418479936
]
},
{
"marker_id": 243,
"link": "Arm1",
"error_m": [
-0.003209164680574139,
0.0017388740546709636,
0.030410049589423907
],
"error_norm_m": 0.03062831266910199,
"predicted_m": [
0.1652706994014028,
-0.16982089283547608,
0.09369365099846033
],
"observed_m": [
0.16847986408197693,
-0.17155976689014704,
0.06328360140903642
]
},
{
"marker_id": 244,
"link": "Ellbow",
"error_m": [
0.03501252783775599,
-0.11610781383140847,
0.08273235200019766
],
"error_norm_m": 0.14680444000704904,
"predicted_m": [
0.29055089770875575,
-0.13617142157615636,
0.08894128359366708
],
"observed_m": [
0.25553836987099976,
-0.02006360774474789,
0.006208931593469432
]
},
{
"marker_id": 245,
"link": "Ellbow",
"error_m": [
0.01472520341653269,
-0.0984687815987656,
0.1012317604165435
],
"error_norm_m": 0.14198873857541,
"predicted_m": [
0.255338234129394,
-0.1657316862376428,
0.10727865191031945
],
"observed_m": [
0.2406130307128613,
-0.06726290463887721,
0.006046891493775955
]
}
],
"stage_idx": 2,
"num_active_links": 5
}
],
"markers": [
{
"marker_id": 41,
"link": "FingerA",
"observed_position_m": [
0.1571273925444109,
-0.2417091517279724,
0.5004883537060872
],
"predicted_position_m": [
0.23538482571309632,
0.0015811624535499742,
0.3417598943207742
],
"error_m": [
0.07825743316868541,
0.24329031418152236,
-0.15872845938531305
],
"error_norm_m": 0.3008473477355752
},
{
"marker_id": 42,
"link": "FingerA",
"observed_position_m": [
0.14791429060362243,
-0.19727321113148424,
0.51423694375173
],
"predicted_position_m": [
0.24479252410298546,
0.04440563426308586,
0.35980982022711533
],
"error_m": [
0.09687823349936303,
0.2416788453945701,
-0.15442712352461468
],
"error_norm_m": 0.30272395497762683
},
{
"marker_id": 43,
"link": "FingerB",
"observed_position_m": [
0.1995420422389749,
-0.1786853796663364,
0.4893315305410218
],
"predicted_position_m": [
0.2569762611955935,
0.0053686773553617805,
0.3648389897247622
],
"error_m": [
0.05743421895661863,
0.1840540570216982,
-0.1244925408162596
],
"error_norm_m": 0.2295059435661556
},
{
"marker_id": 46,
"link": "Board",
"observed_position_m": [
0.5537230882431512,
0.1977611666244955,
-0.04996016972217795
],
"predicted_position_m": [
0.5406516238004262,
0.18530751827789943,
-0.033448441747951724
],
"error_m": [
-0.013071464442725,
-0.012453648346596069,
0.016511727974226224
],
"error_norm_m": 0.024466174619522028
},
{
"marker_id": 47,
"link": "Board",
"observed_position_m": [
0.34332130966761365,
-0.2887639957420238,
-0.028114094135045332
],
"predicted_position_m": [
0.3441935007486563,
-0.2849262112708967,
-0.02354307544450357
],
"error_m": [
0.0008721910810426392,
0.003837784471127148,
0.004571018690541762
],
"error_norm_m": 0.006031875230635755
},
{
"marker_id": 51,
"link": "Board",
"observed_position_m": [
0.16642387487428473,
-0.16684364399024212,
-0.03274030026346752
],
"predicted_position_m": [
0.1687367974887361,
-0.16899564696596553,
-0.02546298197884166
],
"error_m": [
0.0023129226144513737,
-0.002152002975723405,
0.007277318284625859
],
"error_norm_m": 0.007933479012621942
},
{
"marker_id": 53,
"link": "Board",
"observed_position_m": [
0.4894977912056363,
0.212643597189728,
-0.029794389274099962
],
"predicted_position_m": [
0.4904198654590923,
0.2125295197648856,
-0.03387819630621625
],
"error_m": [
0.0009220742534559734,
-0.00011407742484240146,
-0.004083807032116291
],
"error_norm_m": 0.0041881636146773845
},
{
"marker_id": 54,
"link": "Board",
"observed_position_m": [
0.33917399491630046,
-0.3273770220199586,
-0.007231621521410211
],
"predicted_position_m": [
0.3418616075192047,
-0.3289490972806476,
-0.022653198296289687
],
"error_m": [
0.0026876126029042324,
-0.0015720752606889765,
-0.015421576774879476
],
"error_norm_m": 0.015732759209752815
},
{
"marker_id": 55,
"link": "Board",
"observed_position_m": [
0.2839627083125436,
-0.26208377047205506,
-0.02759771899372336
],
"predicted_position_m": [
0.28388814642167004,
-0.26045821613532605,
-0.02389400783448468
],
"error_m": [
-7.456189087357012e-05,
0.001625554336729007,
0.0037037111592386797
],
"error_norm_m": 0.004045424913194935
},
{
"marker_id": 56,
"link": "Board",
"observed_position_m": [
0.5151342183417627,
0.18242584975183368,
-0.05176078959042257
],
"predicted_position_m": [
0.5024814732941351,
0.1688643573695323,
-0.033029073570061046
],
"error_m": [
-0.01265274504762759,
-0.013561492382301393,
0.018731716020361527
],
"error_norm_m": 0.026360637661918422
},
{
"marker_id": 58,
"link": "Board",
"observed_position_m": [
0.05047028595322087,
-0.21805046551807833,
-0.027899136253572415
],
"predicted_position_m": [
0.05064262618971274,
-0.21401541587418343,
-0.02428310374461435
],
"error_m": [
0.0001723402364918747,
0.004035049643894895,
0.003616032508958065
],
"error_norm_m": 0.005420979421806723
},
{
"marker_id": 60,
"link": "Board",
"observed_position_m": [
0.43450310210255794,
0.287334797016034,
-0.030088268897900873
],
"predicted_position_m": [
0.4391362102742091,
0.28452301506431216,
-0.03520497641213836
],
"error_m": [
0.00463310817165119,
-0.0028117819517218257,
-0.005116707514237484
],
"error_norm_m": 0.0074533552753443845
},
{
"marker_id": 61,
"link": "Board",
"observed_position_m": [
-0.010273167795059716,
0.36463632019321685,
-0.05936521876385093
],
"predicted_position_m": [
-0.017186993384537545,
0.34040842616559613,
-0.03526353116172124
],
"error_m": [
-0.00691382558947783,
-0.02422789402762071,
0.02410168760212969
],
"error_norm_m": 0.034866648513529226
},
{
"marker_id": 62,
"link": "Board",
"observed_position_m": [
0.4052500991034773,
-0.17961608003520677,
-0.02860129330488841
],
"predicted_position_m": [
0.4056022056791012,
-0.17402606404855112,
-0.025914320861504775
],
"error_m": [
0.0003521065756239006,
0.00559001598665565,
0.0026869724433836346
],
"error_norm_m": 0.006212252303566424
},
{
"marker_id": 63,
"link": "Board",
"observed_position_m": [
0.793650705177529,
-0.2455555576219817,
-0.04804152775546483
],
"predicted_position_m": [
0.7777723842017723,
-0.23822554041647467,
-0.02549247671060849
],
"error_m": [
-0.0158783209757567,
0.007330017205507022,
0.02254905104485634
],
"error_norm_m": 0.028536116278598967
},
{
"marker_id": 64,
"link": "Board",
"observed_position_m": [
-0.020212843087242333,
-0.18664711640406315,
-0.02623228398950468
],
"predicted_position_m": [
-0.02046232194973048,
-0.18353671865193455,
-0.024729607632139067
],
"error_m": [
-0.00024947886248814777,
0.0031103977521285964,
0.0015026763573656142
],
"error_norm_m": 0.0034633582133906677
},
{
"marker_id": 66,
"link": "Board",
"observed_position_m": [
0.2112402941494965,
-0.35712995003941583,
-0.02398275523167106
],
"predicted_position_m": [
0.2090710727753069,
-0.36045632245526643,
-0.021710519015962968
],
"error_m": [
-0.002169221374189595,
-0.003326372415850598,
0.0022722362157080907
],
"error_norm_m": 0.004575295863564253
},
{
"marker_id": 68,
"link": "Board",
"observed_position_m": [
0.571640476179435,
0.17338792419550367,
-0.023990325126361893
],
"predicted_position_m": [
0.5775452286447659,
0.1701967606003062,
-0.033230900949978014
],
"error_m": [
0.0059047524653308425,
-0.0031911635951974715,
-0.00924057582361612
],
"error_norm_m": 0.011420939905285513
},
{
"marker_id": 69,
"link": "Board",
"observed_position_m": [
0.017838832300215667,
-0.273525688820154,
0.012645184176436158
],
"predicted_position_m": [
0.0076314251493094145,
-0.2767397820557746,
-0.0229226361119002
],
"error_m": [
-0.010207407150906253,
-0.0032140932356206076,
-0.035567820288336355
],
"error_norm_m": 0.03714285121170729
},
{
"marker_id": 72,
"link": "Board",
"observed_position_m": [
0.4428316629283471,
0.19901767904449094,
-0.0322869105551904
],
"predicted_position_m": [
0.44501028151206423,
0.19499801056971586,
-0.03342007940246738
],
"error_m": [
0.0021786185837171512,
-0.004019668474775084,
-0.0011331688472769746
],
"error_norm_m": 0.004710433654862088
},
{
"marker_id": 75,
"link": "Board",
"observed_position_m": [
-0.027008690088654197,
0.19823472058773403,
-0.033723204473509905
],
"predicted_position_m": [
-0.021659615353954997,
0.199219859655652,
-0.03241656091498727
],
"error_m": [
0.0053490747346992,
0.0009851390679179728,
0.001306643558522634
],
"error_norm_m": 0.005593783772149608
},
{
"marker_id": 79,
"link": "Board",
"observed_position_m": [
0.3118339050382921,
-0.16253770901397716,
-0.028924941128076205
],
"predicted_position_m": [
0.31334077448953723,
-0.15725544722430798,
-0.026036083695623685
],
"error_m": [
0.0015068694512451186,
0.005282261789669174,
0.00288885743245252
],
"error_norm_m": 0.006206322777839621
},
{
"marker_id": 83,
"link": "Board",
"observed_position_m": [
0.0426438302170005,
0.339559015660868,
-0.027501294555736213
],
"predicted_position_m": [
0.04941907778341697,
0.3432323968176374,
-0.03547560031504497
],
"error_m": [
0.006775247566416467,
0.0036733811567694064,
-0.00797430575930876
],
"error_norm_m": 0.011089962175412757
},
{
"marker_id": 84,
"link": "Board",
"observed_position_m": [
0.40750100554231905,
0.262085539172646,
-0.029994018343480658
],
"predicted_position_m": [
0.4120528422576719,
0.2593671624020346,
-0.03463642235613811
],
"error_m": [
0.004551836715352864,
-0.002718376770611375,
-0.004642404012657454
],
"error_norm_m": 0.007047035175658761
},
{
"marker_id": 85,
"link": "Board",
"observed_position_m": [
0.5052327332276563,
-0.31461067764594497,
-0.02860128894112495
],
"predicted_position_m": [
0.5043160245339793,
-0.3124912515327591,
-0.023362709204236345
],
"error_m": [
-0.000916708693676993,
0.002119426113185885,
0.005238579736888606
],
"error_norm_m": 0.005724948867724244
},
{
"marker_id": 86,
"link": "Board",
"observed_position_m": [
0.36255478065592384,
0.2951968143044119,
-0.02903589102000064
],
"predicted_position_m": [
0.3677381953969461,
0.29332780147835846,
-0.03521535856749702
],
"error_m": [
0.005183414741022241,
-0.001869012826053451,
-0.006179467547496376
],
"error_norm_m": 0.008279300483250976
},
{
"marker_id": 92,
"link": "Board",
"observed_position_m": [
0.647609094189999,
-0.18750754754418164,
-0.02681176252783257
],
"predicted_position_m": [
0.6459007347108364,
-0.1858045111122829,
-0.026238095399216402
],
"error_m": [
-0.0017083594791625911,
0.00170303643189873,
0.0005736671286161663
],
"error_norm_m": 0.0024794997827936494
},
{
"marker_id": 95,
"link": "Board",
"observed_position_m": [
0.186262561904669,
-0.26836246119075224,
-0.026825122038875483
],
"predicted_position_m": [
0.18611487032737448,
-0.2711162407994176,
-0.023451863007203685
],
"error_m": [
-0.0001476915772945231,
-0.002753779608665352,
0.003373259031671797
],
"error_norm_m": 0.004357062247645791
},
{
"marker_id": 96,
"link": "Board",
"observed_position_m": [
0.36974226201707755,
-0.18895941440950972,
-0.029917117770460532
],
"predicted_position_m": [
0.3705773661912831,
-0.18511682137740493,
-0.025609820081442213
],
"error_m": [
0.0008351041742055698,
0.0038425930321047963,
0.00430729768901832
],
"error_norm_m": 0.005832300881639977
},
{
"marker_id": 97,
"link": "Board",
"observed_position_m": [
0.30573593471495575,
-0.3539299974438902,
-0.028688604748835767
],
"predicted_position_m": [
0.30369750429104686,
-0.35770026478537825,
-0.021986571035044734
],
"error_m": [
-0.002038430423908888,
-0.003770267341488054,
0.006702033713791033
],
"error_norm_m": 0.007955335965262584
},
{
"marker_id": 102,
"link": "Board",
"observed_position_m": [
0.6532853169116069,
-0.22523581436884305,
-0.031471736394007105
],
"predicted_position_m": [
0.6501783262927148,
-0.22399448808793507,
-0.025480818133082388
],
"error_m": [
-0.0031069906188920804,
0.0012413262809079784,
0.005990918260924717
],
"error_norm_m": 0.006861878988341128
},
{
"marker_id": 103,
"link": "Board",
"observed_position_m": [
0.10587298764085004,
-0.1872685011631118,
-0.028756873558720263
],
"predicted_position_m": [
0.10651719662765503,
-0.18409482436457583,
-0.025014528443833572
],
"error_m": [
0.0006442089868049922,
0.0031736767985359737,
0.0037423451148866915
],
"error_norm_m": 0.004948977328616706
},
{
"marker_id": 105,
"link": "Board",
"observed_position_m": [
0.5268925468058784,
-0.2687493257903883,
-0.028050114591019405
],
"predicted_position_m": [
0.5249679039328917,
-0.266174303855376,
-0.024341399729036185
],
"error_m": [
-0.0019246428729866594,
0.0025750219350123005,
0.0037087148619832193
],
"error_norm_m": 0.004908111050274641
},
{
"marker_id": 113,
"link": "Arm2",
"observed_position_m": [
0.28041637693260424,
-0.19872158877928978,
0.2957722126619203
],
"predicted_position_m": [
0.23572119499181232,
-0.05915029827602125,
0.25558271327343457
],
"error_m": [
-0.04469518194079192,
0.13957129050326852,
-0.040189499388485705
],
"error_norm_m": 0.15196381241126244
},
{
"marker_id": 124,
"link": "Arm2",
"observed_position_m": [
0.3179510325507324,
-0.2390062904241294,
0.3172875248346795
],
"predicted_position_m": [
0.2819512112977912,
-0.042571705845387706,
0.28847550679028416
],
"error_m": [
-0.03599982125294121,
0.1964345845787417,
-0.028812018044395316
],
"error_norm_m": 0.20177379793386727
},
{
"marker_id": 198,
"link": "Arm1",
"observed_position_m": [
0.13056884685316103,
-0.07389348412117368,
0.13587886912748515
],
"predicted_position_m": [
0.16640161549206794,
-0.04137291279101603,
0.11239759313089576
],
"error_m": [
0.035832768638906914,
0.03252057133015765,
-0.02348127599658939
],
"error_norm_m": 0.05378610592334518
},
{
"marker_id": 205,
"link": "Board",
"observed_position_m": [
0.748375356811976,
-0.09452600727786088,
0.011969556185094469
],
"predicted_position_m": [
0.7516719139189326,
-0.09132330218998558,
-0.0007772920043905215
],
"error_m": [
0.0032965571069566435,
0.0032027050878753044,
-0.01274684818948499
],
"error_norm_m": 0.01355015672990927
},
{
"marker_id": 206,
"link": "Board",
"observed_position_m": [
0.6470440216888218,
-0.01371610726089136,
0.007318694801492925
],
"predicted_position_m": [
0.6523512896700883,
-0.010493387193897797,
-0.0021695709078748326
],
"error_m": [
0.005307267981266461,
0.0032227200669935636,
-0.009488265709367758
],
"error_norm_m": 0.011339321153699776
},
{
"marker_id": 207,
"link": "Board",
"observed_position_m": [
0.7468786402756248,
-0.014546553422639141,
0.013005282032526235
],
"predicted_position_m": [
0.7523474525118989,
-0.011342325656732447,
-0.002385719931475754
],
"error_m": [
0.0054688122362741565,
0.0032042277659066944,
-0.015391001964001989
],
"error_norm_m": 0.0166450570532919
},
{
"marker_id": 208,
"link": "Board",
"observed_position_m": [
0.3487272920557953,
-0.09413350037790832,
0.001389765445743052
],
"predicted_position_m": [
0.3516872625516899,
-0.087927548338647,
8.730409001316366e-05
],
"error_m": [
0.002959970495894637,
0.006205952039261331,
-0.0013024613557298882
],
"error_norm_m": 0.0069979762526996584
},
{
"marker_id": 210,
"link": "Board",
"observed_position_m": [
0.018120861349245686,
-0.01738466109655536,
-0.0007950740683794831
],
"predicted_position_m": [
0.022291021442560007,
-0.01514269694469615,
-0.000606778568303374
],
"error_m": [
0.004170160093314321,
0.00224196415185921,
0.0001882955000761091
],
"error_norm_m": 0.004738364027535453
},
{
"marker_id": 211,
"link": "Board",
"observed_position_m": [
0.25068179595184664,
-0.011240353169632511,
0.004935236021898448
],
"predicted_position_m": [
0.2523666383028454,
-0.0070976333425592,
-0.0013049748134711472
],
"error_m": [
0.0016848423509987498,
0.004142719827073311,
-0.006240210835369596
],
"error_norm_m": 0.007677307638958428
},
{
"marker_id": 214,
"link": "Board",
"observed_position_m": [
0.3507756143687356,
-0.014233440506156315,
0.004826210435999327
],
"predicted_position_m": [
0.3523628011446562,
-0.007946571805393848,
-0.0015211238370720684
],
"error_m": [
0.0015871867759205682,
0.006286868700762466,
-0.006347334273071395
],
"error_norm_m": 0.009073727585529039
},
{
"marker_id": 217,
"link": "Board",
"observed_position_m": [
0.6499721820721994,
-0.09359823072313132,
0.004107661422486767
],
"predicted_position_m": [
0.651675751077122,
-0.09047436372715094,
-0.0005611429807896003
],
"error_m": [
0.0017035690049225227,
0.0031238669959803844,
-0.0046688044032763675
],
"error_norm_m": 0.005870130059816479
},
{
"marker_id": 229,
"link": "Arm1",
"observed_position_m": [
0.16640174681388165,
-0.1518263116866857,
0.10863026418479936
],
"predicted_position_m": [
0.16566877183521428,
-0.1306288553740845,
0.12392320173879166
],
"error_m": [
-0.0007329749786673667,
0.0211974563126012,
0.015292937553992303
],
"error_norm_m": 0.026148486485345512
},
{
"marker_id": 243,
"link": "Arm1",
"observed_position_m": [
0.16847986408197693,
-0.17155976689014704,
0.06328360140903642
],
"predicted_position_m": [
0.1652706994014028,
-0.16982089283547608,
0.09369365099846033
],
"error_m": [
-0.003209164680574139,
0.0017388740546709636,
0.030410049589423907
],
"error_norm_m": 0.03062831266910199
},
{
"marker_id": 244,
"link": "Ellbow",
"observed_position_m": [
0.25553836987099976,
-0.02006360774474789,
0.006208931593469432
],
"predicted_position_m": [
0.29055089770875575,
-0.13617142157615636,
0.08894128359366708
],
"error_m": [
0.03501252783775599,
-0.11610781383140847,
0.08273235200019766
],
"error_norm_m": 0.14680444000704904
},
{
"marker_id": 245,
"link": "Ellbow",
"observed_position_m": [
0.2406130307128613,
-0.06726290463887721,
0.006046891493775955
],
"predicted_position_m": [
0.255338234129394,
-0.1657316862376428,
0.10727865191031945
],
"error_m": [
0.01472520341653269,
-0.0984687815987656,
0.1012317604165435
],
"error_norm_m": 0.14198873857541
}
]
}
Reference in New Issue View Git Blame Copy Permalink