{"header": {"robotic": "0.4.1", "compiled": "compile time: Jul 16 2026 07:44:51", "date": "2026-11-01", "upstream": "ccc36b55", "upstream_files": ["src/Optim/constrained.cpp", "src/Optim/m_Newton.cpp", "src/Optim/lagrangian.cpp", "src/Optim/NLP.cpp", "src/Optim/options.h"], "image": null, "problem_sha256": "ecfb05865830e425f0b26d558d69ce8c711df00e8996c8239c777be6c5a34600", "writer_sha256": "68d6b3a507b70936f8bbc20f9db8e5c704058a4e13b4112ca3a08c4f9272ba7b", "note": "native RAI for the explorer's Motion refinement tab; see the module docstring", "reference_sha256": "3535e90cea3c5621a535dcf5705a0db28b373007ee60a93d4301509078d064d5", "ts_rows_sha256": "ecfb05865830e425f0b26d558d69ce8c711df00e8996c8239c777be6c5a34600", "capsule_radius": 0.0001, "programs": ["twin", "komo"], "sources_sha256": {"modules/motion-planning/staged_two_link.py": "5eebe7828baedb2dc872d7d320d046e6d1314d8bfcbe1040fba783aa4cfce20b", "modules/motion-planning/rrt_two_link.py": "147b4463ee48b6d6423b10e8db10aad3ef0298134280ca2a3e648b2cf01bdfb7", "modules/motion-planning/stage4_komo_rai.py": "5782ce28f133e784a12c6abbfd79ad29455086d098174f8e6059b68db6f6afff", "modules/motion-planning/stage4_fixture_rai.py": "0a53a279f04ace9537e5246283b8665fd291bee3689643960f9e2d16ae58817c", "lectures/04-D2-motion-planning/code/rai_fixture.py": "1faa3f4d44cbce10e7105d8016b63e62fbe21f3aa7d5bffef8d4b9244db60eb6", "lectures/04-D2-motion-planning/code/rai_nlp.py": "5afe80a08746585fb20ada5b84e8a811d52417a4a6f402a7500b1bac5ccb5690", "modules/opt-explorer/fixtures/refine_rai.py": "68d6b3a507b70936f8bbc20f9db8e5c704058a4e13b4112ca3a08c4f9272ba7b"}}, "features": [{"label": "line start", "scale": 1, "row_diff": 9.930136612989092e-15, "jac_diff": 5.684341886080802e-14, "worst_jac_row": 2}, {"label": "sampled start", "scale": 1, "row_diff": 9.943434964299058e-15, "jac_diff": 5.684341886080802e-14, "worst_jac_row": 2}, {"label": "line + 0.1 rad noise", "scale": 1, "row_diff": 2.1316282072803006e-14, "jac_diff": 5.684341886080802e-14, "worst_jac_row": 2}, {"label": "sampled + 0.05 rad noise", "scale": 1, "row_diff": 1.4210854715202004e-14, "jac_diff": 5.684341886080802e-14, "worst_jac_row": 2}, {"label": "midpoint of the starts", "scale": 1, "row_diff": 9.939965517347105e-15, "jac_diff": 5.684341886080802e-14, "worst_jac_row": 2}, {"label": "wide probe 1", "scale": 1, "row_diff": 4.547473508864641e-13, "jac_diff": 5.684341886080802e-14, "worst_jac_row": 2}, {"label": "wide probe 2", "scale": 1, "row_diff": 3.410605131648481e-13, "jac_diff": 5.684341886080802e-14, "worst_jac_row": 2}, {"label": "wide probe 3", "scale": 1, "row_diff": 3.410605131648481e-13, "jac_diff": 5.684341886080802e-14, "worst_jac_row": 2}, {"label": "sampled start, scale 10", "scale": 10, "row_diff": 9.943434964299058e-15, "jac_diff": 5.684341886080802e-14, "worst_jac_row": 2}], "cases": {"W-auglag-default-line|twin": {"case": "W-auglag-default-line", "model": "W", "method": "AugmentedLag", "opts": "default", "start": "line", "options_passed": {"method": "AugmentedLag"}, "options_effective": {"verbose": 3, "stopTolerance": 0.01, "stopFTolerance": 0.0001, "stopGTolerance": -1.0, "stopEvals": 1000, "stopInners": 1000, "stopOuters": 1000, "stepMax": 0.2, "damping": 1.0, "stepInc": 1.5, "stepDec": 0.5, "wolfe": 0.01, "muInit": 1.0, "muInc": 5.0, "muMax": 10000.0, "muLBInit": 0.1, "muLBDec": 0.2, "lambdaMax": -1.0, "method": "AugmentedLag"}, "constraint_scale": 1.0, "T": 20, "k": 2, "margin_mm": 5.0, "disc": true, "rrt_seed": null, "seed": null, "parent": null, "call": "setInitialization + solve(0)", "program": "twin", "nominal_x": [0.4873681860972264, 0.8162956676063362, 0.45113759659615393, 0.8471931718152241, 0.4149070070950815, 0.8780906760241122, 0.37867641759400905, 0.9089881802330001, 0.34244582809293656, 0.939885684441888, 0.30621523859186417, 0.970783188650776, 0.26998464909079173, 1.001680692859664, 0.23375405958971923, 1.032578197068552, 0.1975234700886468, 1.0634757012774398, 0.16129288058757435, 1.0943732054863278, 0.12506229108650185, 1.1252707096952157, 0.08883170158542947, 1.1561682139041036, 0.05260111208435697, 1.1870657181129916, 0.01637052258328464, 1.2179632223218795, -0.019860066917787855, 1.2488607265307676, -0.05609065641886035, 1.2797582307396556, -0.09232124591993274, 1.3106557349485435, -0.12855183542100523, 1.3415532391574314, -0.16478242492207762, 1.3724507433663193, -0.20101301442315012, 1.4033482475752073], "x_start": [0.4873681860972264, 0.8162956676063362, 0.45113759659615393, 0.8471931718152241, 0.4149070070950815, 0.8780906760241122, 0.37867641759400905, 0.9089881802330001, 0.34244582809293656, 0.939885684441888, 0.30621523859186417, 0.970783188650776, 0.26998464909079173, 1.001680692859664, 0.23375405958971923, 1.032578197068552, 0.1975234700886468, 1.0634757012774398, 0.16129288058757435, 1.0943732054863278, 0.12506229108650185, 1.1252707096952157, 0.08883170158542947, 1.1561682139041036, 0.05260111208435697, 1.1870657181129916, 0.01637052258328464, 1.2179632223218795, -0.019860066917787855, 1.2488607265307676, -0.05609065641886035, 1.2797582307396556, -0.09232124591993274, 1.3106557349485435, -0.12855183542100523, 1.3415532391574314, -0.16478242492207762, 1.3724507433663193, -0.20101301442315012, 1.4033482475752073], "ret": {"evals": 28, "sos": 16.190631440840615, "ineq": 0.0020027127550620583, "eq": 9.991439646450662e-05, "f": 0.0, "feasible": true, "done": true, "time": 0.028584000000000165}, "x": [0.5177644455709793, 0.7993395915348319, 0.5062977344285603, 0.8252966936438909, 0.4894006080165594, 0.8613437255808828, 0.46727507954039965, 0.905554970898114, 0.4401232500426328, 0.9560047638010485, 0.4081473554804823, 1.0107675150214979, 0.37154981693928946, 1.0679177382439704, 0.3305332904956836, 1.1255300747285333, 0.28530071321433187, 1.1816793137822863, 0.23605534172391401, 1.2344404067428665, 0.18300077977201454, 1.2818884721512669, 0.12634099110596922, 1.3220987898074565, 0.06628029396892039, 1.3531467814205551, 0.005462271388291515, 1.3751630814607543, -0.05300084914246827, 1.3896797618359804, -0.10599662245202174, 1.3982289133288055, -0.15041243984357636, 1.4023426249522657, -0.1831355787190856, 1.4035529742870896, -0.2010532445357191, 1.4033920253745198, -0.20105260197775776, 1.403391830749082], "x_end": [0.5177644455709793, 0.7993395915348319, 0.5062977344285603, 0.8252966936438909, 0.4894006080165594, 0.8613437255808828, 0.46727507954039965, 0.905554970898114, 0.4401232500426328, 0.9560047638010485, 0.4081473554804823, 1.0107675150214979, 0.37154981693928946, 1.0679177382439704, 0.3305332904956836, 1.1255300747285333, 0.28530071321433187, 1.1816793137822863, 0.23605534172391401, 1.2344404067428665, 0.18300077977201454, 1.2818884721512669, 0.12634099110596922, 1.3220987898074565, 0.06628029396892039, 1.3531467814205551, 0.005462271388291515, 1.3751630814607543, -0.05300084914246827, 1.3896797618359804, -0.10599662245202174, 1.3982289133288055, -0.15041243984357636, 1.4023426249522657, -0.1831355787190856, 1.4035529742870896, -0.2010532445357191, 1.4033920253745198, -0.20105260197775776, 1.403391830749082], "buffered_x": [0.5177644455709793, 0.7993395915348319, 0.5062977344285603, 0.8252966936438909, 0.4894006080165594, 0.8613437255808828, 0.46727507954039965, 0.905554970898114, 0.4401232500426328, 0.9560047638010485, 0.4081473554804823, 1.0107675150214979, 0.37154981693928946, 1.0679177382439704, 0.3305332904956836, 1.1255300747285333, 0.28530071321433187, 1.1816793137822863, 0.23605534172391401, 1.2344404067428665, 0.18300077977201454, 1.2818884721512669, 0.12634099110596922, 1.3220987898074565, 0.06628029396892039, 1.3531467814205551, 0.005462271388291515, 1.3751630814607543, -0.05300084914246827, 1.3896797618359804, -0.10599662245202174, 1.3982289133288055, -0.15041243984357636, 1.4023426249522657, -0.1831355787190856, 1.4035529742870896, -0.2010532445357191, 1.4033920253745198, -0.20105260197775776, 1.403391830749082], "komo_path": null, "dual": [0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 50.59786300688523, 23.64089867347206, -17.081956927934765, -1.2763882873553278, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 141.23159066251554, 0.0, 51.22446819945527, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0], "trace_errs": [[0.0, 18.138491055467732, 0.2585699416762349, 1.3425618741992085], [0.0, 4.637464933941125, 0.33030083384432707, 1.3653724900872668], [0.0, 0.6376403915657285, 0.27462536070021615, 1.385587112773495], [0.0, 0.21917844913696552, 0.03948886894259984, 1.3891427739989286], [0.0, 0.13146998278109495, 0.0017918134884737855, 1.388872177637965], [0.0, 0.10559154970708376, 0.0, 1.3885139964714568], [0.0, 0.7701385665914959, 0.17846756704604574, 1.1593397442195919], [0.0, 0.9404050248209675, 0.1498222231990453, 1.1312874322798196], [0.0, 0.9840274535939599, 0.14663647888495368, 1.1248538645400048], [0.0, 4.086581575106773, 0.19554220940799993, 0.6099550392665887], [0.0, 5.5816687905871065, 0.17883716543042336, 0.45780906004163757], [0.0, 5.769721063964722, 0.2002051204253989, 0.4406049984831739], [0.0, 5.793413565957064, 0.20879571135256222, 0.43788996711907113], [0.0, 10.11728472148646, 0.09915540011330973, 0.0846183868365348], [0.0, 10.189888292725579, 0.11310479576288451, 0.07461784670299998], [0.0, 10.181327214388817, 0.11887059838504324, 0.07098884102894354], [0.0, 12.242175403145637, 0.06412842384890446, 0.010082300059569421], [0.0, 12.285757283165621, 0.06251563562185905, 0.010697159479118895], [0.0, 14.096955324888546, 0.022391955028351097, 0.003190229615011836], [0.0, 14.099635781923416, 0.019020294922314204, 0.00416876631521404], [0.0, 14.090754600750477, 0.019660191152250032, 0.00461800701689058], [0.0, 15.400729969653312, 0.00615409308731453, 0.0008060097601784444], [0.0, 15.395327573203547, 0.005726339009730963, 0.0009095481204410838], [0.0, 15.938714229757238, 0.0015008631381185564, 0.00011489975436909661], [0.0, 15.893608889347275, 0.0019422721630092538, 0.00025258069026276586], [0.0, 16.450355911221614, 0.000610158859315639, 0.00021198591833287983], [0.0, 16.497222134522193, 0.001506330658446721, 0.000533112351213838], [0.0, 16.190631440840615, 0.0020027127550620583, 9.991439646450662e-05]], "trace_rows": 28, "trace_truncated": false, "outer_iters": 9, "mu_sequence": [5.0, 25.0, 125.0, 625.0, 3125.0, 10000.0, 10000.0, 10000.0, 10000.0], "stop": "StoppingCriterion Delta<0.01", "inner_loops": [{"it": 0, "evals": 6, "A": 0.743519, "f": 0.105592, "g": 0.0, "h": 1.38851, "step": 0.584369, "stop": "DeltaConverge", "bad": 0}, {"it": 1, "evals": 9, "A": 3.74569, "f": 0.984027, "g": 0.146636, "h": 1.12485, "step": 0.16722, "stop": "DeltaConverge", "bad": 0}, {"it": 2, "evals": 13, "A": 9.06831, "f": 5.79341, "g": 0.208796, "h": 0.43789, "step": 0.260809, "stop": "DeltaConverge", "bad": 0}, {"it": 3, "evals": 16, "A": 12.1311, "f": 10.1813, "g": 0.118871, "h": 0.0709888, "step": 0.126894, "stop": "DeltaConverge", "bad": 0}, {"it": 4, "evals": 18, "A": 13.5459, "f": 12.2858, "g": 0.0625156, "h": 0.0106972, "step": 0.0494211, "stop": "DeltaConverge", "bad": 0}, {"it": 5, "evals": 21, "A": 15.3943, "f": 14.0908, "g": 0.0196602, "h": 0.00461801, "step": 0.041149, "stop": "DeltaConverge", "bad": 0}, {"it": 6, "evals": 23, "A": 16.4136, "f": 15.3953, "g": 0.00572634, "h": 0.000909548, "step": 0.0211061, "stop": "DeltaConverge", "bad": 0}, {"it": 7, "evals": 25, "A": 15.9269, "f": 15.8936, "g": 0.00194227, "h": 0.000252581, "step": 0.021292, "stop": "DeltaConverge", "bad": 0}, {"it": 8, "evals": 27, "A": 15.8611, "f": 16.4972, "g": 0.00150633, "h": 0.000533112, "step": 0.0255101, "stop": "DeltaConverge", "bad": 0}, {"it": 9, "evals": 28, "A": 16.1315, "f": 16.1906, "g": 0.00200271, "h": 9.99144e-05, "step": 0.00576, "stop": "DeltaConverge", "bad": 0}], "updates": [{"it": 1, "evals": 6, "A": 4.57109, "mu": 5.0}, {"it": 2, "evals": 9, "A": 14.6511, "mu": 25.0}, {"it": 3, "evals": 13, "A": 18.1262, "mu": 125.0}, {"it": 4, "evals": 16, "A": 16.0794, "mu": 625.0}, {"it": 5, "evals": 18, "A": 18.1531, "mu": 3125.0}, {"it": 6, "evals": 21, "A": 17.6246, "mu": 10000.0}, {"it": 7, "evals": 23, "A": 16.6919, "mu": 10000.0}, {"it": 8, "evals": 25, "A": 16.2166, "mu": 10000.0}, {"it": 9, "evals": 27, "A": 16.2149, "mu": 10000.0}], "phi_at_x": [-0.5218383417701823, 1.2469592407447234, -0.5037754819419472, 1.074714551845639, -0.48571110755351693, 0.9024707593384274, -0.4676424971663725, 0.7302294440411378, -0.4495660303876059, 0.557992659299991, -0.43147749647374983, 0.3857627192834458, -0.41337240419765275, 0.2135419876360521, -0.39524629366178854, 0.04133266669352667, -0.3770950507917856, -0.13086341251984535, -0.3589152252475755, -0.3030449992813921, -0.34070435244466785, -0.47521163092013113, -0.3224612802851322, -0.6473638391175819, -0.3041865010567486, -0.8195033545747331, -0.067737246917407, -0.8078190523526023, 0.2106288425544357, -0.670786375050956, 0.4890144017284758, -0.5337520095496829, 0.7674145870638809, -0.3967178023205079, 1.0458249600371536, -0.2596846176280054, 1.3242417679475142, -0.12265264394394383, 1.6026622226959135, 0.01437830054806915, -3.958755460764518e-05, 4.358317387476163e-05, 1.2851159226778819e-05, -3.892508755320989e-06, -0.15332047896208373, -0.044714993824106035, -0.15474755296560294, -0.044224221325953196, -0.157103416300885, -0.043298632630032426, -0.1606277508477195, -0.041885968348890044, -0.1655984071897585, -0.03996327182397389, -0.17229957546449085, -0.037508910439956876, -0.1809894689896578, -0.0344678953974679, -0.1918722257997849, -0.030711538783683164, -0.20507865322592417, -0.0259935734813403, -0.22065838067487958, -0.01990548131100433, -0.23858287565842617, -0.011834108162202685, -0.25875621102823254, -0.001602664402080893, -0.28102950887841033, 0.0020027127550620583, -0.3042720689648939, -0.0077813314645443984, -0.32707819039602126, -0.027096952762859762, -0.34801806995735923, -0.049340673898680916, -0.3656932266775017, -0.07006180712233281, -0.3787591863533821, -0.08621265797326083, -0.3859223868096976, -0.09534803463409044, -0.3859221298557608, -0.0953477301299854], "residuals_at_x": {"cost": 16.190631440840615, "max_goal_rad": 4.358317387476163e-05, "max_rest_rad_per_normalized_time": 1.2851159226778819e-05, "knot_deficit_mm_link1": 0.0, "knot_deficit_mm_link2": 2.002712755062058, "max_knot_deficit_mm": 2.002712755062058, "margin_mm": 5.0, "T": 20, "validation": {"valid": false, "fail": {"edge": 12, "j": 1, "n": 4, "q": [0.11132581682170702, 1.3298607877107311], "part": "link 2", "c": -0.0006938756705459374}, "evaluated": 58, "scheduled": 64, "deepest": {"c": -0.002538709659391003, "edge": 12, "j": 3, "n": 4, "q": [0.0812954682531826, 1.3453847835172805], "part": "link 2"}, "length_deg": 58.35244988288129}, "deepest_clearance_m": -0.002538709659391003, "between_knot_deficit_mm": 2.538709659391003}, "residuals_at_buffered": null, "upstream": "ccc36b55", "rows_at_x": "staged_two_link rows (sos, eq, ineq) with the eq and ineq rows times the constraint scale"}, "W-auglag-default-line|komo": {"case": "W-auglag-default-line", "model": "W", "method": "AugmentedLag", "opts": "default", "start": "line", "options_passed": {"method": "AugmentedLag"}, "options_effective": {"verbose": 3, "stopTolerance": 0.01, "stopFTolerance": 0.0001, "stopGTolerance": -1.0, "stopEvals": 1000, "stopInners": 1000, "stopOuters": 1000, "stepMax": 0.2, "damping": 1.0, "stepInc": 1.5, "stepDec": 0.5, "wolfe": 0.01, "muInit": 1.0, "muInc": 5.0, "muMax": 10000.0, "muLBInit": 0.1, "muLBDec": 0.2, "lambdaMax": -1.0, "method": "AugmentedLag"}, "constraint_scale": 1.0, "T": 20, "k": 2, "margin_mm": 5.0, "disc": true, "rrt_seed": null, "seed": null, "parent": null, "call": "setInitialization + solve(0)", "program": "komo", "nominal_x": [0.4873681860972264, 0.8162956676063362, 0.45113759659615393, 0.8471931718152241, 0.4149070070950815, 0.8780906760241122, 0.37867641759400905, 0.9089881802330001, 0.34244582809293656, 0.939885684441888, 0.30621523859186417, 0.970783188650776, 0.26998464909079173, 1.001680692859664, 0.23375405958971923, 1.032578197068552, 0.1975234700886468, 1.0634757012774398, 0.16129288058757435, 1.0943732054863278, 0.12506229108650185, 1.1252707096952157, 0.08883170158542947, 1.1561682139041036, 0.05260111208435697, 1.1870657181129916, 0.01637052258328464, 1.2179632223218795, -0.019860066917787855, 1.2488607265307676, -0.05609065641886035, 1.2797582307396556, -0.09232124591993274, 1.3106557349485435, -0.12855183542100523, 1.3415532391574314, -0.16478242492207762, 1.3724507433663193, -0.20101301442315012, 1.4033482475752073], "x_start": [0.4873681860972264, 0.8162956676063362, 0.45113759659615393, 0.8471931718152241, 0.4149070070950815, 0.8780906760241122, 0.37867641759400905, 0.9089881802330001, 0.34244582809293656, 0.939885684441888, 0.30621523859186417, 0.970783188650776, 0.26998464909079173, 1.001680692859664, 0.23375405958971923, 1.032578197068552, 0.1975234700886468, 1.0634757012774398, 0.16129288058757435, 1.0943732054863278, 0.12506229108650185, 1.1252707096952157, 0.08883170158542947, 1.1561682139041036, 0.05260111208435697, 1.1870657181129916, 0.01637052258328464, 1.2179632223218795, -0.019860066917787855, 1.2488607265307676, -0.05609065641886035, 1.2797582307396556, -0.09232124591993274, 1.3106557349485435, -0.12855183542100523, 1.3415532391574314, -0.16478242492207762, 1.3724507433663193, -0.20101301442315012, 1.4033482475752073], "ret": {"evals": 28, "sos": 16.190631440840626, "ineq": 0.002002712755061954, "eq": 9.991439646847566e-05, "f": 0.0, "feasible": true, "done": true, "time": 0.008260000000000156}, "x": [0.5177644455709791, 0.799339591534832, 0.5062977344285601, 0.8252966936438909, 0.489400608016559, 0.8613437255808827, 0.4672750795403991, 0.9055549708981137, 0.4401232500426321, 0.956004763801048, 0.4081473554804815, 1.0107675150214972, 0.37154981693928857, 1.0679177382439697, 0.3305332904956827, 1.1255300747285328, 0.2853007132143311, 1.1816793137822859, 0.23605534172391338, 1.2344404067428663, 0.18300077977201407, 1.2818884721512669, 0.12634099110596897, 1.3220987898074568, 0.06628029396892034, 1.3531467814205556, 0.005462271388291561, 1.3751630814607547, -0.0530008491424682, 1.389679761835981, -0.10599662245202168, 1.3982289133288062, -0.15041243984357636, 1.4023426249522664, -0.18313557871908562, 1.4035529742870898, -0.20105324453571916, 1.40339202537452, -0.20105260197775784, 1.403391830749082], "x_end": [0.5177644455709791, 0.799339591534832, 0.5062977344285601, 0.8252966936438909, 0.489400608016559, 0.8613437255808827, 0.4672750795403991, 0.9055549708981137, 0.4401232500426321, 0.956004763801048, 0.4081473554804815, 1.0107675150214972, 0.37154981693928857, 1.0679177382439697, 0.3305332904956827, 1.1255300747285328, 0.2853007132143311, 1.1816793137822859, 0.23605534172391338, 1.2344404067428663, 0.18300077977201407, 1.2818884721512669, 0.12634099110596897, 1.3220987898074568, 0.06628029396892034, 1.3531467814205556, 0.005462271388291561, 1.3751630814607547, -0.0530008491424682, 1.389679761835981, -0.10599662245202168, 1.3982289133288062, -0.15041243984357636, 1.4023426249522664, -0.18313557871908562, 1.4035529742870898, -0.20105324453571916, 1.40339202537452, -0.20105260197775784, 1.403391830749082], "buffered_x": [0.5177644455709791, 0.799339591534832, 0.5062977344285601, 0.8252966936438909, 0.489400608016559, 0.8613437255808827, 0.4672750795403991, 0.9055549708981137, 0.4401232500426321, 0.956004763801048, 0.4081473554804815, 1.0107675150214972, 0.37154981693928857, 1.0679177382439697, 0.3305332904956827, 1.1255300747285328, 0.2853007132143311, 1.1816793137822859, 0.23605534172391338, 1.2344404067428663, 0.18300077977201407, 1.2818884721512669, 0.12634099110596897, 1.3220987898074568, 0.06628029396892034, 1.3531467814205556, 0.005462271388291561, 1.3751630814607547, -0.0530008491424682, 1.389679761835981, -0.10599662245202168, 1.3982289133288062, -0.15041243984357636, 1.4023426249522664, -0.18313557871908562, 1.4035529742870898, -0.20105324453571916, 1.40339202537452, -0.20105260197775784, 1.403391830749082], "komo_path": [0.5177644455709791, 0.799339591534832, 0.5062977344285601, 0.8252966936438909, 0.489400608016559, 0.8613437255808827, 0.4672750795403991, 0.9055549708981137, 0.4401232500426321, 0.956004763801048, 0.4081473554804815, 1.0107675150214972, 0.37154981693928857, 1.0679177382439697, 0.3305332904956827, 1.1255300747285328, 0.2853007132143311, 1.1816793137822859, 0.23605534172391338, 1.2344404067428663, 0.18300077977201407, 1.2818884721512669, 0.12634099110596897, 1.3220987898074568, 0.06628029396892034, 1.3531467814205556, 0.005462271388291561, 1.3751630814607547, -0.0530008491424682, 1.389679761835981, -0.10599662245202168, 1.3982289133288062, -0.15041243984357636, 1.4023426249522664, -0.18313557871908562, 1.4035529742870898, -0.20105324453571916, 1.40339202537452, -0.20105260197775784, 1.403391830749082], "dual": [0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 50.597863006886506, 23.64089867347279, -17.081956927934453, -1.2763882872618382, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 141.23159066250582, 51.22446819946401, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0], "trace_errs": [[0.0, 18.13849105546762, 0.2585699416762349, 1.3425618741992085], [0.0, 4.6374649339912954, 0.33030083384452646, 1.3653724900873414], [0.0, 0.637640391569212, 0.27462536070024424, 1.3855871127735955], [0.0, 0.2191784491356828, 0.039488868941951104, 1.3891427739989812], [0.0, 0.1314699827803109, 0.0017918134883861542, 1.3888721776379878], [0.0, 0.10559154970670065, 0.0, 1.3885139964714606], [0.0, 0.770138566595019, 0.1784675670471991, 1.15933974421901], [0.0, 0.9404050248225905, 0.14982222319917082, 1.1312874322796125], [0.0, 0.9840274535946104, 0.14663647888496956, 1.1248538645399506], [0.0, 4.08658157510769, 0.19554220940795458, 0.609955039266603], [0.0, 5.581668790590386, 0.17883716543036082, 0.45780906004134164], [0.0, 5.769721063965313, 0.20020512042547534, 0.44060499848310997], [0.0, 5.7934135659570005, 0.20879571135260255, 0.43788996711906936], [0.0, 10.117284721488423, 0.09915540011326568, 0.08461838683654635], [0.0, 10.189888292725705, 0.11310479576288696, 0.07461784670300092], [0.0, 10.181327214388842, 0.11887059838504162, 0.07098884102894545], [0.0, 12.242175403146016, 0.0641284238488978, 0.010082300059566951], [0.0, 12.285757283165628, 0.06251563562185802, 0.010697159479115481], [0.0, 14.096955324888839, 0.022391955028348072, 0.003190229615007617], [0.0, 14.099635781923416, 0.019020294922314274, 0.004168766315213929], [0.0, 14.090754600750454, 0.019660191152250366, 0.004618007016890774], [0.0, 15.400729969653385, 0.0061540930873141275, 0.0008060097601827743], [0.0, 15.39532757320357, 0.005726339009730845, 0.0009095481204405287], [0.0, 15.938714229757231, 0.0015008631381185356, 0.00011489975436965172], [0.0, 15.893608889347242, 0.0019422721630095452, 0.00025258069026332097], [0.0, 16.45035591122167, 0.0006101588593158125, 0.0002119859183292161], [0.0, 16.49722213452225, 0.0015063306584469707, 0.0005331123512183067], [0.0, 16.190631440840626, 0.002002712755061954, 9.991439646847566e-05]], "trace_rows": 28, "trace_truncated": false, "outer_iters": 9, "mu_sequence": [5.0, 25.0, 125.0, 625.0, 3125.0, 10000.0, 10000.0, 10000.0, 10000.0], "stop": "StoppingCriterion Delta<0.01", "inner_loops": [{"it": 0, "evals": 6, "A": 0.743519, "f": 0.105592, "g": 0.0, "h": 1.38851, "step": 0.584369, "stop": "DeltaConverge", "bad": 0}, {"it": 1, "evals": 9, "A": 3.74569, "f": 0.984027, "g": 0.146636, "h": 1.12485, "step": 0.16722, "stop": "DeltaConverge", "bad": 0}, {"it": 2, "evals": 13, "A": 9.06831, "f": 5.79341, "g": 0.208796, "h": 0.43789, "step": 0.260809, "stop": "DeltaConverge", "bad": 0}, {"it": 3, "evals": 16, "A": 12.1311, "f": 10.1813, "g": 0.118871, "h": 0.0709888, "step": 0.126894, "stop": "DeltaConverge", "bad": 0}, {"it": 4, "evals": 18, "A": 13.5459, "f": 12.2858, "g": 0.0625156, "h": 0.0106972, "step": 0.0494211, "stop": "DeltaConverge", "bad": 0}, {"it": 5, "evals": 21, "A": 15.3943, "f": 14.0908, "g": 0.0196602, "h": 0.00461801, "step": 0.041149, "stop": "DeltaConverge", "bad": 0}, {"it": 6, "evals": 23, "A": 16.4136, "f": 15.3953, "g": 0.00572634, "h": 0.000909548, "step": 0.0211061, "stop": "DeltaConverge", "bad": 0}, {"it": 7, "evals": 25, "A": 15.9269, "f": 15.8936, "g": 0.00194227, "h": 0.000252581, "step": 0.021292, "stop": "DeltaConverge", "bad": 0}, {"it": 8, "evals": 27, "A": 15.8611, "f": 16.4972, "g": 0.00150633, "h": 0.000533112, "step": 0.0255101, "stop": "DeltaConverge", "bad": 0}, {"it": 9, "evals": 28, "A": 16.1315, "f": 16.1906, "g": 0.00200271, "h": 9.99144e-05, "step": 0.00576, "stop": "DeltaConverge", "bad": 0}], "updates": [{"it": 1, "evals": 6, "A": 4.57109, "mu": 5.0}, {"it": 2, "evals": 9, "A": 14.6511, "mu": 25.0}, {"it": 3, "evals": 13, "A": 18.1262, "mu": 125.0}, {"it": 4, "evals": 16, "A": 16.0794, "mu": 625.0}, {"it": 5, "evals": 18, "A": 18.1531, "mu": 3125.0}, {"it": 6, "evals": 21, "A": 17.6246, "mu": 10000.0}, {"it": 7, "evals": 23, "A": 16.6919, "mu": 10000.0}, {"it": 8, "evals": 25, "A": 16.2166, "mu": 10000.0}, {"it": 9, "evals": 27, "A": 16.2149, "mu": 10000.0}], "phi_at_x": [-0.521838341770202, 1.2469592407447332, -0.5037754819419273, 1.074714551845619, -0.4857111075535318, 0.9024707593384274, -0.4676424971663725, 0.7302294440411278, -0.4495660303876059, 0.557992659300001, -0.4314774964737449, 0.3857627192834458, -0.41337240419764776, 0.21354198763607193, -0.3952462936617836, 0.04133266669354653, -0.3770950507917757, -0.1308634125198652, -0.3589152252475731, -0.30304499928137224, -0.34070435244466535, -0.47521163092013113, -0.3224612802851272, -0.6473638391175819, -0.30418650105675105, -0.8195033545747331, -0.0677372469174153, -0.8078190523526222, 0.21062884255442887, -0.6707863750509361, 0.4890144017284721, -0.5337520095497027, 0.7674145870638783, -0.3967178023205079, 1.045824960037156, -0.2596846176280451, 1.3242417679475142, -0.12265264394390411, 1.6026622226959135, 0.01437830054804929, -3.958755460772845e-05, 4.358317387476163e-05, 1.2851159226223707e-05, -3.892508759761881e-06, -0.15332047896208376, -0.044714993824105924, -0.15474755296560297, -0.044224221325953154, -0.15710341630088503, -0.04329863263003216, -0.1606277508477196, -0.04188596834888967, -0.1655984071897586, -0.039963271823973405, -0.17229957546449107, -0.03750891043995635, -0.18098946898965804, -0.03446789539746741, -0.19187222579978516, -0.03071153878368272, -0.20507865322592445, -0.025993573481339814, -0.22065838067487975, -0.019905481311003996, -0.23858287565842629, -0.011834108162202532, -0.25875621102823265, -0.001602664402080893, -0.2810295088784104, 0.002002712755061968, -0.30427206896489384, -0.007781331464544412, -0.3270781903960212, -0.027096952762859706, -0.34801806995735923, -0.04934067389868085, -0.3656932266775017, -0.07006180712233276, -0.3787591863533821, -0.08621265797326083, -0.3859223868096976, -0.09534803463409036, -0.38592212985576085, -0.09534773012998549], "residuals_at_x": {"cost": 16.19063144084062, "max_goal_rad": 4.358317387476163e-05, "max_rest_rad_per_normalized_time": 1.2851159226223707e-05, "knot_deficit_mm_link1": 0.0, "knot_deficit_mm_link2": 2.002712755061968, "max_knot_deficit_mm": 2.002712755061968, "margin_mm": 5.0, "T": 20, "validation": {"valid": false, "fail": {"edge": 12, "j": 1, "n": 4, "q": [0.11132581682170681, 1.3298607877107314], "part": "link 2", "c": -0.0006938756705459721}, "evaluated": 58, "scheduled": 64, "deepest": {"c": -0.002538709659390885, "edge": 12, "j": 3, "n": 4, "q": [0.0812954682531825, 1.345384783517281], "part": "link 2"}, "length_deg": 58.35244988288129}, "deepest_clearance_m": -0.002538709659390885, "between_knot_deficit_mm": 2.538709659390885}, "residuals_at_buffered": null, "upstream": "ccc36b55", "rows_at_x": "staged_two_link rows (sos, eq, ineq) with the eq and ineq rows times the constraint scale"}, "W-auglag-default-shortcut|twin": {"case": "W-auglag-default-shortcut", "model": "W", "method": "AugmentedLag", "opts": "default", "start": "shortcut", "options_passed": {"method": "AugmentedLag"}, "options_effective": {"verbose": 3, "stopTolerance": 0.01, "stopFTolerance": 0.0001, "stopGTolerance": -1.0, "stopEvals": 1000, "stopInners": 1000, "stopOuters": 1000, "stepMax": 0.2, "damping": 1.0, "stepInc": 1.5, "stepDec": 0.5, "wolfe": 0.01, "muInit": 1.0, "muInc": 5.0, "muMax": 10000.0, "muLBInit": 0.1, "muLBDec": 0.2, "lambdaMax": -1.0, "method": "AugmentedLag"}, "constraint_scale": 1.0, "T": 20, "k": 2, "margin_mm": 5.0, "disc": true, "rrt_seed": 7, "seed": null, "parent": null, "call": "setInitialization + solve(0)", "program": "twin", "nominal_x": [0.49398606716432986, 0.8266891056465161, 0.4651307531914821, 0.8686379377820006, 0.43646619528099456, 0.9107177430320252, 0.40629608953866575, 0.9517175111402572, 0.3756213981598166, 0.9923553038816949, 0.3449467067809674, 1.0329930966231327, 0.31427201540211824, 1.0736308893645705, 0.28353502034984757, 1.1142212417721706, 0.25252049165525425, 1.1546002697438285, 0.22150596296066088, 1.1949792977154865, 0.19049143426606754, 1.2353583256871445, 0.15947690557147426, 1.2757373536588026, 0.12846237687688095, 1.3161163816304606, 0.09541889381659188, 1.3535564034501737, 0.0459166748668753, 1.3651620901581103, -0.004222505602962695, 1.37401813170593, -0.0543616860728008, 1.3828741732537493, -0.1045008665426388, 1.3917302148015689, -0.1546400470124769, 1.4005862563493883, -0.20101301442315012, 1.4033482475752073], "x_start": [0.49398606716432986, 0.8266891056465161, 0.4651307531914821, 0.8686379377820006, 0.43646619528099456, 0.9107177430320252, 0.40629608953866575, 0.9517175111402572, 0.3756213981598166, 0.9923553038816949, 0.3449467067809674, 1.0329930966231327, 0.31427201540211824, 1.0736308893645705, 0.28353502034984757, 1.1142212417721706, 0.25252049165525425, 1.1546002697438285, 0.22150596296066088, 1.1949792977154865, 0.19049143426606754, 1.2353583256871445, 0.15947690557147426, 1.2757373536588026, 0.12846237687688095, 1.3161163816304606, 0.09541889381659188, 1.3535564034501737, 0.0459166748668753, 1.3651620901581103, -0.004222505602962695, 1.37401813170593, -0.0543616860728008, 1.3828741732537493, -0.1045008665426388, 1.3917302148015689, -0.1546400470124769, 1.4005862563493883, -0.20101301442315012, 1.4033482475752073], "ret": {"evals": 28, "sos": 16.190631528484893, "ineq": 0.0020027136756430378, "eq": 9.991436003267684e-05, "f": 0.0, "feasible": true, "done": true, "time": 0.02097099999999985}, "x": [0.5177644459664553, 0.7993395911831663, 0.5062977355410742, 0.825296692659902, 0.489400610093776, 0.8613437237549433, 0.46727508275613633, 0.9055549680916885, 0.4401232544969499, 0.9560047599468086, 0.4081473611998225, 1.0107675101234974, 0.3715498238766688, 1.0679177323778861, 0.3305332985309337, 1.1255300680419698, 0.28530072215438945, 1.1816793064951379, 0.23605535130314909, 1.2344403991477306, 0.18300078965258681, 1.281888464613889, 0.12634100087819658, 1.3220987827671908, 0.0662803031516404, 1.3531467753908164, 0.005462279267280942, 1.375163076611153, -0.05300084301552721, 1.3896797582311913, -0.10599661825932544, 1.3982289109288364, -0.15041243750104033, 1.40234262361265, -0.18313557787623624, 1.4035529737590051, -0.201053244575629, 1.4033920253048475, -0.2010526020170126, 1.4033918306804158], "x_end": [0.5177644459664553, 0.7993395911831663, 0.5062977355410742, 0.825296692659902, 0.489400610093776, 0.8613437237549433, 0.46727508275613633, 0.9055549680916885, 0.4401232544969499, 0.9560047599468086, 0.4081473611998225, 1.0107675101234974, 0.3715498238766688, 1.0679177323778861, 0.3305332985309337, 1.1255300680419698, 0.28530072215438945, 1.1816793064951379, 0.23605535130314909, 1.2344403991477306, 0.18300078965258681, 1.281888464613889, 0.12634100087819658, 1.3220987827671908, 0.0662803031516404, 1.3531467753908164, 0.005462279267280942, 1.375163076611153, -0.05300084301552721, 1.3896797582311913, -0.10599661825932544, 1.3982289109288364, -0.15041243750104033, 1.40234262361265, -0.18313557787623624, 1.4035529737590051, -0.201053244575629, 1.4033920253048475, -0.2010526020170126, 1.4033918306804158], "buffered_x": [0.5177644459664553, 0.7993395911831663, 0.5062977355410742, 0.825296692659902, 0.489400610093776, 0.8613437237549433, 0.46727508275613633, 0.9055549680916885, 0.4401232544969499, 0.9560047599468086, 0.4081473611998225, 1.0107675101234974, 0.3715498238766688, 1.0679177323778861, 0.3305332985309337, 1.1255300680419698, 0.28530072215438945, 1.1816793064951379, 0.23605535130314909, 1.2344403991477306, 0.18300078965258681, 1.281888464613889, 0.12634100087819658, 1.3220987827671908, 0.0662803031516404, 1.3531467753908164, 0.005462279267280942, 1.375163076611153, -0.05300084301552721, 1.3896797582311913, -0.10599661825932544, 1.3982289109288364, -0.15041243750104033, 1.40234262361265, -0.18313557787623624, 1.4035529737590051, -0.201053244575629, 1.4033920253048475, -0.2010526020170126, 1.4033918306804158], "komo_path": null, "dual": [0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 50.59786805625662, 23.640898377739475, -17.081958109897663, -1.276388240482591, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 141.23158823044554, 0.0, 51.22445196225941, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0], "trace_errs": [[0.0, 28.777650974914156, 0.0, 0.982699172729844], [0.0, 8.035134459254161, 0.11689551193026737, 1.188546411296936], [0.0, 0.985594597957952, 0.1373644517135705, 1.3489636300006587], [0.0, 0.24688922316684744, 0.015480255146420194, 1.3890344652915676], [0.0, 0.13853002588573074, 0.0, 1.3890108619878743], [0.0, 0.10771146573220632, 0.0, 1.388530115652203], [0.0, 0.771467285845057, 0.17756876150969886, 1.1588382664873644], [0.0, 0.9403048450852322, 0.15015617539655682, 1.1310424415661928], [0.0, 0.983475693803837, 0.14712762158196369, 1.1246747643603716], [0.0, 4.081286455568165, 0.1957304391844248, 0.6105375381035741], [0.0, 5.580590641975401, 0.17882502292318012, 0.45790033605533376], [0.0, 5.769487398768996, 0.200200163872911, 0.44062633152374936], [0.0, 5.793231624863053, 0.2088089121679865, 0.43790487199469363], [0.0, 10.117241479629946, 0.09915912249193234, 0.08461387886555655], [0.0, 10.189867260517167, 0.11310597266484952, 0.07461388724381449], [0.0, 10.181305821291128, 0.1188717033397298, 0.07098476367939907], [0.0, 12.24217870428271, 0.0641286996951605, 0.010081610753865794], [0.0, 12.285767688335396, 0.06251547598317789, 0.010696693959866582], [0.0, 14.096965808515431, 0.022391873971252245, 0.0031902295269113923], [0.0, 14.099644092964896, 0.01902016777202127, 0.0041687764712009245], [0.0, 14.090761948050798, 0.019660076620113272, 0.0046180239126761], [0.0, 15.4007309081502, 0.006154079163468752, 0.0008060082427164272], [0.0, 15.395328757949407, 0.005726326209012478, 0.000909546132541933], [0.0, 15.938714401515401, 0.0015008622416305614, 0.00011489892855348627], [0.0, 15.893609301319952, 0.0019422687308844958, 0.00025257968558803356], [0.0, 16.450356658533046, 0.0006101570093519221, 0.00021198621318174737], [0.0, 16.497222831341027, 0.0015063296850231223, 0.0005331129810242918], [0.0, 16.190631528484893, 0.0020027136756430378, 9.991436003267684e-05]], "trace_rows": 28, "trace_truncated": false, "outer_iters": 9, "mu_sequence": [5.0, 25.0, 125.0, 625.0, 3125.0, 10000.0, 10000.0, 10000.0, 10000.0], "stop": "StoppingCriterion Delta<0.01", "inner_loops": [{"it": 0, "evals": 6, "A": 0.743763, "f": 0.107711, "g": 0.0, "h": 1.38853, "step": 0.584854, "stop": "DeltaConverge", "bad": 0}, {"it": 1, "evals": 9, "A": 3.74495, "f": 0.983476, "g": 0.147128, "h": 1.12467, "step": 0.163671, "stop": "DeltaConverge", "bad": 0}, {"it": 2, "evals": 13, "A": 9.06816, "f": 5.79323, "g": 0.208809, "h": 0.437905, "step": 0.260838, "stop": "DeltaConverge", "bad": 0}, {"it": 3, "evals": 16, "A": 12.1312, "f": 10.1813, "g": 0.118872, "h": 0.0709848, "step": 0.126881, "stop": "DeltaConverge", "bad": 0}, {"it": 4, "evals": 18, "A": 13.5459, "f": 12.2858, "g": 0.0625155, "h": 0.0106967, "step": 0.04942, "stop": "DeltaConverge", "bad": 0}, {"it": 5, "evals": 21, "A": 15.3943, "f": 14.0908, "g": 0.0196601, "h": 0.00461802, "step": 0.0411487, "stop": "DeltaConverge", "bad": 0}, {"it": 6, "evals": 23, "A": 16.4136, "f": 15.3953, "g": 0.00572633, "h": 0.000909546, "step": 0.021106, "stop": "DeltaConverge", "bad": 0}, {"it": 7, "evals": 25, "A": 15.9269, "f": 15.8936, "g": 0.00194227, "h": 0.00025258, "step": 0.0212919, "stop": "DeltaConverge", "bad": 0}, {"it": 8, "evals": 27, "A": 15.8611, "f": 16.4972, "g": 0.00150633, "h": 0.000533113, "step": 0.0255102, "stop": "DeltaConverge", "bad": 0}, {"it": 9, "evals": 28, "A": 16.1315, "f": 16.1906, "g": 0.00200271, "h": 9.99144e-05, "step": 0.00576, "stop": "DeltaConverge", "bad": 0}], "updates": [{"it": 1, "evals": 6, "A": 4.56007, "mu": 5.0}, {"it": 2, "evals": 9, "A": 14.6525, "mu": 25.0}, {"it": 3, "evals": 13, "A": 18.1266, "mu": 125.0}, {"it": 4, "evals": 16, "A": 16.0794, "mu": 625.0}, {"it": 5, "evals": 18, "A": 18.1531, "mu": 3125.0}, {"it": 6, "evals": 21, "A": 17.6246, "mu": 10000.0}, {"it": 7, "evals": 23, "A": 16.6919, "mu": 10000.0}, {"it": 8, "evals": 25, "A": 16.2166, "mu": 10000.0}, {"it": 9, "evals": 27, "A": 16.2149, "mu": 10000.0}], "phi_at_x": [-0.5218383063977348, 1.246959209290797, -0.5037754531805776, 1.0747145267428493, -0.4857110854016959, 0.9024707405887903, -0.46764248161968114, 0.7302294316501544, -0.4495660214379362, 0.557992653277959, -0.4314774941086445, 0.3857627196460348, -0.413372408400022, 0.21354199440479069, -0.39524630440997477, 0.04133267989568302, -0.377095068059896, -0.130863392851899, -0.35891524900624167, -0.3030449731106759, -0.3407043826620214, -0.47521159820686504, -0.3224613169282151, -0.6473637998205558, -0.3041865440932258, -0.8195033086535114, -0.06773731079947334, -0.8078190371821935, 0.2106288024556733, -0.6707863692662541, 0.48901438543233594, -0.5337520131266968, 0.7674145945846262, -0.3967178152419989, 1.0458249913844648, -0.25968463988332824, 1.3242418231271806, -0.12265267552787536, 1.6026623017108919, 0.014378259636422672, -3.958759386249455e-05, 4.358310520857778e-05, 1.2851172327965621e-05, -3.892488633638891e-06, -0.15332047891530354, -0.04471499394240638, -0.15474755282033723, -0.04422422165156844, -0.15710341599310662, -0.04329863321851487, -0.16062775030035914, -0.04188596922170198, -0.16559840631843664, -0.039963272971135645, -0.17229957418862496, -0.03750891182575535, -0.18098946724678505, -0.03446789696879652, -0.19187222356012906, -0.030711540480232093, -0.20507865050424667, -0.02599357524649102, -0.22065837753764367, -0.01990548310200666, -0.2385828722258041, -0.011834109958073484, -0.2587562074717687, -0.0016026655780283505, -0.28102950541575855, 0.0020027136756430378, -0.30427206591815875, -0.007781329129607169, -0.32707818798765265, -0.027096950381777236, -0.34801806829335247, -0.04934067212282208, -0.36569322574320556, -0.07006180610212859, -0.3787591860165349, -0.08621265760849131, -0.3859223868256572, -0.09534803466333971, -0.3859221298714585, -0.09534773015877201], "residuals_at_x": {"cost": 16.190631528484893, "max_goal_rad": 4.358310520857778e-05, "max_rest_rad_per_normalized_time": 1.2851172327965621e-05, "knot_deficit_mm_link1": 0.0, "knot_deficit_mm_link2": 2.002713675643038, "max_knot_deficit_mm": 2.002713675643038, "margin_mm": 5.0, "T": 20, "validation": {"valid": false, "fail": {"edge": 12, "j": 1, "n": 4, "q": [0.11132582644655753, 1.3298607809230973], "part": "link 2", "c": -0.0006938749984405869}, "evaluated": 58, "scheduled": 64, "deepest": {"c": -0.002538710062992856, "edge": 12, "j": 3, "n": 4, "q": [0.08129547758327944, 1.34538477723491], "part": "link 2"}, "length_deg": 58.352449873063605}, "deepest_clearance_m": -0.002538710062992856, "between_knot_deficit_mm": 2.5387100629928563}, "residuals_at_buffered": null, "upstream": "ccc36b55", "rows_at_x": "staged_two_link rows (sos, eq, ineq) with the eq and ineq rows times the constraint scale"}, "W-auglag-default-shortcut|komo": {"case": "W-auglag-default-shortcut", "model": "W", "method": "AugmentedLag", "opts": "default", "start": "shortcut", "options_passed": {"method": "AugmentedLag"}, "options_effective": {"verbose": 3, "stopTolerance": 0.01, "stopFTolerance": 0.0001, "stopGTolerance": -1.0, "stopEvals": 1000, "stopInners": 1000, "stopOuters": 1000, "stepMax": 0.2, "damping": 1.0, "stepInc": 1.5, "stepDec": 0.5, "wolfe": 0.01, "muInit": 1.0, "muInc": 5.0, "muMax": 10000.0, "muLBInit": 0.1, "muLBDec": 0.2, "lambdaMax": -1.0, "method": "AugmentedLag"}, "constraint_scale": 1.0, "T": 20, "k": 2, "margin_mm": 5.0, "disc": true, "rrt_seed": 7, "seed": null, "parent": null, "call": "setInitialization + solve(0)", "program": "komo", "nominal_x": [0.49398606716432986, 0.8266891056465161, 0.4651307531914821, 0.8686379377820006, 0.43646619528099456, 0.9107177430320252, 0.40629608953866575, 0.9517175111402572, 0.3756213981598166, 0.9923553038816949, 0.3449467067809674, 1.0329930966231327, 0.31427201540211824, 1.0736308893645705, 0.28353502034984757, 1.1142212417721706, 0.25252049165525425, 1.1546002697438285, 0.22150596296066088, 1.1949792977154865, 0.19049143426606754, 1.2353583256871445, 0.15947690557147426, 1.2757373536588026, 0.12846237687688095, 1.3161163816304606, 0.09541889381659188, 1.3535564034501737, 0.0459166748668753, 1.3651620901581103, -0.004222505602962695, 1.37401813170593, -0.0543616860728008, 1.3828741732537493, -0.1045008665426388, 1.3917302148015689, -0.1546400470124769, 1.4005862563493883, -0.20101301442315012, 1.4033482475752073], "x_start": [0.49398606716432986, 0.8266891056465161, 0.4651307531914821, 0.8686379377820006, 0.43646619528099456, 0.9107177430320252, 0.40629608953866575, 0.9517175111402572, 0.3756213981598166, 0.9923553038816949, 0.3449467067809674, 1.0329930966231327, 0.31427201540211824, 1.0736308893645705, 0.28353502034984757, 1.1142212417721706, 0.25252049165525425, 1.1546002697438285, 0.22150596296066088, 1.1949792977154865, 0.19049143426606754, 1.2353583256871445, 0.15947690557147426, 1.2757373536588026, 0.12846237687688095, 1.3161163816304606, 0.09541889381659188, 1.3535564034501737, 0.0459166748668753, 1.3651620901581103, -0.004222505602962695, 1.37401813170593, -0.0543616860728008, 1.3828741732537493, -0.1045008665426388, 1.3917302148015689, -0.1546400470124769, 1.4005862563493883, -0.20101301442315012, 1.4033482475752073], "ret": {"evals": 28, "sos": 16.190631528484957, "ineq": 0.0020027136756428573, "eq": 9.991436002884657e-05, "f": 0.0, "feasible": true, "done": true, "time": 0.005317000000000016}, "x": [0.5177644459664551, 0.7993395911831664, 0.5062977355410738, 0.8252966926599021, 0.4894006100937756, 0.8613437237549434, 0.46727508275613583, 0.9055549680916886, 0.44012325449694933, 0.9560047599468087, 0.4081473611998218, 1.0107675101234974, 0.3715498238766681, 1.0679177323778863, 0.33053329853093305, 1.12553006804197, 0.28530072215438884, 1.181679306495138, 0.23605535130314867, 1.234440399147731, 0.18300078965258657, 1.2818884646138895, 0.12634100087819652, 1.3220987827671915, 0.06628030315164049, 1.353146775390817, 0.0054622792672811005, 1.3751630766111533, -0.05300084301552707, 1.3896797582311915, -0.10599661825932537, 1.3982289109288366, -0.15041243750104033, 1.40234262361265, -0.1831355778762363, 1.403552973759005, -0.2010532445756291, 1.4033920253048473, -0.20105260201701267, 1.4033918306804158], "x_end": [0.5177644459664551, 0.7993395911831664, 0.5062977355410738, 0.8252966926599021, 0.4894006100937756, 0.8613437237549434, 0.46727508275613583, 0.9055549680916886, 0.44012325449694933, 0.9560047599468087, 0.4081473611998218, 1.0107675101234974, 0.3715498238766681, 1.0679177323778863, 0.33053329853093305, 1.12553006804197, 0.28530072215438884, 1.181679306495138, 0.23605535130314867, 1.234440399147731, 0.18300078965258657, 1.2818884646138895, 0.12634100087819652, 1.3220987827671915, 0.06628030315164049, 1.353146775390817, 0.0054622792672811005, 1.3751630766111533, -0.05300084301552707, 1.3896797582311915, -0.10599661825932537, 1.3982289109288366, -0.15041243750104033, 1.40234262361265, -0.1831355778762363, 1.403552973759005, -0.2010532445756291, 1.4033920253048473, -0.20105260201701267, 1.4033918306804158], "buffered_x": [0.5177644459664551, 0.7993395911831664, 0.5062977355410738, 0.8252966926599021, 0.4894006100937756, 0.8613437237549434, 0.46727508275613583, 0.9055549680916886, 0.44012325449694933, 0.9560047599468087, 0.4081473611998218, 1.0107675101234974, 0.3715498238766681, 1.0679177323778863, 0.33053329853093305, 1.12553006804197, 0.28530072215438884, 1.181679306495138, 0.23605535130314867, 1.234440399147731, 0.18300078965258657, 1.2818884646138895, 0.12634100087819652, 1.3220987827671915, 0.06628030315164049, 1.353146775390817, 0.0054622792672811005, 1.3751630766111533, -0.05300084301552707, 1.3896797582311915, -0.10599661825932537, 1.3982289109288366, -0.15041243750104033, 1.40234262361265, -0.1831355778762363, 1.403552973759005, -0.2010532445756291, 1.4033920253048473, -0.20105260201701267, 1.4033918306804158], "komo_path": [0.5177644459664551, 0.7993395911831664, 0.5062977355410738, 0.8252966926599021, 0.4894006100937756, 0.8613437237549434, 0.46727508275613583, 0.9055549680916886, 0.44012325449694933, 0.9560047599468087, 0.4081473611998218, 1.0107675101234974, 0.3715498238766681, 1.0679177323778863, 0.33053329853093305, 1.12553006804197, 0.28530072215438884, 1.181679306495138, 0.23605535130314867, 1.234440399147731, 0.18300078965258657, 1.2818884646138895, 0.12634100087819652, 1.3220987827671915, 0.06628030315164049, 1.353146775390817, 0.0054622792672811005, 1.3751630766111533, -0.05300084301552707, 1.3896797582311915, -0.10599661825932537, 1.3982289109288366, -0.15041243750104033, 1.40234262361265, -0.1831355778762363, 1.403552973759005, -0.2010532445756291, 1.4033920253048473, -0.20105260201701267, 1.4033918306804158], "dual": [0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 50.5978680562581, 23.640898377738576, -17.081958109911977, -1.276388240577071, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 141.23158823044008, 51.224451962269995, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0], "trace_errs": [[0.0, 28.777650974914046, 0.0, 0.982699172729844], [0.0, 8.035134459311305, 0.11689551193012876, 1.1885464112961082], [0.0, 0.9855945979709975, 0.13736445171416745, 1.3489636299996746], [0.0, 0.24688922316445502, 0.015480255145939238, 1.3890344652916546], [0.0, 0.13853002588454683, 0.0, 1.3890108619878843], [0.0, 0.10771146573168808, 0.0, 1.3885301156522025], [0.0, 0.7714672858484624, 0.1775687615108803, 1.1588382664868209], [0.0, 0.9403048450868384, 0.15015617539670184, 1.1310424415659939], [0.0, 0.9834756938044331, 0.14712762158199588, 1.1246747643603379], [0.0, 4.081286455568274, 0.19573043918425237, 0.6105375381036996], [0.0, 5.580590641978201, 0.17882502292311275, 0.45790033605508074], [0.0, 5.769487398769618, 0.20020016387297224, 0.44062633152369074], [0.0, 5.793231624863116, 0.20880891216802064, 0.43790487199468], [0.0, 10.117241479632044, 0.09915912249188322, 0.08461387886560104], [0.0, 10.189867260517312, 0.11310597266485453, 0.07461388724380869], [0.0, 10.181305821291117, 0.1188717033397301, 0.07098476367940476], [0.0, 12.242178704283239, 0.06412869969515489, 0.010081610753856579], [0.0, 12.285767688335419, 0.06251547598317808, 0.010696693959871523], [0.0, 14.09696580851574, 0.02239187397124922, 0.0031902295269112813], [0.0, 14.099644092964892, 0.01902016777202118, 0.00416877647120531], [0.0, 14.090761948050773, 0.019660076620113646, 0.004618023912676655], [0.0, 15.400730908150276, 0.006154079163468204, 0.0008060082427202853], [0.0, 15.395328757949407, 0.0057263262090126235, 0.0009095461325419052], [0.0, 15.938714401515416, 0.0015008622416304712, 0.00011489892855792716], [0.0, 15.893609301319952, 0.0019422687308845582, 0.0002525796855880891], [0.0, 16.450356658533114, 0.00061015700935204, 0.00021198621318596622], [0.0, 16.497222831341052, 0.0015063296850234414, 0.0005331129810204338], [0.0, 16.190631528484957, 0.0020027136756428573, 9.991436002884657e-05]], "trace_rows": 28, "trace_truncated": false, "outer_iters": 9, "mu_sequence": [5.0, 25.0, 125.0, 625.0, 3125.0, 10000.0, 10000.0, 10000.0, 10000.0], "stop": "StoppingCriterion Delta<0.01", "inner_loops": [{"it": 0, "evals": 6, "A": 0.743763, "f": 0.107711, "g": 0.0, "h": 1.38853, "step": 0.584854, "stop": "DeltaConverge", "bad": 0}, {"it": 1, "evals": 9, "A": 3.74495, "f": 0.983476, "g": 0.147128, "h": 1.12467, "step": 0.163671, "stop": "DeltaConverge", "bad": 0}, {"it": 2, "evals": 13, "A": 9.06816, "f": 5.79323, "g": 0.208809, "h": 0.437905, "step": 0.260838, "stop": "DeltaConverge", "bad": 0}, {"it": 3, "evals": 16, "A": 12.1312, "f": 10.1813, "g": 0.118872, "h": 0.0709848, "step": 0.126881, "stop": "DeltaConverge", "bad": 0}, {"it": 4, "evals": 18, "A": 13.5459, "f": 12.2858, "g": 0.0625155, "h": 0.0106967, "step": 0.04942, "stop": "DeltaConverge", "bad": 0}, {"it": 5, "evals": 21, "A": 15.3943, "f": 14.0908, "g": 0.0196601, "h": 0.00461802, "step": 0.0411487, "stop": "DeltaConverge", "bad": 0}, {"it": 6, "evals": 23, "A": 16.4136, "f": 15.3953, "g": 0.00572633, "h": 0.000909546, "step": 0.021106, "stop": "DeltaConverge", "bad": 0}, {"it": 7, "evals": 25, "A": 15.9269, "f": 15.8936, "g": 0.00194227, "h": 0.00025258, "step": 0.0212919, "stop": "DeltaConverge", "bad": 0}, {"it": 8, "evals": 27, "A": 15.8611, "f": 16.4972, "g": 0.00150633, "h": 0.000533113, "step": 0.0255102, "stop": "DeltaConverge", "bad": 0}, {"it": 9, "evals": 28, "A": 16.1315, "f": 16.1906, "g": 0.00200271, "h": 9.99144e-05, "step": 0.00576, "stop": "DeltaConverge", "bad": 0}], "updates": [{"it": 1, "evals": 6, "A": 4.56007, "mu": 5.0}, {"it": 2, "evals": 9, "A": 14.6525, "mu": 25.0}, {"it": 3, "evals": 13, "A": 18.1266, "mu": 125.0}, {"it": 4, "evals": 16, "A": 16.0794, "mu": 625.0}, {"it": 5, "evals": 18, "A": 18.1531, "mu": 3125.0}, {"it": 6, "evals": 21, "A": 17.6246, "mu": 10000.0}, {"it": 7, "evals": 23, "A": 16.6919, "mu": 10000.0}, {"it": 8, "evals": 25, "A": 16.2166, "mu": 10000.0}, {"it": 9, "evals": 27, "A": 16.2149, "mu": 10000.0}], "phi_at_x": [-0.5218383063977546, 1.246959209290807, -0.5037754531805677, 1.0747145267428393, -0.4857110854016909, 0.9024707405887903, -0.46764248161968613, 0.7302294316501544, -0.44956602143793123, 0.557992653277959, -0.4314774941086495, 0.3857627196460348, -0.41337240840001704, 0.21354199440481053, -0.39524630440996483, 0.04133267989566316, -0.377095068059896, -0.130863392851899, -0.35891524900622923, -0.3030449731106561, -0.3407043826620239, -0.47521159820688486, -0.3224613169282126, -0.6473637998205359, -0.30418654409322954, -0.8195033086535313, -0.06773731079948149, -0.8078190371822134, 0.21062880245566587, -0.6707863692662541, 0.48901438543233094, -0.533752013126677, 0.7674145945846262, -0.39671781524201877, 1.0458249913844648, -0.25968463988332824, 1.324241823127183, -0.1226526755278555, 1.6026623017108967, 0.014378259636442531, -3.9587593862550063e-05, 4.358310520857778e-05, 1.2851172328520732e-05, -3.892488629197999e-06, -0.15332047891530357, -0.04471499394240635, -0.1547475528203373, -0.04422422165156833, -0.15710341599310673, -0.04329863321851481, -0.16062775030035922, -0.04188596922170181, -0.16559840631843672, -0.03996327297113541, -0.17229957418862513, -0.03750891182575509, -0.1809894672467852, -0.0344678969687963, -0.19187222356012928, -0.030711540480231884, -0.20507865050424684, -0.025993575246490798, -0.22065837753764378, -0.019905483102006606, -0.2385828722258042, -0.011834109958073484, -0.2587562074717687, -0.0016026655780285101, -0.2810295054157585, 0.0020027136756428573, -0.3042720659181587, -0.0077813291296071965, -0.32707818798765254, -0.027096950381777153, -0.34801806829335247, -0.04934067212282207, -0.36569322574320556, -0.07006180610212859, -0.3787591860165349, -0.08621265760849131, -0.3859223868256572, -0.09534803466333977, -0.3859221298714585, -0.09534773015877201], "residuals_at_x": {"cost": 16.190631528484946, "max_goal_rad": 4.358310520857778e-05, "max_rest_rad_per_normalized_time": 1.2851172328520732e-05, "knot_deficit_mm_link1": 0.0, "knot_deficit_mm_link2": 2.002713675642857, "max_knot_deficit_mm": 2.002713675642857, "margin_mm": 5.0, "T": 20, "validation": {"valid": false, "fail": {"edge": 12, "j": 1, "n": 4, "q": [0.11132582644655752, 1.3298607809230978], "part": "link 2", "c": -0.0006938749984404273}, "evaluated": 58, "scheduled": 64, "deepest": {"c": -0.0025387100629926966, "edge": 12, "j": 3, "n": 4, "q": [0.0812954775832795, 1.3453847772349108], "part": "link 2"}, "length_deg": 58.35244987306362}, "deepest_clearance_m": -0.0025387100629926966, "between_knot_deficit_mm": 2.5387100629926964}, "residuals_at_buffered": null, "upstream": "ccc36b55", "rows_at_x": "staged_two_link rows (sos, eq, ineq) with the eq and ineq rows times the constraint scale"}, "W-auglag-tight-line-s10|twin": {"case": "W-auglag-tight-line-s10", "model": "W", "method": "AugmentedLag", "opts": "tight", "start": "line", "options_passed": {"method": "AugmentedLag", "stopTolerance": 1e-08, "stopFTolerance": 1e-12, "stopEvals": 5000}, "options_effective": {"verbose": 3, "stopTolerance": 1e-08, "stopFTolerance": 1e-12, "stopGTolerance": -1.0, "stopEvals": 5000, "stopInners": 1000, "stopOuters": 1000, "stepMax": 0.2, "damping": 1.0, "stepInc": 1.5, "stepDec": 0.5, "wolfe": 0.01, "muInit": 1.0, "muInc": 5.0, "muMax": 10000.0, "muLBInit": 0.1, "muLBDec": 0.2, "lambdaMax": -1.0, "method": "AugmentedLag"}, "constraint_scale": 10.0, "T": 20, "k": 2, "margin_mm": 5.0, "disc": true, "rrt_seed": null, "seed": null, "parent": null, "call": "setInitialization + solve(0)", "program": "twin", "nominal_x": [0.4873681860972264, 0.8162956676063362, 0.45113759659615393, 0.8471931718152241, 0.4149070070950815, 0.8780906760241122, 0.37867641759400905, 0.9089881802330001, 0.34244582809293656, 0.939885684441888, 0.30621523859186417, 0.970783188650776, 0.26998464909079173, 1.001680692859664, 0.23375405958971923, 1.032578197068552, 0.1975234700886468, 1.0634757012774398, 0.16129288058757435, 1.0943732054863278, 0.12506229108650185, 1.1252707096952157, 0.08883170158542947, 1.1561682139041036, 0.05260111208435697, 1.1870657181129916, 0.01637052258328464, 1.2179632223218795, -0.019860066917787855, 1.2488607265307676, -0.05609065641886035, 1.2797582307396556, -0.09232124591993274, 1.3106557349485435, -0.12855183542100523, 1.3415532391574314, -0.16478242492207762, 1.3724507433663193, -0.20101301442315012, 1.4033482475752073], "x_start": [0.4873681860972264, 0.8162956676063362, 0.45113759659615393, 0.8471931718152241, 0.4149070070950815, 0.8780906760241122, 0.37867641759400905, 0.9089881802330001, 0.34244582809293656, 0.939885684441888, 0.30621523859186417, 0.970783188650776, 0.26998464909079173, 1.001680692859664, 0.23375405958971923, 1.032578197068552, 0.1975234700886468, 1.0634757012774398, 0.16129288058757435, 1.0943732054863278, 0.12506229108650185, 1.1252707096952157, 0.08883170158542947, 1.1561682139041036, 0.05260111208435697, 1.1870657181129916, 0.01637052258328464, 1.2179632223218795, -0.019860066917787855, 1.2488607265307676, -0.05609065641886035, 1.2797582307396556, -0.09232124591993274, 1.3106557349485435, -0.12855183542100523, 1.3415532391574314, -0.16478242492207762, 1.3724507433663193, -0.20101301442315012, 1.4033482475752073], "ret": {"evals": 132, "sos": 16.138216033785675, "ineq": 8.988253197284024e-10, "eq": 2.468414361800342e-10, "f": 0.0, "feasible": true, "done": true, "time": 0.0963900000000002}, "x": [0.5170520499737724, 0.799922116032177, 0.5042963223882763, 0.8269269353733721, 0.48566931650537104, 0.8643695354927391, 0.4615087559886304, 0.9102068304618965, 0.43215236450165234, 0.9623957343523043, 0.39793786570807416, 1.0188931612351846, 0.35920298327158995, 1.0776560251814427, 0.3162854408559706, 1.1366412402615949, 0.26952296212508553, 1.1938057205457147, 0.219253270742927, 1.2471063801034004, 0.1658140903736361, 1.2945001330037746, 0.10954314468153062, 1.3339438933155252, 0.05077815733113617, 1.3633945751069907, -0.007680711438840445, 1.3834524766888847, -0.06313716842458679, 1.3958461113788907, -0.11289492042202144, 1.4023039924947995, -0.15425767422683687, 1.4045546333545473, -0.18452913663456166, 1.4043265472761999, -0.20101301444062852, 1.4033482475779104, -0.2010130144404333, 1.4033482475778687], "x_end": [0.5170520499737724, 0.799922116032177, 0.5042963223882763, 0.8269269353733721, 0.48566931650537104, 0.8643695354927391, 0.4615087559886304, 0.9102068304618965, 0.43215236450165234, 0.9623957343523043, 0.39793786570807416, 1.0188931612351846, 0.35920298327158995, 1.0776560251814427, 0.3162854408559706, 1.1366412402615949, 0.26952296212508553, 1.1938057205457147, 0.219253270742927, 1.2471063801034004, 0.1658140903736361, 1.2945001330037746, 0.10954314468153062, 1.3339438933155252, 0.05077815733113617, 1.3633945751069907, -0.007680711438840445, 1.3834524766888847, -0.06313716842458679, 1.3958461113788907, -0.11289492042202144, 1.4023039924947995, -0.15425767422683687, 1.4045546333545473, -0.18452913663456166, 1.4043265472761999, -0.20101301444062852, 1.4033482475779104, -0.2010130144404333, 1.4033482475778687], "buffered_x": [0.5170520499737724, 0.799922116032177, 0.5042963223882763, 0.8269269353733721, 0.48566931650537104, 0.8643695354927391, 0.4615087559886304, 0.9102068304618965, 0.43215236450165234, 0.9623957343523043, 0.39793786570807416, 1.0188931612351846, 0.35920298327158995, 1.0776560251814427, 0.3162854408559706, 1.1366412402615949, 0.26952296212508553, 1.1938057205457147, 0.219253270742927, 1.2471063801034004, 0.1658140903736361, 1.2945001330037746, 0.10954314468153062, 1.3339438933155252, 0.05077815733113617, 1.3633945751069907, -0.007680711438840445, 1.3834524766888847, -0.06313716842458679, 1.3958461113788907, -0.11289492042202144, 1.4023039924947995, -0.15425767422683687, 1.4045546333545473, -0.18452913663456166, 1.4043265472761999, -0.20101301444062852, 1.4033482475779104, -0.2010130144404333, 1.4033482475778687], "komo_path": null, "dual": [0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 4.314069127369269, 2.765621309098387, -1.5344136808848052, -0.21654504116543905, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 14.695498195391949, 0.0, 8.713593819245983, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0], "trace_errs": [[0.0, 18.138491055467732, 2.5856994167623495, 13.425618741992086], [0.0, 8.436014897270491, 1.7836844885043177, 1.9746113903526934], [0.0, 8.392847281261721, 1.7458831287555598, 2.0122767645653505], [0.0, 8.392444506221919, 1.7183027278741514, 2.015951817611232], [0.0, 8.388954204344227, 1.6908307025893647, 2.0224644151178977], [0.0, 8.38187915847512, 1.663266491466722, 2.0319611234087196], [0.0, 8.37310226820101, 1.6373932503449562, 2.042636387395065], [0.0, 8.364633722672135, 1.6157385692005097, 2.0524913140813617], [0.0, 8.35783619678448, 1.5995549959384112, 2.0602338126792588], [0.0, 8.353035600521551, 1.5884552909923142, 2.0656513602486957], [0.0, 8.34990239691401, 1.581262781728733, 2.0691768856425643], [0.0, 8.347946059853903, 1.576764186187933, 2.07137775022137], [0.0, 8.346753215896134, 1.574010481550422, 2.0727205674234543], [0.0, 8.346035026381777, 1.5723465992922265, 2.0735296398020733], [0.0, 8.345605553234261, 1.5713490058076445, 2.074013734581298], [0.0, 8.345349694440053, 1.5707536566496345, 2.0743022461852494], [0.0, 8.345197589329732, 1.5703993396236686, 2.074473805794555], [0.0, 8.345107274542734, 1.5701888161391566, 2.074575687767874], [0.0, 8.345053686603233, 1.5700638516635257, 2.0746361447539305], [0.0, 8.345021903548131, 1.5699897168954924, 2.0746720038827187], [0.0, 8.345003057574974, 1.5699457517374336, 2.074693267513156], [0.0, 8.34499188433425, 1.5699196837680875, 2.0747058743692812], [0.0, 8.34498526060016, 1.569904229319713, 2.074713348070959], [0.0, 8.344981334107215, 1.5698950677722434, 2.07471777844913], [0.0, 8.34497900658503, 1.5698896369473372, 2.0747204046724064], [0.0, 8.344977626915082, 1.569886417718271, 2.0747219614053534], [0.0, 8.344976809105804, 1.5698845094848073, 2.0747228841713756], [0.0, 8.344976324346504, 1.569883378368381, 2.0747234311446245], [0.0, 8.344976037004749, 1.5698827078960729, 2.0747237553639692], [0.0, 8.344975866682892, 1.5698823104730366, 2.074723947545077], [0.0, 8.344975765724739, 1.5698820749006261, 2.0747240614603077], [0.0, 11.753160117172353, 0.7540859119230438, 0.1917434195627854], [0.0, 11.816601906742441, 0.730360398003264, 0.2065462940720672], [0.0, 11.819633362067993, 0.7294761684804852, 0.2066867707815251], [0.0, 11.818781115694929, 0.7299818992020456, 0.20609664980204973], [0.0, 11.818102215672344, 0.7303427729728472, 0.20571621137503382], [0.0, 11.817707411486504, 0.7305501003315087, 0.2054999364776039], [0.0, 11.817485735977444, 0.7307344093403123, 0.2053788745861898], [0.0, 11.817361828181506, 0.730856469419533, 0.20531123470324403], [0.0, 11.817292601307003, 0.7309246536284719, 0.20527344677945758], [0.0, 11.81725392369356, 0.7309627466163096, 0.2052523345397922], [0.0, 11.817232313099165, 0.7309840299987282, 0.205240538375962], [0.0, 11.81722023806183, 0.7309959220364822, 0.20523394720677463], [0.0, 11.817213490935963, 0.7310025668562989, 0.20523026428271945], [0.0, 11.817209720826488, 0.7310062797837813, 0.20522820636556416], [0.0, 11.817207614179223, 0.7310083544740182, 0.20522705645050515], [0.0, 11.81720643703094, 0.7310095137638803, 0.2052264139032442], [0.0, 11.817205779264981, 0.7310101615504127, 0.20522605486118561], [0.0, 11.817205411718652, 0.7310105235202784, 0.20522585423574102], [0.0, 11.817205206341082, 0.7310107257817896, 0.20522574213021616], [0.0, 11.81720509158015, 0.7310108388015256, 0.20522567948788845], [0.0, 11.817205027453994, 0.7310109019547374, 0.2052256444845993], [0.0, 13.756110191291574, 0.29938360779487927, 0.04378979079256634], [0.0, 13.818024705010323, 0.26194700024857187, 0.05568090324715391], [0.0, 13.834172635033545, 0.2569256130138264, 0.061158311052982306], [0.0, 13.849535959958903, 0.25436224401158447, 0.06420746797884097], [0.0, 13.860744250110601, 0.2525913570433092, 0.06590588719360108], [0.0, 13.867711788089009, 0.25151262205234975, 0.0668375766465304], [0.0, 13.871733986114817, 0.2508955032988257, 0.06734327725461425], [0.0, 13.873973361073528, 0.25055343273547126, 0.06761607868967512], [0.0, 13.875197338803705, 0.25036688706166554, 0.0677627419452928], [0.0, 13.875859915629478, 0.2502660226421606, 0.06784144486160965], [0.0, 13.876216768003538, 0.250211732493456, 0.06788363639709888], [0.0, 13.876408443130256, 0.25018258138664307, 0.06790624250483906], [0.0, 13.87651124855594, 0.2501669488673397, 0.06791835129093787], [0.0, 13.876566345981914, 0.25015857157926685, 0.0679248362621579], [0.0, 13.876595862654305, 0.25015408394232963, 0.06792830905911873], [0.0, 13.87661167177033, 0.25015168043069846, 0.0679301687099057], [0.0, 13.876620138124757, 0.2501503932816618, 0.06793116451196596], [0.0, 13.876624671877417, 0.25014970401564374, 0.06793169773532448], [0.0, 13.876627099630353, 0.2501493349261018, 0.0679319832590991], [0.0, 13.876628399630105, 0.25014913728850513, 0.0679321361472543], [0.0, 13.87662909574006, 0.25014903145976664, 0.06793221801338234], [0.0, 13.876629468483618, 0.2501489747920594, 0.06793226184979129], [0.0, 13.876629668074736, 0.25014894444849306, 0.06793228532255974], [0.0, 13.876629774948656, 0.25014892820060464, 0.06793229789142347], [0.0, 13.876629832175754, 0.2501489195004494, 0.06793230462154853], [0.0, 15.461481555252204, 0.060129895109490156, 0.006755678709077506], [0.0, 15.453307083853616, 0.05746634823553219, 0.007467742855418735], [0.0, 15.45534944075031, 0.055740159015419885, 0.0078039519613209984], [0.0, 15.457524108977266, 0.05486570230964723, 0.00796728870250979], [0.0, 15.458836761671902, 0.05444030425212236, 0.008045430758150118], [0.0, 15.459518571057728, 0.05423722840439932, 0.00808246287406722], [0.0, 15.45985329946958, 0.054141115213333646, 0.008099931698229978], [0.0, 15.460013735425626, 0.05409580639713939, 0.008108154079441154], [0.0, 15.46008980828481, 0.05407448679133557, 0.008112020272800502], [0.0, 15.460125700774416, 0.05406446374264136, 0.008113837289384085], [0.0, 15.460142596432105, 0.05405975348871453, 0.008114691048182188], [0.0, 15.460150541138656, 0.054057540362881934, 0.00811509215955214], [0.0, 15.460154275023083, 0.05405650061256227, 0.008115280599446384], [0.0, 15.460156029472138, 0.054056012147188914, 0.008115369125360483], [0.0, 15.460156853747252, 0.05405578267506629, 0.008115410712971616], [0.0, 15.460157240987888, 0.05405567487424788, 0.008115430249801547], [0.0, 15.460157422907265, 0.05405562423207791, 0.00811543942765891], [0.0, 15.460157508369067, 0.05405560044168298, 0.008115443739211692], [0.0, 15.460157548516928, 0.054055589265575577, 0.008115445764679263], [0.0, 16.122507871761943, 0.018819927032358574, 0.0006590593181970972], [0.0, 16.11213798152983, 0.01915770580235107, 0.0006985834444925287], [0.0, 16.11962605663555, 0.01900372741851071, 0.0007281808327574968], [0.0, 16.121385432754227, 0.018964228538077832, 0.0007348440905952103], [0.0, 16.12184510070181, 0.01895379369878443, 0.0007365228976907723], [0.0, 16.121957952686444, 0.018951221429501508, 0.0007369332111062388], [0.0, 16.12198566533407, 0.01895058932363955, 0.0007370337904111235], [0.0, 16.121992452796302, 0.018950434471921018, 0.0007370584167665228], [0.0, 16.12199411493154, 0.018950396549627033, 0.0007370644467347143], [0.0, 16.12199452190922, 0.018950387264146246, 0.0007370659232008858], [0.0, 16.121994621557153, 0.01895038499060281, 0.0007370662847025478], [0.0, 16.230495627821142, 0.012782954573180572, 0.0001120534883439217], [0.0, 16.214438733179488, 0.0013368587471187382, 3.837765019776285e-05], [0.0, 16.19500447758436, 0.0014704909211117612, 5.986941094243692e-05], [0.0, 16.19440037856909, 0.0014432833689547592, 6.355394949447701e-05], [0.0, 16.194368784156254, 0.0014376121335690772, 6.400159707875552e-05], [0.0, 16.19436546864552, 0.0014368479832976844, 6.405788894575659e-05], [0.0, 16.194365057953753, 0.0014367498570214826, 6.406504142353331e-05], [0.0, 16.194365005830594, 0.0014367373414306966, 6.406595213420685e-05], [0.0, 16.194364999193784, 0.0014367357467395814, 6.406606814807203e-05], [0.0, 16.140882104809876, 0.0, 6.8886220319641644e-06], [0.0, 16.13802806540303, 2.0578219221550897e-05, 6.321399635134117e-06], [0.0, 16.13798539779596, 2.479552603969204e-05, 6.2932418032346504e-06], [0.0, 16.137983443571365, 2.5141296647601674e-05, 6.290984881918149e-06], [0.0, 16.1379832748805, 2.5174113435846857e-05, 6.290765189875813e-06], [0.0, 16.13798325883745, 2.5177266475481797e-05, 6.290743876646854e-06], [0.0, 16.137983257296327, 2.517756969050433e-05, 6.29074182328937e-06], [0.0, 16.13821652260594, 1.0738608481608569e-07, 4.711234929954955e-08], [0.0, 16.138217607307357, 4.302879247353175e-08, 4.38198477503704e-08], [0.0, 16.138217717118387, 6.727362472647158e-08, 4.363451183708733e-08], [0.0, 16.138217727795936, 6.955471976155536e-08, 4.36195446429366e-08], [0.0, 16.138217728824724, 6.977321317935825e-08, 4.361820599152466e-08], [0.0, 16.138216041371177, 1.379118347299979e-09, 2.669600651650228e-10], [0.0, 16.138216034120248, 8.317267707891318e-10, 2.473893312426867e-10], [0.0, 16.13821603345112, 9.65925603391149e-10, 2.4629603911918707e-10], [0.0, 16.138216033785675, 8.988253197284024e-10, 2.468414361800342e-10]], "trace_rows": 132, "trace_truncated": false, "outer_iters": 9, "mu_sequence": [5.0, 25.0, 125.0, 625.0, 3125.0, 10000.0, 10000.0, 10000.0, 10000.0], "stop": "StoppingCriterion Delta<1e-08", "inner_loops": [{"it": 0, "evals": 31, "A": 10.062, "f": 8.34498, "g": 1.56988, "h": 2.07472, "step": 0.0851662, "stop": "DeltaConverge", "bad": 0}, {"it": 1, "evals": 52, "A": 13.2625, "f": 11.8172, "g": 0.731011, "h": 0.205226, "step": 0.0803302, "stop": "DeltaConverge", "bad": 0}, {"it": 2, "evals": 77, "A": 15.4455, "f": 13.8766, "g": 0.250149, "h": 0.0679323, "step": 0.0409679, "stop": "DeltaConverge", "bad": 0}, {"it": 3, "evals": 96, "A": 16.4148, "f": 15.4602, "g": 0.0540556, "h": 0.00811545, "step": 0.0271646, "stop": "DeltaConverge", "bad": 0}, {"it": 4, "evals": 107, "A": 16.8117, "f": 16.122, "g": 0.0189504, "h": 0.000737066, "step": 0.00685509, "stop": "DeltaConverge", "bad": 0}, {"it": 5, "evals": 116, "A": 16.0626, "f": 16.1944, "g": 0.00143674, "h": 6.40661e-05, "step": 0.0241014, "stop": "DeltaConverge", "bad": 0}, {"it": 6, "evals": 123, "A": 16.1382, "f": 16.138, "g": 2.51776e-05, "h": 6.29074e-06, "step": 0.00254425, "stop": "DeltaConverge", "bad": 0}, {"it": 7, "evals": 128, "A": 16.1382, "f": 16.1382, "g": 6.97732e-08, "h": 4.36182e-08, "step": 1.64783e-05, "stop": "DeltaConverge", "bad": 0}, {"it": 8, "evals": 132, "A": 16.1382, "f": 16.1382, "g": 8.98825e-10, "h": 2.46841e-10, "step": 9.76377e-08, "stop": "DeltaConverge", "bad": 0}, {"it": 9, "evals": 132, "A": 16.1382, "f": 16.1382, "g": 8.98825e-10, "h": 2.46841e-10, "step": 0.0, "stop": "DeltaConverge", "bad": 0}], "updates": [{"it": 1, "evals": 31, "A": 20.3644, "mu": 5.0}, {"it": 2, "evals": 52, "A": 18.1604, "mu": 25.0}, {"it": 3, "evals": 77, "A": 18.9663, "mu": 125.0}, {"it": 4, "evals": 96, "A": 17.9087, "mu": 625.0}, {"it": 5, "evals": 107, "A": 18.0794, "mu": 3125.0}, {"it": 6, "evals": 116, "A": 16.386, "mu": 10000.0}, {"it": 7, "evals": 123, "A": 16.1382, "mu": 10000.0}, {"it": 8, "evals": 128, "A": 16.1382, "mu": 10000.0}, {"it": 9, "evals": 132, "A": 16.1382, "mu": 10000.0}], "phi_at_x": [-0.5855569410592322, 1.2990618157296234, -0.5553500182863133, 1.1163226549509129, -0.5251430955130368, 0.9335834941693127, -0.4949361727385986, 0.7508443333799573, -0.4647292499619807, 0.5681051725763916, -0.4345223271818524, 0.38536601175156565, -0.40431540439664, 0.20262685089839902, -0.37410848160456084, 0.019887690010457062, -0.3439015588036687, -0.16285147091710614, -0.3136946359917889, -0.3455906318871703, -0.2834877131665977, -0.5283297928997752, -0.25328079032560025, -0.7110689539512863, -0.22307386746601787, -0.8938081150340179, 0.02738007819960025, -0.8401158018526601, 0.2685438738394129, -0.6855128707185072, 0.5097076695032836, -0.5309099395747421, 0.7508714651873771, -0.37630700841798825, 0.9920352608861313, -0.22170407724963606, 1.23319905659346, -0.0671011460734589, 1.4743628523040855, 0.08750178510597534, -1.72831748912472e-10, 2.6614266346314253e-11, 3.9046543776066756e-11, -8.348877145181177e-12, -1.5340502174015467, -0.444926178456923, -1.550110053513014, -0.43612940842897135, -1.576633738216226, -0.421950748352948, -1.6162529566407091, -0.4025073367745608, -1.6718601046460022, -0.37815843401668137, -1.746192138452345, -0.3491717233627192, -1.8414557392573472, -0.3153319199109741, -1.9590533585582577, -0.2755086634814278, -2.0994510907725483, -0.22721159980065098, -2.2621912114673326, -0.16616492643263153, -2.4460150659424507, -0.08593416493980814, -2.649043852314421, 8.988253197284024e-10, -2.868968954190846, -3.918839558414433e-10, -3.093653944782015, -0.1184800383364832, -3.3106698893033104, -0.310672990785193, -3.5075718409613543, -0.5225947911429423, -3.672270950981305, -0.7173541007630169, -3.7931614241166667, -0.8682722728938554, -3.859062991147705, -0.9533296379233969, -3.859062991146924, -0.9533296379224498], "residuals_at_x": {"cost": 16.138216033785678, "max_goal_rad": 1.72831748912472e-11, "max_rest_rad_per_normalized_time": 3.9046543776066756e-12, "knot_deficit_mm_link1": 0.0, "knot_deficit_mm_link2": 8.988253197284024e-08, "max_knot_deficit_mm": 8.988253197284024e-08, "margin_mm": 5.0, "T": 20, "validation": {"valid": false, "fail": {"edge": 11, "j": 4, "n": 4, "q": [0.10954314468153062, 1.3339438933155252], "part": "link 2", "c": -8.988253457492545e-11}, "evaluated": 59, "scheduled": 62, "deepest": {"c": -0.0018436361921079182, "edge": 12, "j": 2, "n": 4, "q": [0.08016065100633339, 1.348669234211258], "part": "link 2"}, "length_deg": 58.36722182513032}, "deepest_clearance_m": -0.0018436361921079182, "between_knot_deficit_mm": 1.843636192107918}, "residuals_at_buffered": null, "upstream": "ccc36b55", "rows_at_x": "staged_two_link rows (sos, eq, ineq) with the eq and ineq rows times the constraint scale"}, "W-auglag-tight-line-s10|komo": {"case": "W-auglag-tight-line-s10", "model": "W", "method": "AugmentedLag", "opts": "tight", "start": "line", "options_passed": {"method": "AugmentedLag", "stopTolerance": 1e-08, "stopFTolerance": 1e-12, "stopEvals": 5000}, "options_effective": {"verbose": 3, "stopTolerance": 1e-08, "stopFTolerance": 1e-12, "stopGTolerance": -1.0, "stopEvals": 5000, "stopInners": 1000, "stopOuters": 1000, "stepMax": 0.2, "damping": 1.0, "stepInc": 1.5, "stepDec": 0.5, "wolfe": 0.01, "muInit": 1.0, "muInc": 5.0, "muMax": 10000.0, "muLBInit": 0.1, "muLBDec": 0.2, "lambdaMax": -1.0, "method": "AugmentedLag"}, "constraint_scale": 10.0, "T": 20, "k": 2, "margin_mm": 5.0, "disc": true, "rrt_seed": null, "seed": null, "parent": null, "call": "setInitialization + solve(0)", "program": "komo", "nominal_x": [0.4873681860972264, 0.8162956676063362, 0.45113759659615393, 0.8471931718152241, 0.4149070070950815, 0.8780906760241122, 0.37867641759400905, 0.9089881802330001, 0.34244582809293656, 0.939885684441888, 0.30621523859186417, 0.970783188650776, 0.26998464909079173, 1.001680692859664, 0.23375405958971923, 1.032578197068552, 0.1975234700886468, 1.0634757012774398, 0.16129288058757435, 1.0943732054863278, 0.12506229108650185, 1.1252707096952157, 0.08883170158542947, 1.1561682139041036, 0.05260111208435697, 1.1870657181129916, 0.01637052258328464, 1.2179632223218795, -0.019860066917787855, 1.2488607265307676, -0.05609065641886035, 1.2797582307396556, -0.09232124591993274, 1.3106557349485435, -0.12855183542100523, 1.3415532391574314, -0.16478242492207762, 1.3724507433663193, -0.20101301442315012, 1.4033482475752073], "x_start": [0.4873681860972264, 0.8162956676063362, 0.45113759659615393, 0.8471931718152241, 0.4149070070950815, 0.8780906760241122, 0.37867641759400905, 0.9089881802330001, 0.34244582809293656, 0.939885684441888, 0.30621523859186417, 0.970783188650776, 0.26998464909079173, 1.001680692859664, 0.23375405958971923, 1.032578197068552, 0.1975234700886468, 1.0634757012774398, 0.16129288058757435, 1.0943732054863278, 0.12506229108650185, 1.1252707096952157, 0.08883170158542947, 1.1561682139041036, 0.05260111208435697, 1.1870657181129916, 0.01637052258328464, 1.2179632223218795, -0.019860066917787855, 1.2488607265307676, -0.05609065641886035, 1.2797582307396556, -0.09232124591993274, 1.3106557349485435, -0.12855183542100523, 1.3415532391574314, -0.16478242492207762, 1.3724507433663193, -0.20101301442315012, 1.4033482475752073], "ret": {"evals": 132, "sos": 16.138216033785675, "ineq": 8.988259442288538e-10, "eq": 2.468361626206672e-10, "f": 0.0, "feasible": true, "done": true, "time": 0.023572999999999844}, "x": [0.5170520499737723, 0.7999221160321771, 0.5042963223882762, 0.8269269353733723, 0.485669316505371, 0.8643695354927393, 0.46150875598863034, 0.9102068304618968, 0.43215236450165234, 0.9623957343523046, 0.39793786570807416, 1.018893161235185, 0.35920298327159, 1.0776560251814429, 0.3162854408559706, 1.136641240261595, 0.2695229621250856, 1.1938057205457149, 0.2192532707429271, 1.2471063801034004, 0.16581409037363617, 1.2945001330037746, 0.1095431446815307, 1.333943893315525, 0.05077815733113625, 1.3633945751069907, -0.007680711438840382, 1.3834524766888845, -0.06313716842458675, 1.3958461113788905, -0.11289492042202143, 1.4023039924947995, -0.15425767422683684, 1.4045546333545473, -0.18452913663456166, 1.4043265472761999, -0.20101301444062852, 1.4033482475779104, -0.20101301444043332, 1.4033482475778687], "x_end": [0.5170520499737723, 0.7999221160321771, 0.5042963223882762, 0.8269269353733723, 0.485669316505371, 0.8643695354927393, 0.46150875598863034, 0.9102068304618968, 0.43215236450165234, 0.9623957343523046, 0.39793786570807416, 1.018893161235185, 0.35920298327159, 1.0776560251814429, 0.3162854408559706, 1.136641240261595, 0.2695229621250856, 1.1938057205457149, 0.2192532707429271, 1.2471063801034004, 0.16581409037363617, 1.2945001330037746, 0.1095431446815307, 1.333943893315525, 0.05077815733113625, 1.3633945751069907, -0.007680711438840382, 1.3834524766888845, -0.06313716842458675, 1.3958461113788905, -0.11289492042202143, 1.4023039924947995, -0.15425767422683684, 1.4045546333545473, -0.18452913663456166, 1.4043265472761999, -0.20101301444062852, 1.4033482475779104, -0.20101301444043332, 1.4033482475778687], "buffered_x": [0.5170520499737723, 0.7999221160321771, 0.5042963223882762, 0.8269269353733723, 0.485669316505371, 0.8643695354927393, 0.46150875598863034, 0.9102068304618968, 0.43215236450165234, 0.9623957343523046, 0.39793786570807416, 1.018893161235185, 0.35920298327159, 1.0776560251814429, 0.3162854408559706, 1.136641240261595, 0.2695229621250856, 1.1938057205457149, 0.2192532707429271, 1.2471063801034004, 0.16581409037363617, 1.2945001330037746, 0.1095431446815307, 1.333943893315525, 0.05077815733113625, 1.3633945751069907, -0.007680711438840382, 1.3834524766888845, -0.06313716842458675, 1.3958461113788905, -0.11289492042202143, 1.4023039924947995, -0.15425767422683684, 1.4045546333545473, -0.18452913663456166, 1.4043265472761999, -0.20101301444062852, 1.4033482475779104, -0.20101301444043332, 1.4033482475778687], "komo_path": [0.5170520499737723, 0.7999221160321771, 0.5042963223882762, 0.8269269353733723, 0.485669316505371, 0.8643695354927393, 0.46150875598863034, 0.9102068304618968, 0.43215236450165234, 0.9623957343523046, 0.39793786570807416, 1.018893161235185, 0.35920298327159, 1.0776560251814429, 0.3162854408559706, 1.136641240261595, 0.2695229621250856, 1.1938057205457149, 0.2192532707429271, 1.2471063801034004, 0.16581409037363617, 1.2945001330037746, 0.1095431446815307, 1.333943893315525, 0.05077815733113625, 1.3633945751069907, -0.007680711438840382, 1.3834524766888845, -0.06313716842458675, 1.3958461113788905, -0.11289492042202143, 1.4023039924947995, -0.15425767422683684, 1.4045546333545473, -0.18452913663456166, 1.4043265472761999, -0.20101301444062852, 1.4033482475779104, -0.20101301444043332, 1.4033482475778687], "dual": [0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 4.314069127365445, 2.765621309098405, -1.534413680961355, -0.21654504116499496, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 14.695498195410218, 8.7135938192439, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0], "trace_errs": [[0.0, 18.13849105546762, 2.585699416762349, 13.425618741992086], [0.0, 8.436014897270322, 1.7836844885043095, 1.9746113903528117], [0.0, 8.392847281261668, 1.745883128755554, 2.0122767645653914], [0.0, 8.39244450622191, 1.7183027278741214, 2.015951817611249], [0.0, 8.388954204344211, 1.6908307025893172, 2.0224644151179128], [0.0, 8.38187915847512, 1.6632664914666664, 2.031961123408709], [0.0, 8.373102268200947, 1.6373932503448927, 2.0426363873951465], [0.0, 8.364633722672131, 1.6157385692004496, 2.0524913140813523], [0.0, 8.35783619678442, 1.5995549959383588, 2.060233812679337], [0.0, 8.35303560052151, 1.588455290992274, 2.065651360248762], [0.0, 8.349902396913988, 1.5812627817287053, 2.0691768856425807], [0.0, 8.347946059853898, 1.576764186187922, 2.071377750221381], [0.0, 8.346753215896127, 1.5740104815504055, 2.072720567423462], [0.0, 8.34603502638178, 1.5723465992922225, 2.0735296398020786], [0.0, 8.34560555323426, 1.5713490058076367, 2.074013734581304], [0.0, 8.345349694440053, 1.5707536566496305, 2.074302246185251], [0.0, 8.345197589329736, 1.5703993396236653, 2.0744738057945558], [0.0, 8.345107274542707, 1.5701888161391584, 2.074575687767919], [0.0, 8.345053686603237, 1.5700638516635261, 2.0746361447539265], [0.0, 8.345021903548137, 1.5699897168954937, 2.074672003882719], [0.0, 8.345003057574973, 1.569945751737433, 2.0746932675131573], [0.0, 8.344991884334274, 1.5699196837680918, 2.0747058743692395], [0.0, 8.344985260600135, 1.569904229319713, 2.0747133480710036], [0.0, 8.344981334107237, 1.5698950677722447, 2.0747177784490907], [0.0, 8.344979006585028, 1.5698896369473376, 2.074720404672407], [0.0, 8.344977626915085, 1.5698864177182703, 2.074721961405353], [0.0, 8.34497680910581, 1.569884509484809, 2.074722884171374], [0.0, 8.344976324346476, 1.5698833783683832, 2.0747234311446676], [0.0, 8.34497603700472, 1.5698827078960746, 2.0747237553640128], [0.0, 8.344975866682894, 1.5698823104730408, 2.0747239475450763], [0.0, 8.344975765724739, 1.5698820749006266, 2.0747240614603104], [0.0, 11.753160117172747, 0.7540859119228738, 0.19174341956278151], [0.0, 11.816601906742466, 0.7303603980032508, 0.20654629407207414], [0.0, 11.81963336206799, 0.7294761684804897, 0.20668677078152065], [0.0, 11.81878111569493, 0.729981899202046, 0.2060966498020475], [0.0, 11.818102215672344, 0.7303427729728487, 0.20571621137503243], [0.0, 11.817707411486511, 0.7305501003315114, 0.20549993647760334], [0.0, 11.817485735977435, 0.7307344093403154, 0.20537887458618953], [0.0, 11.817361828181507, 0.7308564694195316, 0.2053112347032468], [0.0, 11.817292601306994, 0.7309246536284695, 0.2052734467794637], [0.0, 11.817253923693563, 0.7309627466163096, 0.20525233453979275], [0.0, 11.817232313099172, 0.7309840299987275, 0.2052405383759623], [0.0, 11.817220238061816, 0.730995922036481, 0.20523394720672744], [0.0, 11.817213490935966, 0.7310025668562967, 0.20523026428271973], [0.0, 11.817209720826474, 0.7310062797837817, 0.20522820636552225], [0.0, 11.817207614179255, 0.7310083544740169, 0.20522705645054984], [0.0, 11.817206437030926, 0.7310095137638821, 0.20522641390319674], [0.0, 11.817205779264965, 0.7310101615504143, 0.20522605486114898], [0.0, 11.817205411718653, 0.7310105235202774, 0.2052258542357413], [0.0, 11.817205206341104, 0.7310107257817914, 0.20522574213026057], [0.0, 11.817205091580153, 0.7310108388015237, 0.20522567948788817], [0.0, 11.817205027453978, 0.7310109019547378, 0.2052256444845521], [0.0, 13.756110191291867, 0.29938360779484585, 0.04378979079257078], [0.0, 13.818024705010322, 0.2619470002485714, 0.05568090324715419], [0.0, 13.834172635033534, 0.25692561301382977, 0.06115831105298397], [0.0, 13.849535959958923, 0.25436224401158203, 0.06420746797888371], [0.0, 13.860744250110601, 0.2525913570433106, 0.06590588719360163], [0.0, 13.867711788089013, 0.25151262205235225, 0.06683757664653067], [0.0, 13.871733986114824, 0.2508955032988227, 0.06734327725461453], [0.0, 13.873973361073531, 0.2505534327354728, 0.06761607868966957], [0.0, 13.87519733880371, 0.25036688706166643, 0.0677627419452928], [0.0, 13.875859915629473, 0.2502660226421575, 0.06784144486160965], [0.0, 13.87621676800354, 0.25021173249345763, 0.0678836363970986], [0.0, 13.876408443130263, 0.25018258138664035, 0.06790624250484434], [0.0, 13.876511248555945, 0.25016694886734037, 0.06791835129093787], [0.0, 13.876566345981916, 0.2501585715792649, 0.0679248362621579], [0.0, 13.876595862654316, 0.25015408394232935, 0.0679283090591612], [0.0, 13.87661167177033, 0.2501516804306985, 0.06793016870991125], [0.0, 13.876620138124773, 0.25015039328166033, 0.06793116451205256], [0.0, 13.876624671877426, 0.2501497040156433, 0.06793169773532448], [0.0, 13.87662709963035, 0.2501493349261027, 0.06793198325910466], [0.0, 13.876628399630114, 0.25014913728850563, 0.0679321361472543], [0.0, 13.876629095740062, 0.25014903145976697, 0.06793221801338761], [0.0, 13.87662946848361, 0.2501489747920599, 0.06793226184979656], [0.0, 13.876629668074747, 0.25014894444849195, 0.06793228532256529], [0.0, 13.87662977494866, 0.2501489282006053, 0.06793229789142902], [0.0, 13.876629832175757, 0.2501489195004484, 0.06793230462155381], [0.0, 15.46148155525232, 0.06012989510948488, 0.006755678709112756], [0.0, 15.453307083853632, 0.05746634823553261, 0.007467742855413184], [0.0, 15.455349440750286, 0.05574015901542155, 0.007803951961363187], [0.0, 15.457524108977276, 0.05486570230964577, 0.00796728870250979], [0.0, 15.458836761671888, 0.0544403042521243, 0.008045430758150118], [0.0, 15.459518571057732, 0.054237228404398555, 0.008082462874061946], [0.0, 15.45985329946957, 0.0541411152133351, 0.008099931698229978], [0.0, 15.460013735425619, 0.05409580639713758, 0.008108154079441154], [0.0, 15.46008980828481, 0.054074486791335294, 0.008112020272806053], [0.0, 15.460125700774414, 0.05406446374264316, 0.008113837289384085], [0.0, 15.46014259643211, 0.05405975348871418, 0.008114691048182188], [0.0, 15.460150541138686, 0.05405754036288041, 0.00811509215955214], [0.0, 15.460154275023095, 0.054056500612563105, 0.008115280599446384], [0.0, 15.46015602947213, 0.05405601214718926, 0.008115369125360483], [0.0, 15.46015685374727, 0.05405578267506567, 0.008115410712971616], [0.0, 15.460157240987888, 0.054055674874247325, 0.008115430249801547], [0.0, 15.460157422907265, 0.05405562423207763, 0.00811543942765891], [0.0, 15.460157508369052, 0.054055600441683185, 0.008115443739211692], [0.0, 15.460157548516923, 0.05405558926557599, 0.008115445764679263], [0.0, 16.12250787176194, 0.01881992703235913, 0.0006590593182392857], [0.0, 16.11213798152981, 0.019157705802351627, 0.0006985834444925287], [0.0, 16.119626056635564, 0.01900372741851085, 0.0007281808327574968], [0.0, 16.12138543275425, 0.018964228538076097, 0.0007348440905952103], [0.0, 16.12184510070178, 0.018953793698784846, 0.0007365228976907723], [0.0, 16.121957952686454, 0.018951221429502063, 0.0007369332111062388], [0.0, 16.121985665334098, 0.01895058932363823, 0.0007370337904111235], [0.0, 16.121992452796306, 0.018950434471920463, 0.0007370584167665228], [0.0, 16.121994114931532, 0.018950396549626616, 0.0007370644467347143], [0.0, 16.121994521909244, 0.018950387264145552, 0.0007370659232008858], [0.0, 16.121994621557157, 0.01895038499060267, 0.0007370662847025478], [0.0, 16.23049562782114, 0.012782954573188204, 0.0001120534883439217], [0.0, 16.214438733179506, 0.00133685874711853, 3.837765019776285e-05], [0.0, 16.195004477584376, 0.0014704909211114836, 5.98694109368858e-05], [0.0, 16.194400378569114, 0.0014432833689551061, 6.355394949447701e-05], [0.0, 16.19436878415628, 0.0014376121335692854, 6.400159707875552e-05], [0.0, 16.19436546864553, 0.001436847983298517, 6.405788894575659e-05], [0.0, 16.19436505795375, 0.0014367498570212744, 6.406504142353331e-05], [0.0, 16.1943650058306, 0.001436737341430419, 6.406595213420685e-05], [0.0, 16.194364999193823, 0.0014367357467390263, 6.406606815334559e-05], [0.0, 16.140882104809883, 0.0, 6.8886220319641644e-06], [0.0, 16.13802806540302, 2.0578219223146843e-05, 6.321399629860558e-06], [0.0, 16.13798539779596, 2.479552603976143e-05, 6.2932418032346504e-06], [0.0, 16.137983443571372, 2.5141296648156786e-05, 6.290984881918149e-06], [0.0, 16.137983274880494, 2.5174113436679524e-05, 6.290765184602254e-06], [0.0, 16.137983258837423, 2.5177266476175686e-05, 6.290743871373294e-06], [0.0, 16.137983257296323, 2.5177569689602275e-05, 6.29074181801581e-06], [0.0, 16.13821652260592, 1.073860873140875e-07, 4.711234402599018e-08], [0.0, 16.138217607307364, 4.302879171025342e-08, 4.381984247681103e-08], [0.0, 16.138217717118373, 6.727362500402734e-08, 4.3634506563527964e-08], [0.0, 16.13821772779594, 6.955471976155536e-08, 4.3619539369377236e-08], [0.0, 16.138217728824735, 6.977321262424674e-08, 4.3618200717965294e-08], [0.0, 16.1382160413712, 1.3791172370769544e-09, 2.669600651650228e-10], [0.0, 16.13821603412024, 8.317273952895832e-10, 2.473840576833197e-10], [0.0, 16.138216033451126, 9.659249788906976e-10, 2.4629603911918707e-10], [0.0, 16.138216033785675, 8.988259442288538e-10, 2.468361626206672e-10]], "trace_rows": 132, "trace_truncated": false, "outer_iters": 9, "mu_sequence": [5.0, 25.0, 125.0, 625.0, 3125.0, 10000.0, 10000.0, 10000.0, 10000.0], "stop": "StoppingCriterion Delta<1e-08", "inner_loops": [{"it": 0, "evals": 31, "A": 10.062, "f": 8.34498, "g": 1.56988, "h": 2.07472, "step": 0.0851662, "stop": "DeltaConverge", "bad": 0}, {"it": 1, "evals": 52, "A": 13.2625, "f": 11.8172, "g": 0.731011, "h": 0.205226, "step": 0.0803302, "stop": "DeltaConverge", "bad": 0}, {"it": 2, "evals": 77, "A": 15.4455, "f": 13.8766, "g": 0.250149, "h": 0.0679323, "step": 0.0409679, "stop": "DeltaConverge", "bad": 0}, {"it": 3, "evals": 96, "A": 16.4148, "f": 15.4602, "g": 0.0540556, "h": 0.00811545, "step": 0.0271646, "stop": "DeltaConverge", "bad": 0}, {"it": 4, "evals": 107, "A": 16.8117, "f": 16.122, "g": 0.0189504, "h": 0.000737066, "step": 0.00685509, "stop": "DeltaConverge", "bad": 0}, {"it": 5, "evals": 116, "A": 16.0626, "f": 16.1944, "g": 0.00143674, "h": 6.40661e-05, "step": 0.0241014, "stop": "DeltaConverge", "bad": 0}, {"it": 6, "evals": 123, "A": 16.1382, "f": 16.138, "g": 2.51776e-05, "h": 6.29074e-06, "step": 0.00254425, "stop": "DeltaConverge", "bad": 0}, {"it": 7, "evals": 128, "A": 16.1382, "f": 16.1382, "g": 6.97732e-08, "h": 4.36182e-08, "step": 1.64783e-05, "stop": "DeltaConverge", "bad": 0}, {"it": 8, "evals": 132, "A": 16.1382, "f": 16.1382, "g": 8.98826e-10, "h": 2.46836e-10, "step": 9.76377e-08, "stop": "DeltaConverge", "bad": 0}, {"it": 9, "evals": 132, "A": 16.1382, "f": 16.1382, "g": 8.98826e-10, "h": 2.46836e-10, "step": 0.0, "stop": "DeltaConverge", "bad": 0}], "updates": [{"it": 1, "evals": 31, "A": 20.3644, "mu": 5.0}, {"it": 2, "evals": 52, "A": 18.1604, "mu": 25.0}, {"it": 3, "evals": 77, "A": 18.9663, "mu": 125.0}, {"it": 4, "evals": 96, "A": 17.9087, "mu": 625.0}, {"it": 5, "evals": 107, "A": 18.0794, "mu": 3125.0}, {"it": 6, "evals": 116, "A": 16.386, "mu": 10000.0}, {"it": 7, "evals": 123, "A": 16.1382, "mu": 10000.0}, {"it": 8, "evals": 128, "A": 16.1382, "mu": 10000.0}, {"it": 9, "evals": 132, "A": 16.1382, "mu": 10000.0}], "phi_at_x": [-0.585556941059242, 1.2990618157296332, -0.5553500182863033, 1.1163226549509029, -0.5251430955130318, 0.9335834941693227, -0.4949361727386035, 0.7508443333799473, -0.4647292499619757, 0.5681051725764016, -0.4345223271818574, 0.38536601175156565, -0.404315404396635, 0.20262685089837915, -0.3741084816045708, 0.01988769001047692, -0.3439015588036588, -0.16285147091710614, -0.3136946359917889, -0.3455906318871902, -0.28348771316660515, -0.5283297928997553, -0.25328079032559775, -0.7110689539513062, -0.2230738674660185, -0.8938081150339782, 0.02738007819959963, -0.8401158018526997, 0.2685438738394117, -0.6855128707184874, 0.5097076695032824, -0.5309099395747222, 0.7508714651873821, -0.3763070084180081, 0.9920352608861263, -0.22170407724963606, 1.2331990565934625, -0.0671011460734589, 1.474362852304083, 0.08750178510597534, -1.7283202646822815e-10, 2.6614266346314253e-11, 3.904099266094363e-11, -8.348877145181177e-12, -1.5340502174015467, -0.44492617845692256, -1.550110053513014, -0.4361294084289708, -1.5766337382162265, -0.42195074835294855, -1.6162529566407091, -0.4025073367745615, -1.6718601046460022, -0.3781584340166819, -1.746192138452345, -0.34917172336271973, -1.8414557392573472, -0.31533191991097465, -1.9590533585582577, -0.2755086634814289, -2.099451090772548, -0.2272115998006522, -2.2621912114673326, -0.16616492643263153, -2.4460150659424507, -0.08593416493980884, -2.649043852314421, 8.988258748399147e-10, -2.8689689541908447, -3.918840946193214e-10, -3.093653944782015, -0.11848003833648292, -3.3106698893033104, -0.3106729907851929, -3.5075718409613543, -0.5225947911429423, -3.672270950981305, -0.7173541007630169, -3.7931614241166667, -0.8682722728938554, -3.859062991147705, -0.9533296379233969, -3.859062991146924, -0.9533296379224498], "residuals_at_x": {"cost": 16.138216033785667, "max_goal_rad": 1.7283202646822815e-11, "max_rest_rad_per_normalized_time": 3.904099266094363e-12, "knot_deficit_mm_link1": 0.0, "knot_deficit_mm_link2": 8.988258748399147e-08, "max_knot_deficit_mm": 8.988258748399147e-08, "margin_mm": 5.0, "T": 20, "validation": {"valid": false, "fail": {"edge": 11, "j": 4, "n": 4, "q": [0.1095431446815307, 1.333943893315525], "part": "link 2", "c": -8.988259008607669e-11}, "evaluated": 59, "scheduled": 62, "deepest": {"c": -0.0018436361921079182, "edge": 12, "j": 2, "n": 4, "q": [0.08016065100633347, 1.3486692342112578], "part": "link 2"}, "length_deg": 58.36722182513032}, "deepest_clearance_m": -0.0018436361921079182, "between_knot_deficit_mm": 1.843636192107918}, "residuals_at_buffered": null, "upstream": "ccc36b55", "rows_at_x": "staged_two_link rows (sos, eq, ineq) with the eq and ineq rows times the constraint scale"}, "W-auglag-tight-shortcut-s10|twin": {"case": "W-auglag-tight-shortcut-s10", "model": "W", "method": "AugmentedLag", "opts": "tight", "start": "shortcut", "options_passed": {"method": "AugmentedLag", "stopTolerance": 1e-08, "stopFTolerance": 1e-12, "stopEvals": 5000}, "options_effective": {"verbose": 3, "stopTolerance": 1e-08, "stopFTolerance": 1e-12, "stopGTolerance": -1.0, "stopEvals": 5000, "stopInners": 1000, "stopOuters": 1000, "stepMax": 0.2, "damping": 1.0, "stepInc": 1.5, "stepDec": 0.5, "wolfe": 0.01, "muInit": 1.0, "muInc": 5.0, "muMax": 10000.0, "muLBInit": 0.1, "muLBDec": 0.2, "lambdaMax": -1.0, "method": "AugmentedLag"}, "constraint_scale": 10.0, "T": 20, "k": 2, "margin_mm": 5.0, "disc": true, "rrt_seed": 7, "seed": null, "parent": null, "call": "setInitialization + solve(0)", "program": "twin", "nominal_x": [0.49398606716432986, 0.8266891056465161, 0.4651307531914821, 0.8686379377820006, 0.43646619528099456, 0.9107177430320252, 0.40629608953866575, 0.9517175111402572, 0.3756213981598166, 0.9923553038816949, 0.3449467067809674, 1.0329930966231327, 0.31427201540211824, 1.0736308893645705, 0.28353502034984757, 1.1142212417721706, 0.25252049165525425, 1.1546002697438285, 0.22150596296066088, 1.1949792977154865, 0.19049143426606754, 1.2353583256871445, 0.15947690557147426, 1.2757373536588026, 0.12846237687688095, 1.3161163816304606, 0.09541889381659188, 1.3535564034501737, 0.0459166748668753, 1.3651620901581103, -0.004222505602962695, 1.37401813170593, -0.0543616860728008, 1.3828741732537493, -0.1045008665426388, 1.3917302148015689, -0.1546400470124769, 1.4005862563493883, -0.20101301442315012, 1.4033482475752073], "x_start": [0.49398606716432986, 0.8266891056465161, 0.4651307531914821, 0.8686379377820006, 0.43646619528099456, 0.9107177430320252, 0.40629608953866575, 0.9517175111402572, 0.3756213981598166, 0.9923553038816949, 0.3449467067809674, 1.0329930966231327, 0.31427201540211824, 1.0736308893645705, 0.28353502034984757, 1.1142212417721706, 0.25252049165525425, 1.1546002697438285, 0.22150596296066088, 1.1949792977154865, 0.19049143426606754, 1.2353583256871445, 0.15947690557147426, 1.2757373536588026, 0.12846237687688095, 1.3161163816304606, 0.09541889381659188, 1.3535564034501737, 0.0459166748668753, 1.3651620901581103, -0.004222505602962695, 1.37401813170593, -0.0543616860728008, 1.3828741732537493, -0.1045008665426388, 1.3917302148015689, -0.1546400470124769, 1.4005862563493883, -0.20101301442315012, 1.4033482475752073], "ret": {"evals": 131, "sos": 16.138216033451087, "ineq": 9.659267830031126e-10, "eq": 2.4629048800406395e-10, "f": 0.0, "feasible": true, "done": true, "time": 0.09699599999999986}, "x": [0.5170520499721558, 0.7999221160776169, 0.5042963223828014, 0.8269269354979576, 0.48566931649316764, 0.8643695357184681, 0.46150875596618707, 0.9102068307991305, 0.4321523644647939, 0.9623957347998987, 0.39793786565192496, 1.0188931617806847, 0.3592029831905219, 1.077656025801344, 0.3162854407435332, 1.1366412409216644, 0.2695229619739177, 1.1938057212013564, 0.21925327054464805, 1.2471063807000473, 0.1658140901187159, 1.294500133477283, 0.10954314435913773, 1.3339438935925345, 0.05077815692896182, 1.363394575105214, -0.007680711841056259, 1.3834524765376839, -0.06313716876959131, 1.3958461111779457, -0.11289492067526788, 1.4023039923140193, -0.15425767437666732, 1.4045546332339498, -0.18452913669233942, 1.404326547225805, -0.20101301444081515, 1.4033482475776682, -0.20101301444061834, 1.403348247577628], "x_end": [0.5170520499721558, 0.7999221160776169, 0.5042963223828014, 0.8269269354979576, 0.48566931649316764, 0.8643695357184681, 0.46150875596618707, 0.9102068307991305, 0.4321523644647939, 0.9623957347998987, 0.39793786565192496, 1.0188931617806847, 0.3592029831905219, 1.077656025801344, 0.3162854407435332, 1.1366412409216644, 0.2695229619739177, 1.1938057212013564, 0.21925327054464805, 1.2471063807000473, 0.1658140901187159, 1.294500133477283, 0.10954314435913773, 1.3339438935925345, 0.05077815692896182, 1.363394575105214, -0.007680711841056259, 1.3834524765376839, -0.06313716876959131, 1.3958461111779457, -0.11289492067526788, 1.4023039923140193, -0.15425767437666732, 1.4045546332339498, -0.18452913669233942, 1.404326547225805, -0.20101301444081515, 1.4033482475776682, -0.20101301444061834, 1.403348247577628], "buffered_x": [0.5170520499721558, 0.7999221160776169, 0.5042963223828014, 0.8269269354979576, 0.48566931649316764, 0.8643695357184681, 0.46150875596618707, 0.9102068307991305, 0.4321523644647939, 0.9623957347998987, 0.39793786565192496, 1.0188931617806847, 0.3592029831905219, 1.077656025801344, 0.3162854407435332, 1.1366412409216644, 0.2695229619739177, 1.1938057212013564, 0.21925327054464805, 1.2471063807000473, 0.1658140901187159, 1.294500133477283, 0.10954314435913773, 1.3339438935925345, 0.05077815692896182, 1.363394575105214, -0.007680711841056259, 1.3834524765376839, -0.06313716876959131, 1.3958461111779457, -0.11289492067526788, 1.4023039923140193, -0.15425767437666732, 1.4045546332339498, -0.18452913669233942, 1.404326547225805, -0.20101301444081515, 1.4033482475776682, -0.20101301444061834, 1.403348247577628], "komo_path": null, "dual": [0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 4.314069090362684, 2.7656212609552266, -1.5344136744369186, -0.21654503495529553, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 14.695499537410804, 0.0, 8.713592358809523, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0], "trace_errs": [[0.0, 28.777650974914156, 0.0, 9.82699172729844], [0.0, 8.248327840456819, 1.921874799253918, 2.0944484601573383], [0.0, 8.379907015044289, 1.759008091036607, 2.0195409423907265], [0.0, 8.391900857941991, 1.7242509432113182, 2.0155706282670005], [0.0, 8.389991007254004, 1.6966236549370404, 2.0208376162111605], [0.0, 8.383566444454464, 1.6689854036248928, 2.029809603069694], [0.0, 8.374977331435353, 1.642536652400952, 2.0404070396504324], [0.0, 8.366298112020017, 1.6198335185409816, 2.0505766003936503], [0.0, 8.359091384273935, 1.6024914497518363, 2.058811789916209], [0.0, 8.353886789170685, 1.590412706034969, 2.064692649480354], [0.0, 8.350445035391267, 1.5825084294298235, 2.068566507552071], [0.0, 8.348280582819532, 1.5775346774604224, 2.071001327459146], [0.0, 8.346955806425301, 1.5744789587459787, 2.0724924297962506], [0.0, 8.34615655905057, 1.572628528635678, 2.0733926898048844], [0.0, 8.345678084087021, 1.5715176313602068, 2.073931963027489], [0.0, 8.34539285635458, 1.5708541453452771, 2.0742535697105167], [0.0, 8.34522323217487, 1.5704590935258433, 2.0744448808738642], [0.0, 8.34512249474093, 1.5702243019185285, 2.0745585173827585], [0.0, 8.345062715495297, 1.5700849092963993, 2.074625958213307], [0.0, 8.345027257910822, 1.5700022070357762, 2.074665962733491], [0.0, 8.345006232241648, 1.5699531581518555, 2.0746896855462746], [0.0, 8.344993766420274, 1.5699240749283874, 2.074703750783353], [0.0, 8.344986376311402, 1.5699068325310408, 2.074712089185268], [0.0, 8.34498199548106, 1.5698966109471952, 2.0747170321997905], [0.0, 8.3449793986265, 1.5698905517058228, 2.0747199623179524], [0.0, 8.344977859301629, 1.5698869599552845, 2.0747216991947606], [0.0, 8.344976946854171, 1.5698848309002889, 2.074722728744464], [0.0, 8.34497640599715, 1.5698835688887458, 2.074723339014929], [0.0, 8.344976085403246, 1.5698828208273503, 2.074723700753963], [0.0, 8.34497589537108, 1.5698823774130861, 2.0747239151750256], [0.0, 8.344975782729648, 1.5698821145793023, 2.074724042272958], [0.0, 11.753160089605581, 0.7540859211810741, 0.19174341414735452], [0.0, 11.816601893677033, 0.730360400108321, 0.20654629599013846], [0.0, 11.819633356896922, 0.7294761664325862, 0.2066867770021641], [0.0, 11.818781114954621, 0.7299818948398726, 0.20609665843893954], [0.0, 11.818102217408924, 0.7303427673241512, 0.2057162213610242], [0.0, 11.8177074146077, 0.7305500939656944, 0.20549994721747372], [0.0, 11.81748573987337, 0.730734397869626, 0.20537888574794522], [0.0, 11.817361832511228, 0.7308564575248323, 0.2053112461011855], [0.0, 11.817292605879677, 0.730924641496309, 0.20527345830969768], [0.0, 11.817253928402382, 0.7309627343511194, 0.20525234614418908], [0.0, 11.81723231788426, 0.7309840176590026, 0.2052405500218632], [0.0, 11.817220242889626, 0.7309959096549918, 0.2052339588758631], [0.0, 11.81721349578774, 0.7310025544514057, 0.20523027596492827], [0.0, 11.817209725691649, 0.7310062673657749, 0.2052282180550069], [0.0, 11.817207619051944, 0.7310083420486626, 0.20522706814410735], [0.0, 11.817206441907848, 0.7310095013344047, 0.20522642559907572], [0.0, 11.817205784144267, 0.7310101491186312, 0.205226066558358], [0.0, 11.817205416599268, 0.7310105110872005, 0.20522586593360342], [0.0, 11.817205211222438, 0.7310107133479887, 0.2052257538285196], [0.0, 11.817205096461906, 0.7310108263673198, 0.20522569118641226], [0.0, 11.81720503233599, 0.7310108895203021, 0.20522565618324495], [0.0, 13.756110187781792, 0.29938360527458585, 0.04378979100860103], [0.0, 13.818024704903284, 0.2619469992265898, 0.055680902962449985], [0.0, 13.834172636227677, 0.256925613438545, 0.06115831048184195], [0.0, 13.849535960918699, 0.25436224452346823, 0.06420746723727916], [0.0, 13.86074425059403, 0.2525913576478969, 0.06590588635544792], [0.0, 13.867711788212107, 0.2515126227204276, 0.06683757575568772], [0.0, 13.871733986017295, 0.2508955040044882, 0.06734327633566406], [0.0, 13.873973360851894, 0.25055343346199715, 0.06761607775592537], [0.0, 13.875197338515024, 0.2503668877994036, 0.06776274100381258], [0.0, 13.8758599153053, 0.2502660233858239, 0.06784144391611208], [0.0, 13.876216767660814, 0.25021173324022367, 0.06788363544953768], [0.0, 13.876408442777887, 0.250182582135024, 0.06790624155622038], [0.0, 13.876511248198579, 0.25016694961656033, 0.06791835034178628], [0.0, 13.876566345621976, 0.2501585723289223, 0.06792483531271681], [0.0, 13.876595862293046, 0.25015408469220934, 0.06792830810952694], [0.0, 13.876611671408394, 0.2501516811806931, 0.06793016776024036], [0.0, 13.876620137762467, 0.25015039403171624, 0.06793116356229978], [0.0, 13.876624671514953, 0.25014970476572795, 0.06793169678564304], [0.0, 13.876627099267797, 0.25014933567620135, 0.0679319823094035], [0.0, 13.876628399267501, 0.25014913803861427, 0.06793213519750652], [0.0, 13.876629095377423, 0.2501490322098813, 0.06793221706367952], [0.0, 13.87662946812098, 0.25014897554217314, 0.06793226090004517], [0.0, 13.876629667712098, 0.2501489451986102, 0.06793228437281335], [0.0, 13.876629774586, 0.2501489289507197, 0.06793229694167652], [0.0, 13.876629831813116, 0.25014892025056557, 0.06793230367184377], [0.0, 15.461481556638407, 0.06012989516647589, 0.006755678710070878], [0.0, 15.45330708442607, 0.057466348225148414, 0.007467742869556038], [0.0, 15.455349441230018, 0.05574015896354159, 0.007803951984162727], [0.0, 15.457524109488627, 0.05486570223434885, 0.007967288729787414], [0.0, 15.458836762214965, 0.05444030416491344, 0.008045430787637087], [0.0, 15.45951857161956, 0.05423722831137283, 0.008082462904574206], [0.0, 15.459853300041068, 0.05414111511751592, 0.008099931729337317], [0.0, 15.460013736001889, 0.05409580629999265, 0.008108154110699206], [0.0, 15.460089808863394, 0.054074486693558924, 0.008112020304172629], [0.0, 15.460125701354071, 0.054064463644567795, 0.008113837320812556], [0.0, 15.460142597012295, 0.054059753390497886, 0.008114691079633418], [0.0, 15.460150541719083, 0.05405754026460104, 0.008115092191012252], [0.0, 15.460154275603655, 0.05405650051424779, 0.008115280630955068], [0.0, 15.460156030052719, 0.054056012048859375, 0.008115369156881935], [0.0, 15.460156854327897, 0.054055782576730785, 0.008115410744446161], [0.0, 15.460157241568536, 0.05405567477590717, 0.008115430281276648], [0.0, 15.460157423487901, 0.054055624133737476, 0.008115439459176477], [0.0, 15.460157508949697, 0.054055600343341295, 0.008115443770731479], [0.0, 15.460157549097582, 0.0540555891672341, 0.008115445796154641], [0.0, 16.12250787173237, 0.018819927033207826, 0.0006590593171354464], [0.0, 16.11213798157229, 0.019157705800649794, 0.0006985834432809979], [0.0, 16.119626056651324, 0.019003727417277114, 0.0007281808313791549], [0.0, 16.121385432762537, 0.01896422853700612, 0.0007348440892357422], [0.0, 16.121845100708125, 0.018953793697756294, 0.0007365228962391557], [0.0, 16.121957952692256, 0.01895122142848628, 0.0007369332096957004], [0.0, 16.121985665339793, 0.018950589322624528, 0.000737033788995034], [0.0, 16.121992452801962, 0.018950434470907593, 0.0007370584153557069], [0.0, 16.12199411493716, 0.0189503965486143, 0.0007370644453683073], [0.0, 16.12199452191488, 0.018950387263132543, 0.0007370659217900699], [0.0, 16.121994621562763, 0.018950384989590077, 0.0007370662832917318], [0.0, 16.23049562782511, 0.01278295457237219, 0.00011205348833809303], [0.0, 16.214438733174, 0.0013368587471400406, 3.837765019831796e-05], [0.0, 16.195004477580554, 0.0014704909211080835, 5.986941093133469e-05], [0.0, 16.194400378565355, 0.0014432833689524, 6.355394944451698e-05], [0.0, 16.194368784152545, 0.001437612133566371, 6.40015970707064e-05], [0.0, 16.194365468641774, 0.001436847983295117, 6.405788893465436e-05], [0.0, 16.194365057950012, 0.0014367498570189152, 6.406504141770464e-05], [0.0, 16.194365005826842, 0.0014367373414272966, 6.406595212643529e-05], [0.0, 16.194364999190064, 0.0014367357467363895, 6.406606814224336e-05], [0.0, 16.140882104809652, 0.0, 6.888622026413049e-06], [0.0, 16.138028065403034, 2.057821922071823e-05, 6.321399635134117e-06], [0.0, 16.13798539779594, 2.4795526039553262e-05, 6.293241797683535e-06], [0.0, 16.137983443571407, 2.5141296645589395e-05, 6.2909849316006294e-06], [0.0, 16.137983274880497, 2.5174113435152967e-05, 6.290765184324698e-06], [0.0, 16.137983258837416, 2.5177266476106297e-05, 6.290743921055775e-06], [0.0, 16.137983257296348, 2.517756968793694e-05, 6.290741817738255e-06], [0.0, 16.138216522605934, 1.0738608703653174e-07, 4.711233847487506e-08], [0.0, 16.13821760730736, 4.3028792265364935e-08, 4.381983692569591e-08], [0.0, 16.13821771711839, 6.727362569791673e-08, 4.363450101241284e-08], [0.0, 16.13821772779592, 6.955471892888809e-08, 4.361953909182148e-08], [0.0, 16.13821772882473, 6.977321359569189e-08, 4.361819516685017e-08], [0.0, 16.13821604137118, 1.3791169595211983e-09, 2.669600651650228e-10], [0.0, 16.138216034120248, 8.317278810121564e-10, 2.473840576833197e-10], [0.0, 16.138216033451087, 9.659267830031126e-10, 2.4629048800406395e-10]], "trace_rows": 131, "trace_truncated": false, "outer_iters": 9, "mu_sequence": [5.0, 25.0, 125.0, 625.0, 3125.0, 10000.0, 10000.0, 10000.0, 10000.0], "stop": "StoppingCriterion Delta<1e-08", "inner_loops": [{"it": 0, "evals": 31, "A": 10.062, "f": 8.34498, "g": 1.56988, "h": 2.07472, "step": 0.100762, "stop": "DeltaConverge", "bad": 0}, {"it": 1, "evals": 52, "A": 13.2625, "f": 11.8172, "g": 0.731011, "h": 0.205226, "step": 0.0803302, "stop": "DeltaConverge", "bad": 0}, {"it": 2, "evals": 77, "A": 15.4455, "f": 13.8766, "g": 0.250149, "h": 0.0679323, "step": 0.0409679, "stop": "DeltaConverge", "bad": 0}, {"it": 3, "evals": 96, "A": 16.4148, "f": 15.4602, "g": 0.0540556, "h": 0.00811545, "step": 0.0271646, "stop": "DeltaConverge", "bad": 0}, {"it": 4, "evals": 107, "A": 16.8117, "f": 16.122, "g": 0.0189504, "h": 0.000737066, "step": 0.00685509, "stop": "DeltaConverge", "bad": 0}, {"it": 5, "evals": 116, "A": 16.0626, "f": 16.1944, "g": 0.00143674, "h": 6.40661e-05, "step": 0.0241014, "stop": "DeltaConverge", "bad": 0}, {"it": 6, "evals": 123, "A": 16.1382, "f": 16.138, "g": 2.51776e-05, "h": 6.29074e-06, "step": 0.00254425, "stop": "DeltaConverge", "bad": 0}, {"it": 7, "evals": 128, "A": 16.1382, "f": 16.1382, "g": 6.97732e-08, "h": 4.36182e-08, "step": 1.64783e-05, "stop": "DeltaConverge", "bad": 0}, {"it": 8, "evals": 131, "A": 16.1382, "f": 16.1382, "g": 9.65927e-10, "h": 2.4629e-10, "step": 9.78926e-08, "stop": "DeltaConverge", "bad": 0}, {"it": 9, "evals": 131, "A": 16.1382, "f": 16.1382, "g": 9.65927e-10, "h": 2.4629e-10, "step": 0.0, "stop": "DeltaConverge", "bad": 0}], "updates": [{"it": 1, "evals": 31, "A": 20.3644, "mu": 5.0}, {"it": 2, "evals": 52, "A": 18.1604, "mu": 25.0}, {"it": 3, "evals": 77, "A": 18.9663, "mu": 125.0}, {"it": 4, "evals": 96, "A": 17.9087, "mu": 625.0}, {"it": 5, "evals": 107, "A": 18.0794, "mu": 3125.0}, {"it": 6, "evals": 116, "A": 16.386, "mu": 10000.0}, {"it": 7, "evals": 123, "A": 16.1382, "mu": 10000.0}, {"it": 8, "evals": 128, "A": 16.1382, "mu": 10000.0}, {"it": 9, "evals": 131, "A": 16.1382, "mu": 10000.0}], "phi_at_x": [-0.5855569412038248, 1.2990618197938892, -0.5553500184868126, 1.116322657965643, -0.5251430957697656, 0.9335834961368701, -0.49493617305266396, 0.750844334306707, -0.4647292503354233, 0.5681051724740318, -0.43452232761793935, 0.385366010637583, -0.40431540490003337, 0.2026268487960898, -0.3741084821815117, 0.019887686948578877, -0.3439015594620666, -0.162851474905903, -0.31369463674137515, -0.3455906367677927, -0.28348771401900064, -0.5283297986369712, -0.2532807912943943, -0.7110689605128426, -0.2230738685669473, -0.8938081223939968, 0.027380085331762147, -0.8401157902821642, 0.26854387896025406, -0.6855128618028731, 0.509707672593243, -0.530909933321894, 0.7508714662300936, -0.3763070048386705, 0.9920352598697668, -0.22170407635342138, 1.2331990535111232, -0.06710114786680185, 1.47436284715312, 0.08750178062033402, -1.7468221313876597e-10, 2.4207302828926913e-11, 3.9362957338084925e-11, -8.038014698286133e-12, -1.5340502174034714, -0.4449261785326674, -1.5501100535202783, -0.43612940863499505, -1.5766337382347715, -0.42195074872515204, -1.6162529566801564, -0.40250733733193633, -1.6718601047207182, -0.37815843476157135, -1.746192138582209, -0.34917172427886883, -1.841455739468082, -0.31533192095874496, -1.959053358881322, -0.2755086645897833, -2.099451091244726, -0.22721160085583386, -2.2621912121302263, -0.16616492726371745, -2.4460150668420604, -0.08593416530161595, -2.6490438535009124, 9.659267830031126e-10, -2.8689689557185254, -4.649064466732966e-10, -3.09365394634402, -0.11848003926269772, -3.310669890662426, -0.3106729921498586, -3.5075718419673896, -0.5225947924080417, -3.6722709515790712, -0.7173541016095377, -3.7931614243475913, -0.8682722732440473, -3.859062991148451, -0.9533296379246586, -3.859062991147664, -0.9533296379237016], "residuals_at_x": {"cost": 16.138216033451084, "max_goal_rad": 1.7468221313876597e-11, "max_rest_rad_per_normalized_time": 3.9362957338084925e-12, "knot_deficit_mm_link1": 0.0, "knot_deficit_mm_link2": 9.659267830031126e-08, "max_knot_deficit_mm": 9.659267830031126e-08, "margin_mm": 5.0, "T": 20, "validation": {"valid": false, "fail": {"edge": 11, "j": 4, "n": 4, "q": [0.10954314435913773, 1.3339438935925345], "part": "link 2", "c": -9.659268090239648e-11}, "evaluated": 59, "scheduled": 62, "deepest": {"c": -0.0018436362032710858, "edge": 12, "j": 2, "n": 4, "q": [0.08016065064404977, 1.3486692343488742], "part": "link 2"}, "length_deg": 58.3672218273945}, "deepest_clearance_m": -0.0018436362032710858, "between_knot_deficit_mm": 1.8436362032710858}, "residuals_at_buffered": null, "upstream": "ccc36b55", "rows_at_x": "staged_two_link rows (sos, eq, ineq) with the eq and ineq rows times the constraint scale"}, "W-auglag-tight-shortcut-s10|komo": {"case": "W-auglag-tight-shortcut-s10", "model": "W", "method": "AugmentedLag", "opts": "tight", "start": "shortcut", "options_passed": {"method": "AugmentedLag", "stopTolerance": 1e-08, "stopFTolerance": 1e-12, "stopEvals": 5000}, "options_effective": {"verbose": 3, "stopTolerance": 1e-08, "stopFTolerance": 1e-12, "stopGTolerance": -1.0, "stopEvals": 5000, "stopInners": 1000, "stopOuters": 1000, "stepMax": 0.2, "damping": 1.0, "stepInc": 1.5, "stepDec": 0.5, "wolfe": 0.01, "muInit": 1.0, "muInc": 5.0, "muMax": 10000.0, "muLBInit": 0.1, "muLBDec": 0.2, "lambdaMax": -1.0, "method": "AugmentedLag"}, "constraint_scale": 10.0, "T": 20, "k": 2, "margin_mm": 5.0, "disc": true, "rrt_seed": 7, "seed": null, "parent": null, "call": "setInitialization + solve(0)", "program": "komo", "nominal_x": [0.49398606716432986, 0.8266891056465161, 0.4651307531914821, 0.8686379377820006, 0.43646619528099456, 0.9107177430320252, 0.40629608953866575, 0.9517175111402572, 0.3756213981598166, 0.9923553038816949, 0.3449467067809674, 1.0329930966231327, 0.31427201540211824, 1.0736308893645705, 0.28353502034984757, 1.1142212417721706, 0.25252049165525425, 1.1546002697438285, 0.22150596296066088, 1.1949792977154865, 0.19049143426606754, 1.2353583256871445, 0.15947690557147426, 1.2757373536588026, 0.12846237687688095, 1.3161163816304606, 0.09541889381659188, 1.3535564034501737, 0.0459166748668753, 1.3651620901581103, -0.004222505602962695, 1.37401813170593, -0.0543616860728008, 1.3828741732537493, -0.1045008665426388, 1.3917302148015689, -0.1546400470124769, 1.4005862563493883, -0.20101301442315012, 1.4033482475752073], "x_start": [0.49398606716432986, 0.8266891056465161, 0.4651307531914821, 0.8686379377820006, 0.43646619528099456, 0.9107177430320252, 0.40629608953866575, 0.9517175111402572, 0.3756213981598166, 0.9923553038816949, 0.3449467067809674, 1.0329930966231327, 0.31427201540211824, 1.0736308893645705, 0.28353502034984757, 1.1142212417721706, 0.25252049165525425, 1.1546002697438285, 0.22150596296066088, 1.1949792977154865, 0.19049143426606754, 1.2353583256871445, 0.15947690557147426, 1.2757373536588026, 0.12846237687688095, 1.3161163816304606, 0.09541889381659188, 1.3535564034501737, 0.0459166748668753, 1.3651620901581103, -0.004222505602962695, 1.37401813170593, -0.0543616860728008, 1.3828741732537493, -0.1045008665426388, 1.3917302148015689, -0.1546400470124769, 1.4005862563493883, -0.20101301442315012, 1.4033482475752073], "ret": {"evals": 131, "sos": 16.138216033451094, "ineq": 9.659253952243319e-10, "eq": 2.4629048800406395e-10, "f": 0.0, "feasible": true, "done": true, "time": 0.024653000000000036}, "x": [0.5170520499721557, 0.799922116077617, 0.5042963223828013, 0.8269269354979576, 0.48566931649316764, 0.864369535718468, 0.4615087559661871, 0.9102068307991302, 0.432152364464794, 0.9623957347998984, 0.3979378656519252, 1.0188931617806842, 0.3592029831905222, 1.0776560258013437, 0.3162854407435336, 1.1366412409216642, 0.2695229619739181, 1.1938057212013562, 0.2192532705446485, 1.247106380700047, 0.16581409011871637, 1.2945001334772828, 0.10954314435913817, 1.3339438935925343, 0.050778156928962224, 1.3633945751052137, -0.007680711841055924, 1.3834524765376837, -0.06313716876959105, 1.3958461111779454, -0.1128949206752677, 1.402303992314019, -0.15425767437666724, 1.4045546332339496, -0.1845291366923394, 1.404326547225805, -0.20101301444081515, 1.4033482475776682, -0.20101301444061834, 1.403348247577628], "x_end": [0.5170520499721557, 0.799922116077617, 0.5042963223828013, 0.8269269354979576, 0.48566931649316764, 0.864369535718468, 0.4615087559661871, 0.9102068307991302, 0.432152364464794, 0.9623957347998984, 0.3979378656519252, 1.0188931617806842, 0.3592029831905222, 1.0776560258013437, 0.3162854407435336, 1.1366412409216642, 0.2695229619739181, 1.1938057212013562, 0.2192532705446485, 1.247106380700047, 0.16581409011871637, 1.2945001334772828, 0.10954314435913817, 1.3339438935925343, 0.050778156928962224, 1.3633945751052137, -0.007680711841055924, 1.3834524765376837, -0.06313716876959105, 1.3958461111779454, -0.1128949206752677, 1.402303992314019, -0.15425767437666724, 1.4045546332339496, -0.1845291366923394, 1.404326547225805, -0.20101301444081515, 1.4033482475776682, -0.20101301444061834, 1.403348247577628], "buffered_x": [0.5170520499721557, 0.799922116077617, 0.5042963223828013, 0.8269269354979576, 0.48566931649316764, 0.864369535718468, 0.4615087559661871, 0.9102068307991302, 0.432152364464794, 0.9623957347998984, 0.3979378656519252, 1.0188931617806842, 0.3592029831905222, 1.0776560258013437, 0.3162854407435336, 1.1366412409216642, 0.2695229619739181, 1.1938057212013562, 0.2192532705446485, 1.247106380700047, 0.16581409011871637, 1.2945001334772828, 0.10954314435913817, 1.3339438935925343, 0.050778156928962224, 1.3633945751052137, -0.007680711841055924, 1.3834524765376837, -0.06313716876959105, 1.3958461111779454, -0.1128949206752677, 1.402303992314019, -0.15425767437666724, 1.4045546332339496, -0.1845291366923394, 1.404326547225805, -0.20101301444081515, 1.4033482475776682, -0.20101301444061834, 1.403348247577628], "komo_path": [0.5170520499721557, 0.799922116077617, 0.5042963223828013, 0.8269269354979576, 0.48566931649316764, 0.864369535718468, 0.4615087559661871, 0.9102068307991302, 0.432152364464794, 0.9623957347998984, 0.3979378656519252, 1.0188931617806842, 0.3592029831905222, 1.0776560258013437, 0.3162854407435336, 1.1366412409216642, 0.2695229619739181, 1.1938057212013562, 0.2192532705446485, 1.247106380700047, 0.16581409011871637, 1.2945001334772828, 0.10954314435913817, 1.3339438935925343, 0.050778156928962224, 1.3633945751052137, -0.007680711841055924, 1.3834524765376837, -0.06313716876959105, 1.3958461111779454, -0.1128949206752677, 1.402303992314019, -0.15425767437666724, 1.4045546332339496, -0.1845291366923394, 1.404326547225805, -0.20101301444081515, 1.4033482475776682, -0.20101301444061834, 1.403348247577628], "dual": [0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 4.314069090362683, 2.7656212609552266, -1.5344136744369685, -0.21654503495485145, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 14.69549953738485, 8.713592358803536, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0], "trace_errs": [[0.0, 28.777650974914046, 0.0, 9.82699172729844], [0.0, 8.248327840456055, 1.921874799254834, 2.094448460157956], [0.0, 8.379907015044212, 1.7590080910368746, 2.0195409423907598], [0.0, 8.39190085794198, 1.7242509432115622, 2.015570628266986], [0.0, 8.389991007254052, 1.6966236549372622, 2.0208376162111072], [0.0, 8.383566444454509, 1.66898540362511, 2.029809603069641], [0.0, 8.374977331435426, 1.642536652401139, 2.0404070396503435], [0.0, 8.366298112020072, 1.6198335185411208, 2.050576600393585], [0.0, 8.359091384273977, 1.6024914497519243, 2.0588117899161604], [0.0, 8.353886789170735, 1.5904127060350288, 2.0646926494802806], [0.0, 8.350445035391287, 1.582508429429865, 2.068566507552052], [0.0, 8.348280582819564, 1.5775346774604455, 2.071001327459098], [0.0, 8.34695580642531, 1.5744789587459838, 2.0724924297962435], [0.0, 8.3461565590506, 1.5726285286356845, 2.073392689804835], [0.0, 8.345678084087034, 1.5715176313602106, 2.073931963027487], [0.0, 8.345392856354612, 1.5708541453452802, 2.0742535697104714], [0.0, 8.345223232174872, 1.570459093525842, 2.074444880873865], [0.0, 8.345122494740925, 1.5702243019185338, 2.074558517382759], [0.0, 8.345062715495295, 1.5700849092964004, 2.074625958213307], [0.0, 8.345027257910825, 1.5700022070357802, 2.074665962733491], [0.0, 8.345006232241653, 1.5699531581518575, 2.074689685546274], [0.0, 8.3449937664203, 1.5699240749283851, 2.074703750783311], [0.0, 8.344986376311399, 1.5699068325310381, 2.0747120891852697], [0.0, 8.34498199548103, 1.5698966109472006, 2.0747170321998367], [0.0, 8.34497939862647, 1.5698905517058221, 2.0747199623180013], [0.0, 8.344977859301661, 1.5698869599552823, 2.07472169919472], [0.0, 8.344976946854173, 1.5698848309002873, 2.074722728744462], [0.0, 8.34497640599715, 1.5698835688887476, 2.0747233390149287], [0.0, 8.344976085403227, 1.5698828208273534, 2.0747237007540065], [0.0, 8.344975895371105, 1.5698823774130897, 2.074723915174983], [0.0, 8.344975782729653, 1.5698821145793005, 2.0747240422729547], [0.0, 11.753160089606208, 0.75408592118083, 0.19174341414732288], [0.0, 11.816601893677074, 0.7303604001083073, 0.20654629599014762], [0.0, 11.819633356896917, 0.7294761664325892, 0.20668677700215882], [0.0, 11.818781114954614, 0.7299818948398777, 0.206096658438934], [0.0, 11.818102217408914, 0.7303427673241536, 0.20571622136102224], [0.0, 11.817707414607712, 0.7305500939656957, 0.20549994721751508], [0.0, 11.817485739873367, 0.7307343978696285, 0.20537888574794494], [0.0, 11.817361832511235, 0.7308564575248329, 0.2053112461011855], [0.0, 11.817292605879684, 0.73092464149631, 0.20527345830969768], [0.0, 11.817253928402398, 0.7309627343511187, 0.2052523461441838], [0.0, 11.817232317884269, 0.7309840176590028, 0.20524055002186348], [0.0, 11.817220242889627, 0.7309959096549941, 0.20523395887586282], [0.0, 11.817213495787742, 0.7310025544514022, 0.20523027596492827], [0.0, 11.81720972569166, 0.7310062673657736, 0.20522821805500718], [0.0, 11.817207619051954, 0.7310083420486624, 0.20522706814410235], [0.0, 11.817206441907844, 0.7310095013344049, 0.205226425599071], [0.0, 11.817205784144269, 0.7310101491186312, 0.20522606655835857], [0.0, 11.817205416599258, 0.7310105110872007, 0.20522586593360953], [0.0, 11.817205211222433, 0.7310107133479894, 0.2052257538285257], [0.0, 11.817205096461915, 0.731010826367321, 0.20522569118641254], [0.0, 11.817205032335965, 0.7310108895203018, 0.2052256561832061], [0.0, 13.756110187782113, 0.29938360527454855, 0.04378979100864433], [0.0, 13.818024704903284, 0.26194699922659, 0.05568090296249356], [0.0, 13.83417263622768, 0.2569256134385485, 0.06115831048188414], [0.0, 13.849535960918699, 0.2543622445234692, 0.06420746723727444], [0.0, 13.860744250594033, 0.25259135764789475, 0.06590588635544847], [0.0, 13.867711788212107, 0.2515126227204263, 0.06683757575568827], [0.0, 13.871733986017304, 0.2508955040044899, 0.06734327633566434], [0.0, 13.873973360851904, 0.25055343346199516, 0.06761607775592038], [0.0, 13.87519733851502, 0.2503668877994039, 0.06776274100381258], [0.0, 13.8758599153053, 0.2502660233858247, 0.06784144391615649], [0.0, 13.876216767660816, 0.25021173324022494, 0.06788363544958764], [0.0, 13.876408442777896, 0.25018258213502426, 0.06790624155622038], [0.0, 13.876511248198597, 0.2501669496165586, 0.06791835034178628], [0.0, 13.87656634562198, 0.25015857232892125, 0.06792483531271681], [0.0, 13.876595862293055, 0.250154084692209, 0.06792830810952166], [0.0, 13.876611671408396, 0.2501516811806943, 0.06793016776024036], [0.0, 13.876620137762494, 0.2501503940317151, 0.06793116356233891], [0.0, 13.876624671514971, 0.25014970476572884, 0.06793169678563776], [0.0, 13.876627099267798, 0.2501493356762001, 0.0679319823094035], [0.0, 13.876628399267505, 0.25014913803861405, 0.06793213519750624], [0.0, 13.876629095377428, 0.25014903220987994, 0.06793221706367952], [0.0, 13.876629468120969, 0.2501489755421731, 0.06793226090004517], [0.0, 13.876629667712102, 0.25014894519861114, 0.0679322843728522], [0.0, 13.876629774586013, 0.2501489289507219, 0.06793229694167652], [0.0, 13.876629831813124, 0.2501489202505627, 0.06793230367184377], [0.0, 15.461481556638466, 0.06012989516647263, 0.006755678710027024], [0.0, 15.453307084426058, 0.057466348225149594, 0.007467742869556038], [0.0, 15.455349441230007, 0.05574015896354187, 0.007803951984157176], [0.0, 15.457524109488611, 0.05486570223434975, 0.007967288729787692], [0.0, 15.458836762214966, 0.054440304164913855, 0.008045430787637087], [0.0, 15.45951857161954, 0.054237228311373176, 0.008082462904574206], [0.0, 15.45985330004107, 0.054141115117516125, 0.008099931729337317], [0.0, 15.460013736001887, 0.05409580629999189, 0.008108154110699206], [0.0, 15.460089808863387, 0.05407448669355962, 0.008112020304172629], [0.0, 15.460125701354066, 0.05406446364456599, 0.008113837320812556], [0.0, 15.460142597012286, 0.054059753390499274, 0.008114691079633418], [0.0, 15.460150541719116, 0.05405754026460041, 0.008115092191012252], [0.0, 15.460154275603651, 0.05405650051424793, 0.008115280630955068], [0.0, 15.46015603005273, 0.05405601204885861, 0.008115369156876384], [0.0, 15.460156854327888, 0.05405578257673231, 0.008115410744446161], [0.0, 15.460157241568542, 0.054055674775907586, 0.008115430281271097], [0.0, 15.46015742348791, 0.05405562413373678, 0.008115439459176477], [0.0, 15.460157508949683, 0.05405560034334317, 0.008115443770731479], [0.0, 15.460157549097573, 0.05405558916723403, 0.008115445796154641], [0.0, 16.122507871732378, 0.01881992703320838, 0.0006590593171354464], [0.0, 16.11213798157231, 0.019157705800650904, 0.0006985834432809979], [0.0, 16.11962605665134, 0.019003727417276628, 0.0007281808313791549], [0.0, 16.121385432762562, 0.01896422853700612, 0.0007348440892357422], [0.0, 16.121845100708107, 0.018953793697756988, 0.0007365228962391557], [0.0, 16.121957952692245, 0.01895122142848593, 0.0007369332097348358], [0.0, 16.121985665339768, 0.018950589322625083, 0.000737033788995034], [0.0, 16.12199245280196, 0.018950434470907593, 0.0007370584153557069], [0.0, 16.12199411493717, 0.018950396548615064, 0.0007370644453683073], [0.0, 16.121994521914896, 0.01895038726313296, 0.0007370659217900699], [0.0, 16.121994621562813, 0.018950384989588967, 0.0007370662832917318], [0.0, 16.230495627825086, 0.012782954572383154, 0.00011205348834364415], [0.0, 16.214438733174045, 0.0013368587471387916, 3.837765019831796e-05], [0.0, 16.19500447758058, 0.0014704909211080835, 5.986941093133469e-05], [0.0, 16.19440037856536, 0.0014432833689526775, 6.355394944451698e-05], [0.0, 16.19436878415255, 0.0014376121335653996, 6.40015970707064e-05], [0.0, 16.194365468641816, 0.0014368479832958109, 6.405788893465436e-05], [0.0, 16.194365057950012, 0.001436749857019054, 6.406504141770464e-05], [0.0, 16.194365005826864, 0.0014367373414262558, 6.406595212643529e-05], [0.0, 16.19436499919007, 0.0014367357467374303, 6.406606814224336e-05], [0.0, 16.14088210480967, 0.0, 6.888622026413049e-06], [0.0, 16.138028065403038, 2.057821922127334e-05, 6.321399635134117e-06], [0.0, 16.13798539779596, 2.4795526040108373e-05, 6.293241797683535e-06], [0.0, 16.13798344357141, 2.5141296644479172e-05, 6.2909849316006294e-06], [0.0, 16.13798327488049, 2.517411343626319e-05, 6.290765184324698e-06], [0.0, 16.137983258837437, 2.5177266474857296e-05, 6.290743921055775e-06], [0.0, 16.13798325729634, 2.5177569689116552e-05, 6.290741817738255e-06], [0.0, 16.13821652260597, 1.0738608502425251e-07, 4.711233847487506e-08], [0.0, 16.13821760730739, 4.302879108575297e-08, 4.381983692569591e-08], [0.0, 16.138217717118405, 6.727362465708264e-08, 4.363450101241284e-08], [0.0, 16.138217727795947, 6.955471809622082e-08, 4.361953909182148e-08], [0.0, 16.13821772882476, 6.977321241607992e-08, 4.361819516685017e-08], [0.0, 16.13821604137119, 1.3791175840216496e-09, 2.669600651650228e-10], [0.0, 16.13821603412024, 8.317279504010955e-10, 2.473840576833197e-10], [0.0, 16.138216033451094, 9.659253952243319e-10, 2.4629048800406395e-10]], "trace_rows": 131, "trace_truncated": false, "outer_iters": 9, "mu_sequence": [5.0, 25.0, 125.0, 625.0, 3125.0, 10000.0, 10000.0, 10000.0, 10000.0], "stop": "StoppingCriterion Delta<1e-08", "inner_loops": [{"it": 0, "evals": 31, "A": 10.062, "f": 8.34498, "g": 1.56988, "h": 2.07472, "step": 0.100762, "stop": "DeltaConverge", "bad": 0}, {"it": 1, "evals": 52, "A": 13.2625, "f": 11.8172, "g": 0.731011, "h": 0.205226, "step": 0.0803302, "stop": "DeltaConverge", "bad": 0}, {"it": 2, "evals": 77, "A": 15.4455, "f": 13.8766, "g": 0.250149, "h": 0.0679323, "step": 0.0409679, "stop": "DeltaConverge", "bad": 0}, {"it": 3, "evals": 96, "A": 16.4148, "f": 15.4602, "g": 0.0540556, "h": 0.00811545, "step": 0.0271646, "stop": "DeltaConverge", "bad": 0}, {"it": 4, "evals": 107, "A": 16.8117, "f": 16.122, "g": 0.0189504, "h": 0.000737066, "step": 0.00685509, "stop": "DeltaConverge", "bad": 0}, {"it": 5, "evals": 116, "A": 16.0626, "f": 16.1944, "g": 0.00143674, "h": 6.40661e-05, "step": 0.0241014, "stop": "DeltaConverge", "bad": 0}, {"it": 6, "evals": 123, "A": 16.1382, "f": 16.138, "g": 2.51776e-05, "h": 6.29074e-06, "step": 0.00254425, "stop": "DeltaConverge", "bad": 0}, {"it": 7, "evals": 128, "A": 16.1382, "f": 16.1382, "g": 6.97732e-08, "h": 4.36182e-08, "step": 1.64783e-05, "stop": "DeltaConverge", "bad": 0}, {"it": 8, "evals": 131, "A": 16.1382, "f": 16.1382, "g": 9.65925e-10, "h": 2.4629e-10, "step": 9.78926e-08, "stop": "DeltaConverge", "bad": 0}, {"it": 9, "evals": 131, "A": 16.1382, "f": 16.1382, "g": 9.65925e-10, "h": 2.4629e-10, "step": 0.0, "stop": "DeltaConverge", "bad": 0}], "updates": [{"it": 1, "evals": 31, "A": 20.3644, "mu": 5.0}, {"it": 2, "evals": 52, "A": 18.1604, "mu": 25.0}, {"it": 3, "evals": 77, "A": 18.9663, "mu": 125.0}, {"it": 4, "evals": 96, "A": 17.9087, "mu": 625.0}, {"it": 5, "evals": 107, "A": 18.0794, "mu": 3125.0}, {"it": 6, "evals": 116, "A": 16.386, "mu": 10000.0}, {"it": 7, "evals": 123, "A": 16.1382, "mu": 10000.0}, {"it": 8, "evals": 128, "A": 16.1382, "mu": 10000.0}, {"it": 9, "evals": 131, "A": 16.1382, "mu": 10000.0}], "phi_at_x": [-0.5855569412038348, 1.2990618197938992, -0.5553500184868027, 1.116322657965623, -0.5251430957697557, 0.9335834961368701, -0.4949361730526689, 0.750844334306707, -0.4647292503354233, 0.5681051724740318, -0.43452232761793436, 0.385366010637583, -0.4043154049000383, 0.20262684879612952, -0.3741084821815067, 0.019887686948559018, -0.3439015594620715, -0.162851474905903, -0.31369463674138015, -0.3455906367677927, -0.28348771401899814, -0.5283297986369712, -0.25328079129439923, -0.7110689605128426, -0.22307386856694855, -0.8938081223939968, 0.02738008533175982, -0.8401157902821642, 0.26854387896025406, -0.6855128618028731, 0.5097076725932418, -0.530909933321894, 0.7508714662300912, -0.3763070048386705, 0.9920352598697718, -0.2217040763534015, 1.2331990535111257, -0.06710114786682171, 1.4743628471531225, 0.08750178062033402, -1.7468221313876597e-10, 2.4207302828926913e-11, 3.9362957338084925e-11, -8.038014698286133e-12, -1.5340502174034714, -0.44492617853266697, -1.5501100535202785, -0.43612940863499505, -1.5766337382347715, -0.42195074872515176, -1.6162529566801562, -0.40250733733193633, -1.671860104720718, -0.37815843476157096, -1.7461921385822081, -0.34917172427886894, -1.841455739468081, -0.3153319209587451, -1.9590533588813208, -0.27550866458978535, -2.0994510912447244, -0.22721160085583497, -2.262191212130225, -0.16616492726371968, -2.446015066842059, -0.08593416530161706, -2.6490438535009115, 9.659258809469051e-10, -2.8689689557185236, -4.649058915617843e-10, -3.093653946344019, -0.11848003926269675, -3.3106698906624255, -0.3106729921498582, -3.5075718419673887, -0.5225947924080412, -3.672270951579071, -0.717354101609538, -3.7931614243475913, -0.8682722732440471, -3.859062991148451, -0.9533296379246586, -3.859062991147664, -0.9533296379237016], "residuals_at_x": {"cost": 16.13821603345109, "max_goal_rad": 1.7468221313876597e-11, "max_rest_rad_per_normalized_time": 3.9362957338084925e-12, "knot_deficit_mm_link1": 0.0, "knot_deficit_mm_link2": 9.659258809469051e-08, "max_knot_deficit_mm": 9.659258809469051e-08, "margin_mm": 5.0, "T": 20, "validation": {"valid": false, "fail": {"edge": 11, "j": 4, "n": 4, "q": [0.10954314435913817, 1.3339438935925343], "part": "link 2", "c": -9.659259069677573e-11}, "evaluated": 59, "scheduled": 62, "deepest": {"c": -0.0018436362032710997, "edge": 12, "j": 2, "n": 4, "q": [0.0801606506440502, 1.348669234348874], "part": "link 2"}, "length_deg": 58.3672218273945}, "deepest_clearance_m": -0.0018436362032710997, "between_knot_deficit_mm": 1.8436362032710996}, "residuals_at_buffered": null, "upstream": "ccc36b55", "rows_at_x": "staged_two_link rows (sos, eq, ineq) with the eq and ineq rows times the constraint scale"}}}